6.68 동차 변환 행렬의 합성과 역변환

1. 도입

동차 변환 행렬의 가장 중요한 두 연산은 합성(composition)과 역변환(inversion)이다. 합성은 여러 좌표계 변환을 차례로 적용하여 통합된 변환을 얻는 절차이며, 역변환은 한 좌표계 변환의 반대 방향 변환을 산출하는 절차이다. 이 두 연산은 강체 변환의 군 구조 SE(3)를 정의하는 본질적 구성 요소이며, 동차 변환의 강력함은 이들을 단일 행렬 연산으로 통일적으로 처리할 수 있다는 점에 있다. 이 절에서는 동차 변환의 합성 규칙과 그 의미, 합성의 결합 법칙과 비가환성, 역변환의 명시적 형태와 유도, 합성과 역변환의 결합, 수치적 안정성과 직교성 보존 문제, 그리고 로봇공학의 사슬 변환과 좌표계 변환에서의 활용을 다룬다.

2. 합성의 정의

두 동차 변환 행렬 T_1, T_2 \in SE(3)의 합성은 단순한 행렬 곱으로 정의된다.

T_{12} = T_1 T_2

이때 T_2가 먼저 적용되고 그 결과에 T_1이 적용되는 순서이며, 이는 행렬 곱의 좌측 우선 적용 약속과 일치한다. 합성의 의미는 적용 맥락에 따라 두 가지로 해석된다.

• 수동적 해석: 좌표계 변환의 사슬 결합. T_2가 좌표계 \{C\}를 \{B\}로 변환하고, T_1이 \{B\}를 \{A\}로 변환하면, T_1 T_2는 \{C\}를 \{A\}로 직접 변환한다.
• 능동적 해석: 강체 운동의 결합. 강체에 T_2의 운동을 적용한 후 T_1의 운동을 추가로 적용하는 결합 운동.

두 해석은 동일한 행렬 연산을 사용하지만, 응용에 따라 적절한 관점을 선택하여 사용한다.

3. 합성의 명시적 블록 형태

두 동차 변환 행렬을 블록 형태로 표현하면

T_1 = \begin{bmatrix} R_1 & \mathbf{t}_1 \\ \mathbf{0}^\top & 1 \end{bmatrix}, \qquad T_2 = \begin{bmatrix} R_2 & \mathbf{t}_2 \\ \mathbf{0}^\top & 1 \end{bmatrix}

이며, 그 곱은 다음과 같이 계산된다.

T_1 T_2 = \begin{bmatrix} R_1 R_2 & R_1 \mathbf{t}_2 + \mathbf{t}_1 \\ \mathbf{0}^\top & 1 \end{bmatrix}

이 형태로부터 다음을 알 수 있다.

• 합성된 변환의 회전 부분은 두 회전 행렬의 곱 R_1 R_2이다.
• 합성된 변환의 병진 부분은 T_2의 병진 벡터 \mathbf{t}_2가 먼저 T_1의 회전을 거친 후 T_1의 병진 벡터에 더해진 것이다.

이러한 비대칭적 결합 방식은 회전이 병진에 작용하는 반직접곱 구조를 반영한다.

4. 결합 법칙

행렬 곱의 결합 법칙으로부터 동차 변환의 합성도 결합 법칙을 만족한다.

(T_1 T_2) T_3 = T_1 (T_2 T_3)

이는 다관절 로봇의 사슬 변환에서 합성의 순서를 자유롭게 조합할 수 있게 하며, 부분 변환의 사전 계산과 캐싱을 통한 성능 최적화의 토대가 된다.

5. 비가환성

동차 변환의 합성은 일반적으로 가환적이지 않다.

T_1 T_2 \neq T_2 T_1

이는 회전이 병진에 결합되는 방식 때문이며, 회전 부분의 비가환성과 결합 형태의 비대칭성이 모두 기여한다. 비가환성의 한 예로, 같은 강체에 대해 90^\circ 회전과 단위 길이의 병진을 적용하는 두 가지 순서를 비교하면 결과가 명확히 다르다는 것을 확인할 수 있다.

비가환성의 시사점은 다음과 같다.

• 변환의 적용 순서는 항상 명시적으로 추적되어야 한다.
• 대칭적인 합성 알고리즘이 일반적으로 적용될 수 없다.
• 군 작용에 기반한 분석이 필요하다.

6. 항등 변환과 군 구조

항등 동차 변환 I_4는 합성의 단위원 역할을 한다.

T \cdot I_4 = I_4 \cdot T = T

또한 모든 동차 변환은 가역이다(아래 절에서 명시적으로 다룬다). 결합 법칙, 단위원의 존재, 역원의 존재로부터 동차 변환의 집합은 행렬 곱셈에 대해 군의 구조를 형성하며, 이 군이 특수 유클리드 군 SE(3)이다.

7. 역변환의 정의와 존재

동차 변환 행렬 T의 역변환은 다음 조건을 만족하는 행렬 T^{-1}로 정의된다.

T \cdot T^{-1} = T^{-1} \cdot T = I_4

회전 부분이 직교 행렬이고 마지막 행이 표준 형태이므로, 동차 변환은 항상 가역이며 그 역도 다시 동차 변환이다.

8. 역변환의 명시적 표현

동차 변환 행렬의 역행렬은 일반적인 행렬 역 계산 방법을 사용하지 않고 블록 구조로부터 직접 유도된다.

유도. T = \begin{bmatrix} R & \mathbf{t} \\ \mathbf{0}^\top & 1 \end{bmatrix}의 역을 T^{-1} = \begin{bmatrix} A & \mathbf{b} \\ \mathbf{0}^\top & 1 \end{bmatrix}의 형태로 가정하고 T \cdot T^{-1} = I_4를 적용하면

\begin{bmatrix} R & \mathbf{t} \\ \mathbf{0}^\top & 1 \end{bmatrix} \begin{bmatrix} A & \mathbf{b} \\ \mathbf{0}^\top & 1 \end{bmatrix} = \begin{bmatrix} RA & R\mathbf{b} + \mathbf{t} \\ \mathbf{0}^\top & 1 \end{bmatrix} = \begin{bmatrix} I & \mathbf{0} \\ \mathbf{0}^\top & 1 \end{bmatrix}

이로부터 RA = I, 즉 A = R^{-1} = R^\top이고, R\mathbf{b} + \mathbf{t} = \mathbf{0}, 즉 \mathbf{b} = -R^\top \mathbf{t}이다. 따라서

T^{-1} = \begin{bmatrix} R^\top & -R^\top \mathbf{t} \\ \mathbf{0}^\top & 1 \end{bmatrix}

이 명시적 표현은 회전 부분의 직교성에 의존하며, 일반 행렬 역 계산(O(n^3) 비용)에 비해 O(n^2)의 저비용으로 계산된다. 또한 수치적으로 매우 안정적이다.

9. 역변환의 기하학적 해석

역변환의 의미는 두 가지로 해석된다.

• 수동적 해석: 좌표계 변환의 반대 방향. T = {}^A T_B가 \{B\}를 \{A\}로 변환한다면, T^{-1} = {}^B T_A는 \{A\}를 \{B\}로 변환한다.
• 능동적 해석: 강체 운동의 반대 운동. 강체에 T의 운동을 적용한 후 T^{-1}를 적용하면 원래 자세로 복귀한다.

역변환의 회전 부분은 원래 회전의 전치(즉, 역방향 회전)이며, 병진 부분은 단순히 -\mathbf{t}가 아니라 -R^\top \mathbf{t}임에 주의한다. 이는 새 좌표계에서 본 원래 원점의 위치이다.

10. 합성과 역변환의 결합

합성과 역변환은 다음의 표준 군 항등식을 만족한다.

(T_1 T_2)^{-1} = T_2^{-1} T_1^{-1}

이는 행렬 군에서의 일반적 성질이며, 강체 변환의 합성에서도 그대로 성립한다. 직관적으로 두 변환을 결합한 후 역을 취하는 것은, 각 변환의 역을 반대 순서로 적용하는 것과 같다.

또한 다음의 항등식이 성립한다.

(T^{-1})^{-1} = T, \qquad I_4^{-1} = I_4, \qquad T \cdot T^{-1} = T^{-1} \cdot T = I_4

이러한 항등식들은 동차 변환을 군으로 다룰 때의 기본 도구이다.

11. 사슬 변환의 합성

다관절 로봇 또는 일반적인 좌표계 사슬에서 여러 변환의 합성은 다음과 같이 표현된다.

^0 T_n = {}^0 T_1 \cdot {}^1 T_2 \cdot {}^2 T_3 \cdots {}^{n-1} T_n

이 곱은 결합 법칙에 의하여 임의의 순서로 그룹화될 수 있으며, 이는 부분 변환의 사전 계산을 가능하게 한다. 사슬 변환의 합성은 매니퓰레이터의 정기구학과 운동학적 모델링의 가장 기본적인 연산이다.

12. 사슬 변환의 역과 부분 변환

사슬 변환의 일부분만 추출하는 연산도 합성과 역변환의 결합으로 표현된다. 예를 들어 \{i\}에서 \{j\}로의 변환(i < j)은

^i T_j = ({}^0 T_i)^{-1} \cdot {}^0 T_j

로 얻어지며, 이는 사슬 안의 임의의 두 좌표계 사이의 상대 변환을 추출하는 데 사용된다.

13. 수치적 고려와 직교성 유지

동차 변환을 반복적으로 합성하면 회전 부분의 수치적 직교성이 점차 손실될 수 있다. 부동 소수점 연산의 반올림 오차가 누적되어 R^\top R이 단위 행렬에서 약간 벗어날 수 있다. 이를 방지하기 위해 다음과 같은 정규화 절차가 사용된다.

• 그람-슈미트 정규 직교화: 회전 부분의 열들을 다시 정규 직교화한다.
• SVD 기반 투영: R = U V^\top 형태로 SVD를 수행하여 가장 가까운 직교 행렬을 얻는다.
• 쿼터니언 사용: 회전을 단위 쿼터니언으로 표현하면 정규화가 단일 노름 정규화로 단순화된다.

이러한 절차는 장시간 운영되는 시스템이나 반복적 변환 합성이 발생하는 상황에서 중요하다.

14. 합성과 역변환의 계산 비용

동차 변환의 합성과 역변환은 일반 4 \times 4 행렬의 동일한 연산보다 효율적이다.

실제 구현에서는 마지막 행이 항상 (0, 0, 0, 1)임을 활용하여 연산을 단순화할 수 있으며, 이는 실시간 응용에서 의미 있는 성능 향상을 제공한다.

15. 동차 변환의 거듭제곱과 보간

동차 변환의 거듭제곱은 합성의 반복으로 정의된다.

T^k = \underbrace{T \cdot T \cdots T}_{k \text{ times}}, \qquad T^{-k} = (T^{-1})^k

연속적 매개 변수 s \in \mathbb{R}에 대한 거듭제곱은 행렬 지수와 행렬 로그를 통해 정의된다.

T^s = \exp(s \log T)

이는 두 강체 자세 사이의 매끄러운 보간을 정의하는 자연스러운 도구이며, 측지선 보간과 직접 연결된다.

16. 로봇공학에서의 활용

16.1 매니퓰레이터의 정기구학

매니퓰레이터의 정기구학은 인접 링크 사이의 동차 변환의 사슬 합성으로 직접 표현된다. 각 인접 변환은 관절 변수에 의존하며, 결합 법칙은 부분 사슬의 사전 계산을 가능하게 한다. 이는 자코비안 계산과 동역학 계산에서 효율성을 위한 기반이 된다.

16.2 좌표계 사이의 변환 사슬

세계 좌표계, 베이스 좌표계, 도구 좌표계, 카메라 좌표계, 작업물 좌표계 등 다수의 좌표계가 동시에 사용되는 시스템에서는 임의의 두 좌표계 사이의 변환을 사슬 합성으로부터 도출한다. 합성과 역변환을 자유롭게 결합하여 필요한 변환을 효율적으로 계산할 수 있다.

16.3 자세 그래프 최적화

3차원 SLAM의 자세 그래프 최적화에서는 두 노드 사이의 상대 측정과 그 두 노드의 자세로부터 합성된 변환을 비교하여 잔차를 계산한다. 이때 합성과 역변환의 정확성이 최적화의 수렴성과 정확도에 직접적인 영향을 미친다.

16.4 손-눈 보정

매니퓰레이터의 말단에 부착된 카메라의 외부 매개 변수를 추정하는 손-눈 보정 문제는 다수의 동차 변환 합성과 역변환을 결합한 등식

T_A X = X T_B

로 형식화되며, 여기서 X가 미지의 변환이다. 합성과 역변환의 명확한 규칙이 이러한 등식의 유도와 해석에 본질적이다.

16.5 실시간 좌표 변환과 렌더링

시뮬레이터와 시각화 시스템에서는 매 시간 단계마다 다수의 좌표 변환이 합성되어 렌더링과 충돌 검사에 사용된다. 동차 변환의 효율적인 합성과 역변환은 실시간 성능을 위한 핵심 구성 요소이다.

16.6 시각적 주행 거리 측정과 다중 시점 정합

시각적 주행 거리 측정에서 연속된 카메라 자세는 인접 시점 사이의 상대 변환을 합성하여 갱신된다. 또한 다중 시점 정합에서는 각 시점 사이의 상대 변환을 합성하여 전역 자세를 산출한다. 이러한 절차는 합성의 누적 오차와 회전 부분의 직교성 유지에 주의를 요한다.

참고문헌

• Craig, J. J. (2017). Introduction to Robotics: Mechanics and Control (4th ed.). Pearson.
• Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2020). Robot Modeling and Control (2nd ed.). Wiley.
• Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2010). Robotics: Modelling, Planning and Control. Springer.
• Murray, R. M., Li, Z., & Sastry, S. S. (1994). A Mathematical Introduction to Robotic Manipulation. CRC Press.
• Lynch, K. M., & Park, F. C. (2017). Modern Robotics: Mechanics, Planning, and Control. Cambridge University Press.
• Selig, J. M. (2005). Geometric Fundamentals of Robotics (2nd ed.). Springer.
• Featherstone, R. (2008). Rigid Body Dynamics Algorithms. Springer.

Version: 1.0