본 포스팅은 논문 A micro Lie theory for state estimation in robotics를 읽고 정리한 내용입니다.
아는 것이 많이 없어서 부족한 부분이 많습니다. 혹여나 틀린부분 있다면 지적해주시길 바랍니다!
DIFFERENTIATION RULES ON MANIFOLDS
앞에서 manifold에서의 derivation에 대해 정의했으니 성질에 대해서 알아보자
A. The chain rule
Manifold에서의 Jacobian chain rule
![](https://blog.kakaocdn.net/dn/s1Qqm/btrKuLq69g0/Sso9VveqsAYPffKkDIHUb1/img.png)
미적분학에 나온 chain rule과 비슷함
간단한 증명방법은 오른쪽 Jacobian 일 때 작은 $\boldsymbol{\tau}$에 대해 다음이 성립한다고 했었다.
![](https://blog.kakaocdn.net/dn/tjoRy/btrKvGinPYM/bDOjk66rXvpzlkUPs8P6T0/img.png)
그대로 적용해보면
![](https://blog.kakaocdn.net/dn/bHHN1X/btrKvPl2NAd/jeUJWwHwrdra2l8a5G9Nq1/img.png)
right,left cross Jacobian에 대해서도 성립한다
![](https://blog.kakaocdn.net/dn/bNRo1K/btrKuHoTSZy/ddZMN3lxzOunWANCVVh5dk/img.png)
간단하게 증명하자면
![](https://blog.kakaocdn.net/dn/nSFld/btrKvErmt6p/QJrSdsIKbamvIZYjom7DXK/img.png)
미적분학에서 배운 chain rule이랑 매우 유사한 형태임을 알 수 있다.
B. Elemetary Jacobian blocks
Jacobian의 몇가지 성질에 대해서 배운다
가볍게 보고 지나가자
1 ) Inverse
정의
![](https://blog.kakaocdn.net/dn/cyCEzq/btrKsO2YoU3/bkb43KgFpMWzc0Zdme5psk/img.png)
이용할 성질들
![](https://blog.kakaocdn.net/dn/Abl8U/btrKuTWQyL9/IGJGLU9MFKSVHh1UYPKmN1/img.png)
![](https://blog.kakaocdn.net/dn/bCFtiS/btrKvESrANI/NvXDK29dQ2Tm5ENxL6XWW0/img.png)
결과는
![](https://blog.kakaocdn.net/dn/bogpKn/btrKuxzZ40s/BwovoGo3PmT4SkGp46Hzj1/img.png)
2 ) Composition
정의
![](https://blog.kakaocdn.net/dn/xE0Wy/btrKvQywgzM/zWRBZJxOGGkqM3CyhZMxpK/img.png)
이용할 성질들
![](https://blog.kakaocdn.net/dn/cypSRV/btrKsFrJKBF/bN4O25coYBL92uW16rHrS0/img.png)
![](https://blog.kakaocdn.net/dn/cP1XvF/btrKuWlCD3t/V96kxRnv3UlQwAchUwQOpk/img.png)
결과는
![](https://blog.kakaocdn.net/dn/cB7HTk/btrKuw8RckG/OZtZDjpi6uv6snDq5ObQA0/img.png)
3 ) Jacobians of $\mathcal{M}$
manifold의 right Jacobian을 정의
![](https://blog.kakaocdn.net/dn/cZBV32/btrKxP6JzOB/Ah1rzL3QlTr959lNLU1Bq0/img.png)
$\mathbf{J}$ 아랫첨자로 r이 있는데 right라는 뜻임, 그리고 매우작은 $\delta\boldsymbol{\tau}$에 대해 다음이 성립
![](https://blog.kakaocdn.net/dn/AW49o/btrKuS4HTlg/L3bb8m88Qb4pCGMKrw3Ki0/img.png)
right 했으니 left도 하자
![](https://blog.kakaocdn.net/dn/bMbh63/btrKuS4HTmh/HkVs1Mrl3vHHsSEZzUg5LK/img.png)
이번엔 $\mathbf{J}$ 아랫첨자로 l이 있는데 left라는 뜻임, 그리고 매우작은 $\delta\boldsymbol{\tau}$에 대해 다음이 성립
![](https://blog.kakaocdn.net/dn/CgPMv/btrKsFywNu4/FlkfEobHzpv71yqUvoKh4k/img.png)
그리고 right의 성질과
![](https://blog.kakaocdn.net/dn/FkOXL/btrKvEyauoV/KvrxP7Mm9Atuag0ttK79mk/img.png)
left의 성질로
![](https://blog.kakaocdn.net/dn/cMNAtn/btrKvEdQYlD/ujNcKa9oh22ebCgXW5tsSk/img.png)
adjoint를 이끌어 낼 수 있다
![](https://blog.kakaocdn.net/dn/codqg1/btrKuHPTH4y/qzKMMbBoCPvXBEDjI60yk1/img.png)
또한 chain rule로 left와 right의 관계도 이끌어 낼 수 있음!
![](https://blog.kakaocdn.net/dn/UE63V/btrKvb30Q31/HTtTQXZe01BQa7KjcpgsjK/img.png)
4 ) Group action
![](https://blog.kakaocdn.net/dn/bWGr23/btrKvFRjm66/FAPdtbA7LhwMgzqhqbkX9k/img.png)
C. Useful, but deduced, Jacobian blocks
1 ) Log map
$\tau=\log (\mathcal{X})$에 대해
![](https://blog.kakaocdn.net/dn/wLZJ7/btrKsGqBRYo/Jd6UXGNkUmL4iQDWqT5xsk/img.png)
2 ) Plus and minus
![](https://blog.kakaocdn.net/dn/dkw9KV/btrKrrUtcOJ/CMVQKgAGPN5fK2kDn4N3C0/img.png)
그리고 $\mathcal{Z}=\mathcal{X}^{-1} \circ \mathcal{Y}$ 와 $\boldsymbol{\tau}=\mathcal{Y} \ominus \mathcal{X}=\log (\mathcal{Z})$가 주어졌을 때
![](https://blog.kakaocdn.net/dn/b22zje/btrKuIOL49p/TFBs1ovPmD5ntK6hFiu1WK/img.png)
첫번째 줄 증명
![](https://blog.kakaocdn.net/dn/lbNRI/btrKvdgtVVk/cxNZ3zRyikNkprlUQJ3V1K/img.png)
![](https://blog.kakaocdn.net/dn/dReplj/btrKvELD3ig/Vm1jepOkko9JQaYKwtGqgk/img.png)
'SLAM' 카테고리의 다른 글
A Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation (0) | 2022.08.30 |
---|---|
Visual-Inertial Odometry of Aerial Robots (0) | 2022.08.30 |
A micro Lie theory for state estimation in robotics (3) (0) | 2022.08.25 |
A micro Lie theory for state estimation in robotics (2) (0) | 2022.08.21 |
A micro Lie theory for state estimation in robotics (1) (0) | 2022.08.18 |