1 |
1
로봇 암의 선단에 장착된 그립부를 이용하여, 워크피스를 파지한 상태로 홀에 삽입하기 위한 양팔로봇 암의 자세 제어방법에 있어서,상기 홀과 워크피스의 접촉점에서 발생하는 반발력을 감지하는 단계;상기 감지된 반발력을 기초로 삽입자세의 오차를 추정하는 단계;상기 추정된 오차를 보상하여 삽입자세를 교정하는 단계;를 포함하는 것을 특징으로 하는 양팔로봇 암의 자세 제어방법
|
2 |
2
제 1항에 있어서,상기 반발력을 감지하는 단계는, 상기 워크피스 삽입 시 접촉하는 방향에 따라 발생하는 비틀림 힘을 감지하는 것을 특징으로 하는 양팔로봇 암의 자세 제어방법
|
3 |
3
제 2항에 있어서,상기 오차를 추정하는 단계 이후에는, 상기 감지된 비틀림 힘과 기준치를 비교하는 단계가 진행되는 것을 특징으로 하는 양팔로봇 암의 자세 제어방법
|
4 |
4
제 3항에 있어서,상기 자세를 교정하는 단계는, 상기 감지된 비틀림 힘이 상기 기준치보다 작아질 때까지 워크피스를 움직여 가며 삽입하는 것을 특징으로 하는 양팔로봇 암의 자세 제어방법
|
5 |
5
제 2항에 있어서,상기 오차를 추정하는 단계는, 상기 워크피스의 비틀림 각을 추정하는 것을 특징으로 하는 양팔로봇 암의 자세 제어방법
|
6 |
6
제 5항에 있어서, 상기 자세를 교정하는 단계는, 추정된 비틀린 각도만큼 워크피스를 움직인 후 삽입하는 것을 특징으로 하는 양팔로봇 암의 자세 제어방법
|