理解好圖像的點(diǎn)云拼接，需要從相機(jī)的模型說(shuō)起。理解相機(jī)的成像原理之后，便可更為深刻的理解圖像的點(diǎn)云如何拼接在一起。

首先說(shuō)下相機(jī)的概念與原理。

相機(jī)概念與原理

相機(jī)的作用：將三維世界中的坐標(biāo)點(diǎn)(單位為米)映射到二維圖像平面(單位為像素)。

通常我們見(jiàn)到的相機(jī)都是針孔相機(jī)，但是不是簡(jiǎn)單的 針孔，還有透鏡的畸變存在，所以在做圖像處理時(shí)要進(jìn)行畸變校正。

由于畸變的存在，我們?cè)谑褂孟鄼C(jī)之前都要進(jìn)行相機(jī)標(biāo)定。

目的就是求出內(nèi)參對(duì)于簡(jiǎn)單的應(yīng)用求出徑向畸變和切向畸變就夠了。

所謂的外參就是相機(jī)的位姿。

有了外參、內(nèi)參、圖像、深度信息 便可以把圖像中的點(diǎn)，轉(zhuǎn)到世界坐標(biāo)系下，并帶有RGB的顏色。就形成了所謂的點(diǎn)云。

相關(guān)的公式也很好理解 ，就是通過(guò)相似三角形的原理。

注意其中fx 、fy、 cx 、cy也就是相機(jī)的內(nèi)參了。在相機(jī)出廠時(shí)會(huì)給出。

理解了相機(jī)的概念與原理，來(lái)編輯代碼實(shí)現(xiàn)下。

Code實(shí)現(xiàn)

全部代碼

先放上全部代碼，再進(jìn)行分段講解

代碼講解

讀取對(duì)應(yīng)路徑下的彩色圖像、深度圖像、相機(jī)的位姿。

上面說(shuō)了，有了這三個(gè)量再加上相機(jī)內(nèi)參，就可以得到點(diǎn)云。

//相機(jī)內(nèi)參

傳說(shuō)中的相機(jī)內(nèi)參

//定義點(diǎn)云使用的格式

聲明pcl的格式創(chuàng)建一個(gè)點(diǎn)云，然后開(kāi)始for循環(huán)處理每一張圖片和對(duì)應(yīng)的深度圖片與相機(jī)位姿。

得到要處理的彩色圖像深度圖像對(duì)應(yīng)的pose，然后for循環(huán)處理每一個(gè)像素。

得到深度信息

通過(guò)：

這個(gè)公式得到相機(jī)坐標(biāo)系下的 x，y，z

相機(jī)坐標(biāo)系下的點(diǎn)通過(guò)坐標(biāo)變換轉(zhuǎn)到世界坐標(biāo)系下。

賦值點(diǎn)云的坐標(biāo)與顏色。

保存成點(diǎn)云文件。

責(zé)任編輯：lq6