我的《视觉SLAM十四讲》:
- 版次:2017年3月第1版
- 印次:2018年11月第12次印刷
- 第13讲 建图
- 13.4.3 图像间的变换
- 342页
- 公式13.15 最后一项多了一个K
推导过程如下:
参考帧:
d
R
P
R
=
K
(
R
R
W
P
W
+
t
R
W
)
d_R P_R = K(R_{RW} P_W + t_{RW})
dRPR=K(RRWPW+tRW)
d R K − 1 P R = R R W P W + t R W d_R K^{-1} P_R = R_{RW} P_W + t_{RW} dRK−1PR=RRWPW+tRW
d R K − 1 P R − t R W = R R W P W d_R K^{-1} P_R - t_{RW} = R_{RW} P_W dRK−1PR−tRW=RRWPW
d R R R W T K − 1 P R − R R W T t R W = P W d_R R_{RW}^T K^{-1} P_R - R_{RW}^T t_{RW} = P_W dRRRWTK−1PR−RRWTtRW=PW
当前帧:
d
C
P
C
=
K
(
R
C
W
P
W
+
t
C
W
)
d_C P_C = K(R_{CW} P_W + t_{CW})
dCPC=K(RCWPW+tCW)
代入 P W P_W PW,
d C P C = K ( R C W P W + t C W ) d_C P_C = K(R_{CW} P_W + t_{CW}) dCPC=K(RCWPW+tCW)
d C P C = K R C W P W + K t C W d_C P_C = K R_{CW} P_W + K t_{CW} dCPC=KRCWPW+KtCW
d C P C = K R C W ( d R R R W T K − 1 P R − R R W T t R W ) + K t C W d_C P_C = K R_{CW} (d_R R_{RW}^T K^{-1} P_R - R_{RW}^T t_{RW}) + K t_{CW} dCPC=KRCW(dRRRWTK−1PR−RRWTtRW)+KtCW
d C P C = d R K R C W R R W T K − 1 P R − K R C W R R W T t R W + K t C W d_C P_C = d_R K R_{CW} R_{RW}^T K^{-1} P_R - K R_{CW} R_{RW}^T t_{RW} + K t_{CW} dCPC=dRKRCWRRWTK−1PR−KRCWRRWTtRW+KtCW