我的《視覺SLAM十四講》:
- 版次:2017年3月第1版
- 印次:2018年11月第12次印刷
- 第13講 建圖
- 13.4.3 圖像間的變換
- 342頁
- 公式13.15 最後一項多了一個K
推導過程如下:
參考幀:
當前幀:
代入,
我的《視覺SLAM十四講》:
推導過程如下:
參考幀:
dRPR=K(RRWPW+tRW)
dRK−1PR=RRWPW+tRW
dRK−1PR−tRW=RRWPW
dRRRWTK−1PR−RRWTtRW=PW
當前幀:
dCPC=K(RCWPW+tCW)
代入PW,
dCPC=K(RCWPW+tCW)
dCPC=KRCWPW+KtCW
dCPC=KRCW(dRRRWTK−1PR−RRWTtRW)+KtCW
dCPC=dRKRCWRRWTK−1PR−KRCWRRWTtRW+KtCW
ICP算法是點雲配准算法,給出兩組點雲,可以計算出兩組點雲的位姿關係R、t。問題數學表達爲: 已知兩組點雲: 求R、t使