15.27 공간 매니퓰레이터의 라그랑주 해석
1. 개요
공간 매니퓰레이터는 3차원 공간에서 운동하는 매니퓰레이터이다. 평면 매니퓰레이터에 비해 분석이 더 복잡하지만 같은 라그랑주 방법이 적용된다. 본 절에서는 공간 매니퓰레이터의 라그랑주 해석을 다룬다.
2. 공간 매니퓰레이터의 특성
2.1 자유도 운동
공간 매니퓰레이터의 말단은 6자유도(3자유도 위치 + 3자유도 방향)의 운동이 가능하다. 따라서 일반적으로 6개 이상의 자유도를 가진다.
2.2 회전과 병진의 결합
각 관절이 링크의 회전과 병진을 모두 일으킨다. 이로 인해 동역학이 평면 경우보다 복잡하다.
2.3 표준 구조
산업 매니퓰레이터의 표준 구조는 6자유도 직렬 매니퓰레이터이다. 처음 3개 관절이 위치를, 마지막 3개 관절이 방향을 결정하는 구조가 일반적이다.
3. 좌표계의 설정
3.1 디나비트-하르텐베르크 표기법
공간 매니퓰레이터의 운동학은 일반적으로 디나비트-하르텐베르크(DH) 표기법으로 정의된다. 각 링크에 대해 4개의 매개 변수가 정의된다.
- a_i: 링크 길이
- \alpha_i: 링크 비틀림각
- d_i: 관절 거리
- \theta_i: 관절 각도
3.2 동차 변환
각 링크의 동차 변환은 DH 매개 변수의 함수로 표현된다.
{}^{i-1}\mathbf{T}_i = \text{Rot}_z(\theta_i)\text{Trans}_z(d_i)\text{Trans}_x(a_i)\text{Rot}_x(\alpha_i)
4. 자코비안의 계산
4.1 정의
각 링크의 질량 중심에 대한 선속도 및 각속도 자코비안이 계산된다.
4.2 회전 관절의 자코비안
회전 관절 j가 링크 i의 운동에 미치는 영향은 다음과 같다.
선속도
\mathbf{J}_{v,i}^{(j)} = {}^{0}\mathbf{z}_{j-1} \times ({}^{0}\mathbf{r}_{c,i} - {}^{0}\mathbf{r}_{j-1})
각속도
\mathbf{J}_{\omega,i}^{(j)} = {}^{0}\mathbf{z}_{j-1}
여기서 {}^{0}\mathbf{z}_{j-1}은 관절 j의 회전축이고 {}^{0}\mathbf{r}_{j-1}은 관절 j의 위치이다.
4.3 직선 관절의 자코비안
직선 관절 j의 경우
\mathbf{J}_{v,i}^{(j)} = {}^{0}\mathbf{z}_{j-1}, \quad \mathbf{J}_{\omega,i}^{(j)} = \mathbf{0}
5. 운동 에너지의 계산
5.1 링크별 운동 에너지
각 링크의 운동 에너지는 다음과 같다.
T_i = \frac{1}{2}m_i\Vert\mathbf{v}_{c,i}\Vert^2 + \frac{1}{2}\boldsymbol{\omega}_i^T\bar{\mathbf{I}}_i\boldsymbol{\omega}_i
여기서
\mathbf{v}_{c,i} = \mathbf{J}_{v,i}\dot{\mathbf{q}}, \quad \boldsymbol{\omega}_i = \mathbf{J}_{\omega,i}\dot{\mathbf{q}}
\bar{\mathbf{I}}_i는 기저 좌표계에서의 관성 텐서이다.
5.2 관성 텐서의 변환
링크의 좌표계에서의 관성 텐서 \mathbf{I}_i는 기저 좌표계로 변환된다.
\bar{\mathbf{I}}_i = {}^{0}\mathbf{R}_i \mathbf{I}_i {}^{0}\mathbf{R}_i^T
이는 회전 운동 에너지 계산에 사용된다.
5.3 총 운동 에너지
T = \sum_{i=1}^{n}T_i = \frac{1}{2}\dot{\mathbf{q}}^T\mathbf{M}(\mathbf{q})\dot{\mathbf{q}}
여기서 \mathbf{M}(\mathbf{q})는 관성 행렬이다.
6. 위치 에너지의 계산
6.1 중력 위치 에너지
U(\mathbf{q}) = -\sum_{i=1}^{n}m_i \mathbf{g}_0^T {}^{0}\mathbf{r}_{c,i}(\mathbf{q})
여기서 \mathbf{g}_0 = (0, 0, -g)^T이다.
7. 라그랑지언과 운동 방정식
7.1 라그랑지언
L = T - U = \frac{1}{2}\dot{\mathbf{q}}^T\mathbf{M}(\mathbf{q})\dot{\mathbf{q}} + \sum_{i=1}^{n}m_i\mathbf{g}_0^T{}^{0}\mathbf{r}_{c,i}(\mathbf{q})
7.2 운동 방정식
라그랑주 방정식을 적용하면 표준 형식의 동역학 방정식이 얻어진다.
\mathbf{M}(\mathbf{q})\ddot{\mathbf{q}} + \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q}) = \boldsymbol{\tau}
8. 자유도 산업 매니퓰레이터의 예
8.1 표준 구조
6자유도 산업 매니퓰레이터는 일반적으로 다음의 구조를 가진다.
- 1번 관절: 기저 회전 (요)
- 2번 관절: 어깨 (피치)
- 3번 관절: 팔꿈치 (피치)
- 4번 관절: 손목 회전
- 5번 관절: 손목 굽힘
- 6번 관절: 손목 비틀림
8.2 분석
이러한 매니퓰레이터의 라그랑주 해석은 위의 절차를 따른다. 결과 운동 방정식은 매우 복잡하므로 기호 계산 도구가 자주 사용된다.
8.3 자세 의존성
관성 행렬, 코리올리/원심력 행렬, 중력 벡터가 모두 자세에 강하게 의존한다.
9. 자동화
9.1 기호 계산 도구
기호 계산 도구를 사용하여 운동 방정식을 자동으로 유도할 수 있다.
9.2 동역학 라이브러리
매니퓰레이터 동역학 라이브러리는 운동학 모형으로부터 동역학 함수를 자동으로 계산한다.
9.3 URDF
URDF(Unified Robot Description Format)는 매니퓰레이터의 운동학과 동역학 매개 변수를 표현하는 표준 형식이다.
10. 검증
10.1 분석적 검증
단순한 자세나 운동에서 결과를 분석적으로 확인한다.
10.2 수치 검증
뉴턴-오일러 알고리즘과 비교하여 결과의 정확성을 확인한다.
10.3 에너지 보존
자유 운동에서 총 에너지가 보존되어야 한다.
11. 본 절의 의의
본 절은 공간 매니퓰레이터의 라그랑주 해석을 다루었다. 이는 매니퓰레이터의 정확한 동역학 모형 도출의 표준 방법이며, 산업 매니퓰레이터의 분석과 제어에 활용된다.
12. 참고 문헌
- Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2020). Robot Modeling and Control (2nd ed.). Wiley.
- Murray, R. M., Li, Z., & Sastry, S. S. (1994). A Mathematical Introduction to Robotic Manipulation. CRC Press.
- Featherstone, R. (2008). Rigid Body Dynamics Algorithms. Springer.
- Craig, J. J. (2005). Introduction to Robotics: Mechanics and Control (3rd ed.). Pearson.
version: 1.0