5
로봇 첨단부의 한 점과 지면에 고정된 베이스 사이를 연결봉으로 연결시키고 로봇 첨단부와 연결봉 및 연결봉과 베이스 사이에 각각 제1 및 제2조인트로 연결하는 제1단계와; 상기 제1단계에서, 다자유도의 구동기 중 임의로 선택된 1 개의 구동기는 자유롭게 풀어주고, 나머지 구동기는 로봇 첨단부를 여러 개의 원하는 위치 및 여러 개의 회전이 이루어지도록 구동시키는 제2단계와; 상기 제2단계에서, 자유롭게 풀어준 1 개의 구동기와 구동시키는 나머지 구동기 모두의 길이 또는 각도를 측정하는 제3단계와; 주어진 기구 변수들(링크의 길이 및 조인트의 위치 등)의 공칭값을 사용하고, 상기에서 측정된 나머지 구동기의 길이 또는 각도 값과 연결봉의 고정길이 등의 정보를 사용하고 순기구학 방정식을 이용하여 로봇 첨단부의 위치 및 자세를 구한 후 역기구학 방정식을 풀어서 1개의 구동기의 계산된 값을 구하는 제4단계와; 상기 제3단계에서 계산된 1개의 구동기 값에서 상기 제4단계에서 계산된 구동기값을 뺀 값을 오차로 정의하고, 오차가 최소가 되도록 하여 기구변수들의 캘리브레이션된 값들을 계산하는 제5단계를 포함하여 구성된 것을 특징으로 하는 로봇 캘리브레이션 방법
|