9.46 특수 유클리드군 SE(3)의 정의와 구조
1. 집합으로서의 정의
특수 유클리드군(Special Euclidean group) SE(3)은 3차원 유클리드 공간의 강체 변환(rigid body transformation)의 집합이다. 행렬 형태로는 다음과 같이 정의된다.
SE(3) = \left\{\begin{bmatrix}\mathbf{R} & \mathbf{t} \\ \mathbf{0}^T & 1\end{bmatrix} : \mathbf{R} \in SO(3),\ \mathbf{t} \in \mathbb{R}^3\right\}
여기서 \mathbf{R}은 회전 부분, \mathbf{t}는 병진 부분이다. SE(3)의 원소를 통상 동차 변환 행렬(homogeneous transformation matrix)이라 부른다.
2. 강체 변환으로서의 의미
SE(3)의 원소는 3차원 공간의 점 사이의 거리와 각도, 그리고 우/좌수성을 보존하는 모든 가능한 강체 변환을 망라한다. 형식적으로 사상 \mathbf{f}: \mathbb{R}^3 \to \mathbb{R}^3이 다음 두 조건을 만족할 때
- 거리 보존: \lVert \mathbf{f}(\mathbf{p}) - \mathbf{f}(\mathbf{q}) \rVert = \lVert \mathbf{p} - \mathbf{q} \rVert
- 방향 보존: 우수 좌표계가 우수 좌표계로 사상
이를 강체 변환이라 한다. 모든 강체 변환은 \mathbf{f}(\mathbf{p}) = \mathbf{R}\mathbf{p} + \mathbf{t}의 형태를 가지며, 이는 SE(3)의 원소와 일대일 대응한다.
3. 군 구조
SE(3)은 행렬 곱 연산에 관해 군을 이룬다. 군의 네 가지 공리를 차례로 확인한다.
3.1 닫힘
\mathbf{T}_1, \mathbf{T}_2 \in SE(3)이면 \mathbf{T}_1\mathbf{T}_2 \in SE(3).
\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}
회전 부분 \mathbf{R}_1\mathbf{R}_2 \in SO(3)이고 병진 부분 \mathbf{R}_1\mathbf{t}_2 + \mathbf{t}_1 \in \mathbb{R}^3이므로, 합성 결과 역시 동차 변환 형태를 유지한다.
3.2 결합 법칙
행렬 곱의 결합 법칙으로부터 자동으로 성립한다.
3.3 항등원
\mathbf{I}_4 = \begin{bmatrix}\mathbf{I}_3 & \mathbf{0} \\ \mathbf{0}^T & 1\end{bmatrix}
는 \mathbf{R} = \mathbf{I}_3, \mathbf{t} = \mathbf{0}인 경우의 동차 변환 행렬이며, 모든 점을 그대로 두는 항등 변환이다.
3.4 역원
\mathbf{T}^{-1} = \begin{bmatrix}\mathbf{R}^T & -\mathbf{R}^T\mathbf{t} \\ \mathbf{0}^T & 1\end{bmatrix} \in SE(3)
이며, 모든 동차 변환은 가역이다.
4. 비가환성
SE(3)은 가환군이 아니다. 일반적으로
\mathbf{T}_1\mathbf{T}_2 \neq \mathbf{T}_2\mathbf{T}_1
이며, 이는 회전의 비가환성과 회전이 병진에 작용하는 방식에 기인한다. 비가환성은 SE(3)의 본질적 성질이며, 매니퓰레이터 기구학과 자세 추정에서 변환의 적용 순서가 결과에 영향을 주는 원인이다.
5. 매니폴드 구조
SE(3)은 단순한 집합이 아니라 미분 가능한 매니폴드(manifold)이다. 회전 부분 SO(3)은 3차원 매니폴드이고, 병진 부분 \mathbb{R}^3은 3차원 벡터 공간이므로
\dim(SE(3)) = \dim(SO(3)) + \dim(\mathbb{R}^3) = 3 + 3 = 6
이 된다. 이는 3차원 강체 변환의 자연스러운 6자유도와 일치한다.
6. 위상 구조
6.1 연결성
SE(3)은 연결(connected) 매니폴드이다. SO(3)이 연결되어 있고 \mathbb{R}^3도 연결되어 있으므로 두 곱이 연결된다.
6.2 비컴팩트성
SE(3)은 컴팩트하지 않다. 회전 부분 SO(3)은 컴팩트이지만 병진 부분 \mathbb{R}^3이 무계(unbounded)이기 때문이다. 이는 강체가 무한히 멀리 이동할 수 있음을 반영한다.
6.3 단순 연결성
SE(3)은 단순 연결이 아니다. SO(3)의 위상적 비단순성이 그대로 SE(3)에 반영된다. 보편 피복(universal cover)이 존재하며, 이는 SE(3)의 이중 피복 군으로 구성된다.
7. 반직접 곱 구조
SE(3)은 SO(3)과 \mathbb{R}^3의 **반직접 곱(semidirect product)**이다.
SE(3) = SO(3) \ltimes \mathbb{R}^3
이는 회전 부분이 독립적인 SO(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)
으로 정의된다. 이는 행렬 곱의 결과와 정확히 일치한다. 직접 곱(direct product) SO(3) \times \mathbb{R}^3는 (\mathbf{R}_1\mathbf{R}_2, \mathbf{t}_1 + \mathbf{t}_2)의 형태로 정의되어 회전과 병진이 독립적으로 합성되지만, 이는 강체 변환의 자연스러운 합성과 다르다.
8. 리 군 구조
8.1 리 군으로서의 SE(3)
SE(3)은 리 군이다. 군 연산이 매끄러운 매니폴드 사상이며, 역원 사상도 매끄럽다. 따라서 미분 기하학과 리 군 이론의 도구를 적용할 수 있다.
8.2 리 대수 \mathfrak{se}(3)
SE(3)의 단위 원소에서의 접공간(tangent space at identity)이 리 대수 \mathfrak{se}(3)을 이룬다.
\mathfrak{se}(3) = \left\{\begin{bmatrix}[\boldsymbol{\omega}]_\times & \mathbf{v} \\ \mathbf{0}^T & 0\end{bmatrix} : \boldsymbol{\omega}, \mathbf{v} \in \mathbb{R}^3\right\}
여기서 [\boldsymbol{\omega}]_\times는 각속도 벡터의 반대칭 행렬, \mathbf{v}는 병진 속도이다. \mathfrak{se}(3)의 원소는 두 벡터의 쌍 \boldsymbol{\xi} = (\boldsymbol{\omega}, \mathbf{v})로 매개화되며, 이를 **트위스트(twist)**라 한다.
차원은
\dim(\mathfrak{se}(3)) = 6
이며 SE(3)의 차원과 일치한다.
8.3 지수 사상
리 대수와 리 군은 행렬 지수에 의해 연결된다.
\exp: \mathfrak{se}(3) \to SE(3)
트위스트 \boldsymbol{\xi} = (\boldsymbol{\omega}, \mathbf{v})에 대해
\exp\left(\begin{bmatrix}[\boldsymbol{\omega}]_\times & \mathbf{v} \\ \mathbf{0}^T & 0\end{bmatrix}\right) = \begin{bmatrix}\exp([\boldsymbol{\omega}]_\times) & \mathbf{J}_l(\boldsymbol{\omega})\mathbf{v} \\ \mathbf{0}^T & 1\end{bmatrix}
이며, 여기서 \mathbf{J}_l(\boldsymbol{\omega})는 SO(3)의 좌측 야코비안이다. 이 사상은 트위스트로부터 강체 변환을 산출하며, 스크류 운동(screw motion)의 해석적 표현이 된다.
9. 군 작용
SE(3)은 \mathbb{R}^3에 자연스럽게 작용한다. \mathbf{T} \in SE(3)과 \mathbf{p} \in \mathbb{R}^3에 대해
\mathbf{T}\cdot\mathbf{p} = \mathbf{R}\mathbf{p} + \mathbf{t}
이는 군 작용(group action)의 공리(항등원의 작용은 원점이고 합성과 작용이 호환됨)를 만족한다. 이 작용을 통해 SE(3)은 강체의 운동을 형식적으로 기술한다.
10. 메트릭과 측지선
10.1 좌-불변 메트릭
SE(3) 상의 좌-불변(left-invariant) 메트릭은 단위 원소의 접공간 \mathfrak{se}(3)의 내적으로부터 유도된다. 표준 내적
\langle (\boldsymbol{\omega}_1, \mathbf{v}_1), (\boldsymbol{\omega}_2, \mathbf{v}_2) \rangle = \boldsymbol{\omega}_1^T\mathbf{W}\boldsymbol{\omega}_2 + \mathbf{v}_1^T\mathbf{V}\mathbf{v}_2
는 두 양의 정부호 행렬 \mathbf{W}와 \mathbf{V}로 매개화된다. 이 메트릭은 회전과 병진의 단위가 다르므로 가중치 선택이 응용에 의존한다.
10.2 측지선
좌-불변 메트릭에 대한 SE(3)의 측지선은 단순한 회전과 병진의 결합이 아니라 일반적으로 스크류 운동에 해당한다. 이는 슈아세의 정리(Chasles’ theorem)와 직접 연관된다.
11. 로봇 공학에서의 의의
SE(3)은 로봇 공학의 핵심 수학적 구조이다.
11.1 기구학 표현
매니퓰레이터의 모든 링크의 자세, 모바일 로봇의 본체 자세, 카메라의 자세 등 모든 강체의 위치-방향 정보가 SE(3)의 원소로 표현된다.
11.2 변환의 통합
다양한 변환(좌표계 변환, 캘리브레이션, 카메라 외부 매개변수, 손-눈 캘리브레이션 결과)이 모두 SE(3)의 원소이며, 단일한 대수적 프레임워크에서 처리된다.
11.3 최적화
SLAM, 번들 조정, 손-눈 캘리브레이션, 등록 등의 비선형 최적화에서 변수가 SE(3)의 원소이다. 매개화는 통상 리 대수 \mathfrak{se}(3)의 지수 좌표를 사용한다.
11.4 필터링과 추정
칼만 필터의 확장된 형태에서 자세 상태가 SE(3) 매니폴드 상에서 진화하며, 오차 상태가 접공간 \mathfrak{se}(3)에서 정의된다.
11.5 제어
자세 제어와 임피던스 제어에서 목표 자세와 현재 자세의 오차가 SE(3)의 군 차이로 표현되며, 제어 입력이 \mathfrak{se}(3)의 원소로 산출된다.
12. SE(3) 이론의 발전 역사
SE(3)의 형식적 연구는 19세기 말 클리포드(William Kingdon Clifford), 슈아세(Michel Chasles), 슈투디(Eduard Study) 등의 작업으로 시작되었다. 20세기 후반 로봇 공학의 발전과 함께 머리(Richard Murray), 사스트리(Shankar Sastry), 박종우(Frank Park) 등이 매니퓰레이터 기구학에 리 군 이론을 본격적으로 도입하였으며, 현대의 로봇 공학 교재에서 표준적 프레임워크로 자리 잡았다.
13. 참고 문헌
- 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