30.16 구형 손목(Spherical Wrist)의 자세 역기구학

30.16 구형 손목(Spherical Wrist)의 자세 역기구학

구형 손목(spherical wrist)은 6자유도 매니퓰레이터의 마지막 3개 관절 구성으로, 세 관절 축이 한 점에서 교차하는 구조이다. 이러한 구조는 자세 역기구학의 해석적 해결을 가능하게 한다. 본 절에서는 구형 손목의 자세 역기구학을 다룬다.

1. 구형 손목의 학술적 정의

구형 손목은 다음과 같은 특성을 가진다.

1.1 교차 축

4번, 5번, 6번 관절의 회전 축이 손목 중심(wrist center)이라 불리는 한 점에서 교차한다.

1.2 자세 자유도

세 관절은 엔드 이펙터의 자세를 3자유도로 제어한다. 위치는 제어하지 않고, 자세만 결정한다.

1.3 오일러 각 표현

구형 손목의 자세는 일반적으로 ZYZ 오일러 각으로 표현된다. 첫 관절이 \alpha(첫 Z 회전), 두 번째 관절이 \beta(Y 회전), 세 번째 관절이 \gamma(두 번째 Z 회전)에 해당한다.

2. 문제 설정

구형 손목의 자세 역기구학 문제는 다음과 같이 설정된다.

2.1 입력

첫 3개 관절이 결정된 상태에서, 엔드 이펙터의 원하는 자세를 달성하기 위한 손목 자세의 회전 행렬 \mathbf{R}_{3,6}이 주어진다.

2.2 출력

\theta_4, \theta_5, \theta_6의 관절 각도를 산출한다.

3. ZYZ 오일러 각 추출

\mathbf{R}_{3,6}의 ZYZ 오일러 각 분해는 다음과 같이 수행된다. 회전 행렬의 원소를 r_{ij}로 표기한다.

3.1 \theta_5 (Y 회전) 산출

\sin\theta_5 \neq 0인 경우:

\theta_5 = \arctan2\left(\pm\sqrt{r_{13}^2 + r_{23}^2}, r_{33}\right)

\pm 기호는 두 가지 해(플립·논 플립)에 해당한다.

30.16.3.2 \theta_4 (첫 Z 회전) 산출

\sin\theta_5 \neq 0인 경우:

\theta_4 = \arctan2(r_{23}, r_{13})

플립 구성(\theta_5 < 0)에서는 \theta_4 + \pi를 사용한다.

3.2 \theta_6 (두 번째 Z 회전) 산출

\sin\theta_5 \neq 0인 경우:

\theta_6 = \arctan2(r_{32}, -r_{31})

플립 구성에서는 \theta_6 + \pi를 사용한다.

30.16.4 특이점의 처리

\sin\theta_5 = 0인 경우(즉, \theta_5 = 0 또는 \theta_5 = \pi) 손목 특이점이 발생한다.

30.16.4.1 \theta_5 = 0

이 경우 \theta_4와 \theta_6의 축이 일치하며, 개별 값이 결정되지 않는다. 합만 결정된다.

\theta_4 + \theta_6 = \arctan2(r_{21}, r_{11})

일반적으로 \theta_4 = 0으로 설정하고 \theta_6을 결정한다.

3.3 \theta_5 = \pi

이 경우 \theta_4와 \theta_6의 회전 축이 반대 방향이 되며, 차이만 결정된다.

\theta_6 - \theta_4 = \arctan2(r_{21}, r_{11})

30.16.5 다중 해

구형 손목의 자세 역기구학은 일반적으로 2개의 해(플립·논 플립)를 가진다. 두 해는 다음과 같다.

해 1 (논 플립):
\theta_5 = +\arctan2(\sqrt{r_{13}^2 + r_{23}^2}, r_{33})
\theta_4 = \arctan2(r_{23}, r_{13})
\theta_6 = \arctan2(r_{32}, -r_{31})

해 2 (플립):
\theta_5 = -\arctan2(\sqrt{r_{13}^2 + r_{23}^2}, r_{33})
\theta_4 = \arctan2(-r_{23}, -r_{13})
\theta_6 = \arctan2(-r_{32}, r_{31})

30.16.6 다른 오일러 각 표현

로봇의 구조에 따라 다른 오일러 각 표현이 활용된다.

30.16.6.1 ZYX

일부 로봇에서는 ZYX(요-피치-롤) 표현이 활용된다.

30.16.6.2 XYZ

일부 다른 구조에서는 XYZ 표현이 활용된다.

각 표현에서의 오일러 각 추출 공식은 회전 행렬의 원소의 다른 조합으로 표현된다.

30.16.7 실무적 고려

30.16.7.1 특이점 회피

운동 계획과 제어에서 손목 특이점을 회피하여 수치적 안정성을 확보한다.

30.16.7.2 해의 연속성

연속 운동 시 해의 연속성을 유지하기 위해 이전 시점의 구성에 가까운 해를 선택한다.

30.16.7.3 관절 한계

관절 한계를 만족하는 해를 선택한다.

30.16.8 학술적 활용

구형 손목의 자세 역기구학은 다음과 같은 영역에 활용된다. 첫째, 산업용 6자유도 매니퓰레이터의 실시간 제어. 둘째, 가상 시뮬레이션. 셋째, 학술 연구와 교육.

30.16.9 학술적 의의

구형 손목의 자세 역기구학은 해석적 역기구학의 핵심 구성 요소이며, 피퍼 기준과 결합되어 6자유도 매니퓰레이터의 해석적 해를 가능하게 한다. 그 학술적 이해는 현대 로봇 공학의 필수 지식이다.

출처

  • Paul, R. P., Robot Manipulators: Mathematics, Programming, and Control, MIT Press, 1981.
  • Craig, J. J., Introduction to Robotics: Mechanics and Control, 4th edition, Pearson, 2018.
  • Spong, M. W., Hutchinson, S., and Vidyasagar, M., Robot Modeling and Control, 2nd edition, Wiley, 2020.
  • Sciavicco, L. and Siciliano, B., Modelling and Control of Robot Manipulators, 2nd edition, Springer, 2000.

버전

  • 문서 버전: 1.0
  • 작성일: 2026-04-18