攝像機數(shù)學模型采用小孔成像的原理,在笛卡兒空間中建立景物點與成像點之間的映射關(guān)系。令點P=(Xw,Yw,Zw)為像素p(u,v)投射在世界坐標系中的點,(u,v,1)是點p在像素坐標系中的齊次坐標;(Xw,Yw,Zw,1)是點 P 在世界坐標系中的 齊次坐標。那么兩個坐標的關(guān)系為RGB-D數(shù)據(jù)來自立體相機中RGB相機和 Depth相機,由于相機空間視角不同,兩組原始數(shù)據(jù)中RGB數(shù)值與深度數(shù)值不匹配。在標定立體相機的外參數(shù)后,建立RGB像素值與 Depth數(shù)值兩者之間的一一對應(yīng)關(guān)系。采用圖像閾值的點云分割基本思路:根據(jù)圖像像素和點云的對應(yīng)關(guān)系進行圖像分割,獲得目標區(qū)域點云。
立體相機中依據(jù) RGB 相機和Depth相機的外參數(shù),可以把Depth相機生成的點云轉(zhuǎn)換到相機坐標系下。參考棋盤格建立世界坐標系。利用靶標世界坐標系可實現(xiàn)一定程度的點云分割,其基本思路是:由于場景三維點云的空間尺度與世界坐標系的空間尺度具有一致性,通過建立世界坐標系并確定待測物體在世界坐標系中的空間區(qū)域,可分割映射到世界坐標系里的點云。如圖1(a)所示,pc(xc,yc,zc)為相機坐標系中的點云,Pw (Xw,Yw,Zw)是世界坐標系中的點云,由(1)式可得
如圖1(b)所示,由于靶標板(標定板)所指定的 坐標系相對于棋盤格角點所建立的世界坐標系有一 定的偏移,這里采用補償?shù)姆绞竭M行坐標系校正。設(shè)靶標的厚度為 Δz,世界坐標系原點在待測區(qū)域的X和Y軸的偏移分別為Δx 和Δy,補償偏移量Δl3×1=[Δx Δy Δz]T,則(6)式可進一步表示為參考前述的圖像閾值、靶標世界坐標系與點云區(qū)域的關(guān)系,為了突出目標區(qū)域以實現(xiàn)點云分割,可將點云的觀測視角旋轉(zhuǎn)至俯視角度(鳥瞰視角),如圖2所示,這樣可減少背景點云信息,使目標點云呈現(xiàn)更多信息,采用相機模型將點云投影至相機的圖像像素。在得到旋轉(zhuǎn)投影后場景的二維圖像后,采用圖像閾值分割的方法可快速地得到目標閾值范圍,還原后得到場景分割的目標點云。參考(6)式得到世界坐標系中的點云 Pwl(Xwl, Ywl,Zwl),將其變換到場景點云的俯視角時,有:

根據(jù)單目攝像機模型,可以得到點云對應(yīng)的二值圖像坐標為: