9.47 SE(3)의 군 성질과 연산
1. 군의 기본 공리
특수 유클리드군 SE(3)이 군임을 확립하는 네 가지 공리는 다음과 같다. 군의 원소는 동차 변환 행렬이고, 군 연산은 행렬 곱이다.
1.1 닫힘(Closure)
두 동차 변환 행렬의 곱은 다시 동차 변환 행렬이다.
\mathbf{T}_1\mathbf{T}_2 = \begin{bmatrix}\mathbf{R}_1\mathbf{R}_2 & \mathbf{R}_1\mathbf{t}_2 + \mathbf{t}_1 \\ \mathbf{0}^T & 1\end{bmatrix} \in SE(3)
회전 부분이 SO(3)의 합성이고 병진 부분이 \mathbb{R}^3의 원소이므로 결과가 SE(3)의 정의를 만족한다.
1.2 결합 법칙(Associativity)
행렬 곱이 결합 법칙을 만족하므로
(\mathbf{T}_1\mathbf{T}_2)\mathbf{T}_3 = \mathbf{T}_1(\mathbf{T}_2\mathbf{T}_3)
이 자명하게 성립한다.
1.3 항등원(Identity)
\mathbf{R} = \mathbf{I}_3, \mathbf{t} = \mathbf{0}인 동차 변환
\mathbf{I}_4 = \begin{bmatrix}\mathbf{I}_3 & \mathbf{0} \\ \mathbf{0}^T & 1\end{bmatrix}
는 항등원이다. 모든 \mathbf{T} \in SE(3)에 대해 \mathbf{I}_4\mathbf{T} = \mathbf{T}\mathbf{I}_4 = \mathbf{T}가 성립한다.
1.4 역원(Inverse)
각 동차 변환 \mathbf{T} \in SE(3)에 대해 역원이 존재하며 다음의 닫힌 형태로 주어진다.
\mathbf{T}^{-1} = \begin{bmatrix}\mathbf{R}^T & -\mathbf{R}^T\mathbf{t} \\ \mathbf{0}^T & 1\end{bmatrix} \in SE(3)
회전 부분의 역이 SO(3)에 속하고 병진 부분이 \mathbb{R}^3에 속하므로 역원이 다시 SE(3)의 원소이다.
2. 군 연산의 자세한 분석
2.1 합성의 비대칭성
SE(3)의 군 연산은 회전과 병진 부분이 비대칭적으로 결합된다.
(\mathbf{R}_1, \mathbf{t}_1) \cdot (\mathbf{R}_2, \mathbf{t}_2) = (\mathbf{R}_1\mathbf{R}_2, \mathbf{R}_1\mathbf{t}_2 + \mathbf{t}_1)
회전 부분은 두 회전의 단순한 곱이지만, 병진 부분은 첫 번째 회전이 두 번째 병진에 작용한 후 첫 번째 병진과 합산된다. 이는 회전이 병진에 영향을 주는 반직접 곱 구조의 표현이다.
2.2 비가환성
SE(3)은 비가환군이다. 일반적으로
\mathbf{T}_1\mathbf{T}_2 \neq \mathbf{T}_2\mathbf{T}_1
이며, 가환성이 성립하는 경우는 다음의 특수한 상황으로 제한된다.
- 두 회전이 같은 축 주위의 회전이고 두 병진이 그 축에 평행한 경우
- 한쪽이 항등원인 경우
- 회전이 모두 항등이고 병진만 있는 경우(이때는 \mathbb{R}^3가 가환이므로 가환)
매니퓰레이터의 관절 운동이 일반적으로 가환하지 않은 이유가 이 비가환성에 있다.
3. 부분군
3.1 SO(3) 부분군
병진이 영인 동차 변환의 집합은 SE(3)의 부분군을 이룬다.
\{(\mathbf{R}, \mathbf{0}) : \mathbf{R} \in SO(3)\} \cong SO(3)
이는 원점을 고정하는 회전들의 부분군이며, 매니퓰레이터의 손목 회전이나 점 주위의 회전을 기술한다.
3.2 \mathbb{R}^3 부분군
회전이 항등인 동차 변환의 집합도 부분군을 이룬다.
\{(\mathbf{I}_3, \mathbf{t}) : \mathbf{t} \in \mathbb{R}^3\} \cong \mathbb{R}^3
이는 순수 병진들의 가환 부분군이다.
3.3 정상 부분군
\mathbb{R}^3 부분군은 SE(3)의 **정상 부분군(normal subgroup)**이다. 즉, 모든 \mathbf{T} \in SE(3)에 대해
\mathbf{T} \cdot (\mathbf{I}_3, \mathbf{t}) \cdot \mathbf{T}^{-1} = (\mathbf{I}_3, \mathbf{R}\mathbf{t})
이 다시 \mathbb{R}^3 부분군에 속한다. 이 정상성이 반직접 곱 구조의 본질적 성질이다.
반면 SO(3) 부분군은 정상이 아니다. 회전 부분군을 병진을 포함한 변환으로 켤레 시키면 일반적으로 회전과 병진을 모두 포함하는 결과가 나온다.
4. 켤레 작용과 공역(Adjoint) 표현
4.1 켤레 작용
\mathbf{T} \in SE(3)의 켤레 작용은 다른 변환에 다음과 같이 작용한다.
\mathrm{Conj}_\mathbf{T}(\mathbf{S}) = \mathbf{T}\mathbf{S}\mathbf{T}^{-1}
이는 \mathbf{S}를 \mathbf{T}의 좌표계에서 본 변환으로 해석할 수 있다.
4.2 공역 표현
리 대수 \mathfrak{se}(3) 상의 공역 표현 \mathrm{Ad}_\mathbf{T}: \mathfrak{se}(3) \to \mathfrak{se}(3)은 다음과 같이 정의된다.
\mathrm{Ad}_\mathbf{T}(\boldsymbol{\xi}) = \mathbf{T}\boldsymbol{\xi}^\wedge\mathbf{T}^{-1}
행렬 형태로
\mathrm{Ad}_\mathbf{T} = \begin{bmatrix}\mathbf{R} & \mathbf{0} \\ [\mathbf{t}]_\times\mathbf{R} & \mathbf{R}\end{bmatrix}
이는 트위스트 좌표계에서 본체 좌표계와 공간 좌표계 사이의 변환에 사용된다.
4.3 공역의 성질
공역 표현은 다음의 합성 규칙을 만족한다.
\mathrm{Ad}_{\mathbf{T}_1\mathbf{T}_2} = \mathrm{Ad}_{\mathbf{T}_1}\mathrm{Ad}_{\mathbf{T}_2}
이는 군 준동형 사상(group homomorphism)이며, SE(3)에서 GL(\mathfrak{se}(3))로의 사상이다.
5. 좌-/우-이동(Translation)
리 군 SE(3)에서 자연스러운 두 가지 작용이 정의된다.
5.1 좌-이동(Left Translation)
L_\mathbf{T}: SE(3) \to SE(3), \quad \mathbf{S} \mapsto \mathbf{T}\mathbf{S}
좌-이동은 \mathbf{S}를 왼쪽에서 \mathbf{T}로 곱하는 연산이다. 자세 추정에서 월드 좌표계 갱신에 해당한다.
5.2 우-이동(Right Translation)
R_\mathbf{T}: SE(3) \to SE(3), \quad \mathbf{S} \mapsto \mathbf{S}\mathbf{T}
우-이동은 본체 좌표계에서의 갱신에 해당한다.
자세 추정과 필터링에서 좌-이동과 우-이동의 구분은 매우 중요하며, 잘못 선택하면 좌표계 해석이 뒤바뀐다.
6. 군 작용으로서의 강체 변환
SE(3)은 \mathbb{R}^3에 작용한다.
\mathbf{T} \cdot \mathbf{p} = \mathbf{R}\mathbf{p} + \mathbf{t}
군 작용의 두 공리를 만족한다.
6.1 항등 작용
\mathbf{I}_4 \cdot \mathbf{p} = \mathbf{I}_3\mathbf{p} + \mathbf{0} = \mathbf{p}.
6.2 합성 호환
(\mathbf{T}_1\mathbf{T}_2) \cdot \mathbf{p} = \mathbf{T}_1 \cdot (\mathbf{T}_2 \cdot \mathbf{p})
이를 직접 확인하면
(\mathbf{R}_1\mathbf{R}_2)\mathbf{p} + (\mathbf{R}_1\mathbf{t}_2 + \mathbf{t}_1) = \mathbf{R}_1(\mathbf{R}_2\mathbf{p} + \mathbf{t}_2) + \mathbf{t}_1 = \mathbf{R}_1(\mathbf{T}_2 \cdot \mathbf{p}) + \mathbf{t}_1 = \mathbf{T}_1 \cdot (\mathbf{T}_2 \cdot \mathbf{p})
이 성립한다.
7. 군 연산의 미분 구조
7.1 좌-/우-자코비안
리 대수의 작은 섭동 \delta\boldsymbol{\xi}에 대해 리 군에서의 변화는 좌-/우-자코비안으로 기술된다. 좌-자코비안 \mathbf{J}_l은
\exp(\boldsymbol{\xi} + \delta\boldsymbol{\xi}) \approx \exp(\boldsymbol{\xi})\exp(\mathbf{J}_l^{-1}(\boldsymbol{\xi})\delta\boldsymbol{\xi})
의 관계로 정의되며, 야코비안의 해석적 형태를 가진다. 이 자코비안은 SE(3) 매니폴드에서의 미분과 비선형 최적화의 핵심 도구이다.
7.2 운동학적 미분
매니퓰레이터의 자코비안 행렬 \mathbf{J}(\boldsymbol{\theta})는 관절 변수의 변화 \dot{\boldsymbol{\theta}}를 말단 장치의 트위스트 \boldsymbol{\xi} = (\boldsymbol{\omega}, \mathbf{v})로 매핑한다.
\boldsymbol{\xi} = \mathbf{J}(\boldsymbol{\theta})\dot{\boldsymbol{\theta}}
이 자코비안은 SE(3) 군 구조와 자연스럽게 연결된다.
8. 군 연산의 효율적 구현
8.1 합성
동차 변환의 곱은 블록 단위로 효율적으로 계산될 수 있다.
- 회전 곱: 3 \times 3 행렬 곱 (27회 곱셈, 18회 덧셈)
- 병진 변환: \mathbf{R}_1\mathbf{t}_2 계산 (9회 곱셈, 6회 덧셈)
- 병진 합산: 3회 덧셈
총 약 36회 곱셈과 27회 덧셈으로 합성이 완료된다.
8.2 역
회전 부분의 전치(0 비용)와 -\mathbf{R}^T\mathbf{t} 계산(9회 곱셈, 6회 덧셈)으로 구성되며, 일반 4 \times 4 역행렬 계산보다 훨씬 효율적이다.
8.3 군 작용
점에 대한 변환 \mathbf{T}\mathbf{p}는 \mathbf{R}\mathbf{p} 계산(9회 곱셈, 6회 덧셈)과 \mathbf{t} 합산(3회 덧셈)으로 구성된다. 점이 많은 경우 회전 부분을 한 번 캐싱하고 각 점에 적용하는 것이 효율적이다.
9. SE(3)의 군 연산이 로봇 공학에서 가지는 의미
SE(3)의 군 구조는 단순한 수학적 형식이 아니라 실제 로봇 시스템의 동작을 결정한다.
- 변환 합성: 좌표계 연쇄, 매니퓰레이터 기구학
- 역변환: 좌표계 방향 전환, 카메라 외부 매개변수의 역해석
- 켤레 작용: 좌표계 변환을 통한 운동의 재해석
- 군 작용: 점, 선, 면의 변환
- 준동형: 외부 매개변수 갱신, 캘리브레이션 결과의 합성
이러한 연산의 군 구조적 일관성이 로봇 알고리즘의 정확성과 효율성을 보장한다.
10. 참고 문헌
- 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.
- Hall, B. C. (2015). Lie Groups, Lie Algebras, and Representations (2nd ed.). Springer.
- Barfoot, T. D. (2017). State Estimation for Robotics. Cambridge University Press.
- Sola, J., Deray, J., & Atchuthan, D. (2018). “A Micro Lie Theory for State Estimation in Robotics.” arXiv:1812.01537.
version: 1.0