31.27 6자유도 산업용 매니퓰레이터의 DH 모델링

6자유도 산업용 매니퓰레이터는 3차원 공간에서 엔드 이펙터의 위치와 자세를 독립적으로 제어할 수 있는 가장 보편적인 산업 로봇 구조이다. 일반적으로 세 회전 관절로 위치를 결정하고, 구형 손목을 이루는 세 회전 관절로 자세를 결정한다. 본 절에서는 6자유도 산업용 매니퓰레이터의 DH 모델링을 다룬다.

1. 6자유도 매니퓰레이터의 기구학적 구조

1.1 위치 결정부와 자세 결정부

6자유도 매니퓰레이터는 일반적으로 위치 결정부(처음 3자유도)와 자세 결정부(나머지 3자유도)로 구분된다. 위치 결정부는 안트로포모픽 팔 구조, 자세 결정부는 구형 손목 구조가 일반적이다.

1.2 주요 구성

주요 구성은 베이스, 어깨, 상박, 팔꿈치, 하박, 손목(3자유도)으로 이루어진다. 각 부분에 회전 관절이 배치된다.

1.3 안트로포모픽 구조

인간 팔과 유사한 안트로포모픽 구조는 KUKA KR 시리즈, ABB IRB 시리즈, FANUC M 시리즈 등 대부분의 산업용 매니퓰레이터에서 채택된다.

2. 좌표계 배치

2.1 기저 좌표계

좌표계 0의 $z$ 축은 수직 방향(관절 1의 축)이다. $x_0$ 축은 로봇의 전방 방향으로 설정된다.

2.2 어깨-팔꿈치 좌표계

좌표계 1, 2, 3은 어깨, 상박, 팔꿈치 부분에 배치되며, 위치 결정에 관여한다.

2.3 손목 좌표계

좌표계 4, 5, 6은 손목 부분에 배치된다. 구형 손목의 경우 세 관절 축이 한 점에서 교차한다.

3. DH 매개변수의 결정

3.1 관절 1

수직 축 주위의 회전이다. $z_1$ 은 관절 2 축(수평)이므로 $\alpha_1 = \pi/2$ 이다. 링크 오프셋 $d_1$ 은 기저 높이이다.

3.2 관절 2와 관절 3

관절 2와 관절 3의 축이 평행하므로 $\alpha_2 = 0$ 이다. 링크 길이 $a_2$ 는 상박의 길이이다.

3.3 관절 4

관절 4의 축은 관절 3의 축과 직교할 수 있다. 이는 손목 구조의 시작이다. $\alpha_3$ 의 값이 특정 각도로 설정된다.

3.4 관절 5와 관절 6

손목의 나머지 관절들은 구형 손목 구조에 맞추어 $\alpha$ 와 관련 매개변수가 설정된다.

4. DH 매개변수 표 (전형적 6자유도 매니퓰레이터)

4.1 표의 예시

전형적 6자유도 산업용 매니퓰레이터(구형 손목)의 DH 매개변수 표는 다음과 같다.

링크	$a_i$	$\alpha_i$	$d_i$	$\theta_i$	관절 유형
1	0	$\pi/2$	$d_1$	$\theta_1^*$	회전
2	$a_2$	0	0	$\theta_2^*$	회전
3	$a_3$	$\pi/2$	0	$\theta_3^*$	회전
4	0	$-\pi/2$	$d_4$	$\theta_4^*$	회전
5	0	$\pi/2$	0	$\theta_5^*$	회전
6	0	0	$d_6$	$\theta_6^*$	회전

4.2 매개변수의 물리적 의미

$d_1$ 은 기저 높이, $a_2$ 와 $a_3$ 는 상박과 하박의 길이, $d_4$ 는 팔꿈치로부터 손목 중심까지의 거리, $d_6$ 는 손목 중심으로부터 엔드 이펙터 팁까지의 거리이다.

4.3 구조의 다양성

제조사와 모델에 따라 DH 매개변수 값이 다르다. 예를 들어, 일부 모델은 $\alpha$ 의 부호가 반대이거나 추가 링크 오프셋이 있다.

5. 동차 변환 행렬

5.1 순차적 곱

전체 순기구학 변환은 여섯 변환 행렬의 순차적 곱이다.

${}^{0}\mathbf{T}_6 = \prod_{i=1}^{6} {}^{i-1}\mathbf{T}_i$

31.27.5.2 분리 구조

구형 손목 구조로 인해 전체 변환은 위치 결정부와 자세 결정부로 분리될 수 있다.

${}^{0}\mathbf{T}_6 = {}^{0}\mathbf{T}_3 \cdot {}^{3}\mathbf{T}_6$

여기서 ${}^{0}\mathbf{T}_3$ 는 손목 중심의 위치를, ${}^{3}\mathbf{T}_6$ 는 손목의 자세를 결정한다.

5.2 계산의 복잡성

전체 변환 행렬의 원소는 여러 관절 변수의 삼각 함수의 조합으로 표현되어 복잡하다. 기호 연산 소프트웨어(Mathematica, SymPy 등)가 활용된다.

6. 역기구학

6.1 Pieper의 원리

구형 손목을 가진 6자유도 매니퓰레이터는 Pieper의 원리에 의해 역기구학이 해석적으로 풀린다. 위치와 자세를 분리하여 풀 수 있다.

6.2 위치 역기구학

손목 중심의 위치를 먼저 계산하고, 여기서 처음 세 관절 변수 $\theta_1, \theta_2, \theta_3$ 를 역산한다.

6.3 자세 역기구학

위치 역기구학의 결과로 ${}^{0}\mathbf{R}_3$ 가 결정되면, 엔드 이펙터 자세로부터 ${}^{3}\mathbf{R}_6$ 를 계산한다. 이로부터 손목 관절 변수 $\theta_4, \theta_5, \theta_6$ 를 역산한다(ZYZ 오일러 각).

7. 특이점

7.1 어깨 특이점

관절 2의 축 상에 손목 중심이 있는 구성에서 $\theta_1$ 이 결정되지 않는 특이점이 발생한다.

7.2 팔꿈치 특이점

상박과 하박이 펴진 구성( $\theta_3 = 0$ ) 또는 겹친 구성에서 특이점이 발생한다.

7.3 손목 특이점

손목의 세 관절 축 중 두 축이 일치하는 구성( $\theta_5 = 0$ 또는 $\theta_5 = \pi$ )에서 짐벌 잠김 특이점이 발생한다.

8. 자코비안

8.1 자코비안 행렬의 크기

6자유도 매니퓰레이터의 자코비안은 $6 \times 6$ 행렬이다. 6자유도 엔드 이펙터 속도와 6개 관절 속도를 연관시킨다.

8.2 자코비안의 블록 구조

자코비안은 선형 속도와 각속도 성분으로 구성되는 블록 구조를 가진다.

8.3 조건수

자코비안의 조건수는 특이점 근방에서 급격히 증가하며, 이는 수치적 안정성 지표로 활용된다.

9. 상용 6자유도 매니퓰레이터의 예

9.1 제조사별 모델

주요 산업용 6자유도 매니퓰레이터는 다양한 제조사(ABB, KUKA, FANUC, Yaskawa, Universal Robots 등)에서 생산된다. 각 모델의 DH 매개변수는 제품 문서에 명시된다.

9.2 가반 하중

가반 하중(payload)에 따라 소형(수 kg), 중형(수십 kg), 대형(수백 kg)으로 분류된다.

9.3 작업 반경

작업 반경(reach)도 모델에 따라 수백 mm에서 수 m까지 다양하다.

10. 학술적 활용

본 절에서 다룬 6자유도 산업용 매니퓰레이터의 DH 모델링은 산업용 로봇의 학술적 분석, 설계, 시뮬레이션, 제어의 표준 예시이다. 다양한 제조사의 로봇 모델과의 호환성, 그리고 실제 산업 응용의 학술적 기반이 된다.

11. 출처

Pieper, D. L., The Kinematics of Manipulators Under Computer Control, Ph.D. Thesis, Stanford University, 1968.
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.
Siciliano, B., Sciavicco, L., Villani, L., and Oriolo, G., Robotics: Modelling, Planning and Control, Springer, 2009.
Paul, R. P., Robot Manipulators: Mathematics, Programming, and Control, MIT Press, 1981.

12. 버전

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