30.10 3자유도 공간 매니퓰레이터의 기하학적 해석

3자유도 공간 매니퓰레이터의 기하학적 역기구학 해석은 평면 매니퓰레이터의 기하학적 해석을 3차원 공간으로 확장한 학술적 주제이다. 본 절에서는 3자유도 RRR 공간 매니퓰레이터의 기하학적 역기구학 도출을 다룬다.

1. 매니퓰레이터의 구조

3자유도 공간 매니퓰레이터(RRR 구조)의 일반적 구성은 다음과 같다.

첫 번째 회전 관절: $z_0$ 축(수직)을 회전 축으로 한다(방위각 결정).
두 번째와 세 번째 회전 관절: 수평 방향의 축을 회전 축으로 한다(상승각과 팔꿈치 결정).
첫 번째 링크: 베이스에서 어깨까지의 수직 높이 $d_1$ .
두 번째 링크: 상완, 길이 $l_2$ .
세 번째 링크: 하완, 길이 $l_3$ .

2. 문제 설정

엔드 이펙터의 목표 3차원 위치를 $(x, y, z)$ 라 할 때, 이를 달성하는 세 관절 각도 $\theta_1, \theta_2, \theta_3$ 를 산출한다.

3. 단계 1: 첫 번째 관절 (방위각)

첫 번째 관절은 엔드 이펙터의 수평 방위각을 결정한다.

$\theta_1 = \arctan2(y, x)$

이 산출은 엔드 이펙터가 위치한 수직 평면을 결정한다.

30.10.3.1 대안 해

$\theta_1 + \pi$ 도 해이지만, 이는 매니퓰레이터가 반대 방향을 향한 구성이다. 일반적으로 관절 한계에 의해 하나의 해가 선택된다.

30.10.4 단계 2: 수직 평면 투영

첫 번째 관절 각도 $\theta_1$ 이 결정되면, 엔드 이펙터의 위치를 포함하는 수직 평면에서 2차원 문제로 투영된다.

30.10.4.1 투영된 좌표

엔드 이펙터의 수평 거리:

$r = \sqrt{x^2 + y^2}$

어깨 기준의 투영된 좌표:

$r' = r$
$z' = z - d_1$

4. 단계 3: 2자유도 평면 매니퓰레이터 해석

투영된 평면에서 두 번째와 세 번째 관절은 2자유도 평면 매니퓰레이터와 동일한 구조를 형성한다.

4.1 어깨에서 엔드 이펙터까지의 거리

$R = \sqrt{r'^2 + z'^2} = \sqrt{r^2 + (z - d_1)^2}$

30.10.5.2 세 번째 관절 각도

코사인 법칙을 활용해 세 번째 관절 각도를 산출한다.

$\cos\theta_3 = \frac{R^2 - l_2^2 - l_3^2}{2 l_2 l_3}$

$\theta_3 = \pm\arccos\left(\frac{R^2 - l_2^2 - l_3^2}{2 l_2 l_3}\right)$

$\pm$ 부호는 팔꿈치 업·다운의 두 구성에 해당한다.

30.10.5.3 두 번째 관절 각도

두 번째 관절 각도는 두 각의 차이로 산출된다.

$\theta_2 = \arctan2(z', r') - \arctan2(l_3 \sin\theta_3, l_2 + l_3 \cos\theta_3)$

5. 다중 해

3자유도 공간 매니퓰레이터는 일반적으로 최대 4개의 해를 가진다.

어깨 구성	팔꿈치 구성	해의 수
전방	업	1
전방	다운	1
후방	업	1
후방	다운	1

실제 운용에서는 관절 한계에 의해 일부 해가 제외될 수 있다.

6. 작업 공간 특성

3자유도 공간 매니퓰레이터의 작업 공간은 다음과 같은 특성을 가진다.

6.1 회전 대칭

첫 번째 관절의 회전 대칭성으로 인해 작업 공간은 $z$ 축을 중심으로 회전 대칭이다.

6.2 3D 환형

평면에서의 환형이 $z$ 축을 중심으로 회전된 3D 환형 영역이 작업 공간이다.

6.3 경계

작업 공간의 외측 경계는 반지름 $l_2 + l_3$ 의 구, 내측 경계는 반지름 $|l_2 - l_3|$ 의 구의 회전 표면이다.

7. 학술적 활용

3자유도 공간 매니퓰레이터의 기하학적 역기구학은 다음과 같은 영역에 활용된다. 첫째, 단순한 공간 매니퓰레이터의 제어. 둘째, 6자유도 매니퓰레이터의 위치 결정 부분 해석. 셋째, 학술 교육과 연구의 표준 예시.

8. 학술적 의의

3자유도 공간 매니퓰레이터의 기하학적 해석은 평면 매니퓰레이터 해석을 3차원으로 자연스럽게 확장하며, 구형 손목을 가진 6자유도 매니퓰레이터의 위치 결정 부분 분석에 직접 활용된다. 이는 역기구학의 학술적 학습에서 중요한 단계이다.

9. 출처

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

10. 버전

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