Halcon|讀取3D相機點云數據

最近發現很多小伙伴在使用Halcon處理3D工業相機掃描結果的時候遇到了“如何讀取”的問題。一般的3D工業相機儲存數據的格式有txt格式、tif格式、csv格式、ply格式、ptx格式、bin格式、obj格式等。

txt格式

讀取txt文件生成3D模型一般需要分析txt文件的儲存格式，下圖是我使用的工業相機儲存的部分txt數據：

經過分析，前3列為X、Y、Z坐標，第4列到第6列為每一點的法線坐標nX、nY、nZ，第7列到第9列為灰度值。因此我們采用以下代碼重構3D模型：

open_file ('data.txt', 'input', XYZ) #打開文件
X :=[]
Y :=[]
Z :=[]
nX :=[]
nY :=[]
nZ :=[]
Gray :=[]
fread_line (XYZ, OutLine, IsEOF) #讀文件中一行的字符串
tuple_split (OutLine, ' ', Substrings) #根據空格分割一行的字符串
while (IsEOF==0) #將X Y Z nX nY nZ Gray分別存儲在不同的元組中X :=[X,Substrings[0]]Y :=[Y,Substrings[1]]Z :=[Z,Substrings[2]]nX :=[nX,Substrings[3]]nY :=[nY,Substrings[4]]nZ :=[nY,Substrings[5]]Gray :=[Gray,Substrings[6]]fread_line (XYZ, OutLine, IsEOF)tuple_split (OutLine, ' ', Substrings)
endwhile
close_file (XYZ) #關閉文件
tuple_number (X, NumberX) 
tuple_number (Y, NumberY) 
tuple_number (Z, NumberZ)  #將字符串轉化為數字
gen_object_model_3d_from_points (NumberX, NumberY, NumberZ, ObjectModel3D) #構建3D模型
visualize_object_model_3d (3600, ObjectModel3D, [], [], [], [], [], [], [], PoseOut) #顯示3D模型
代碼中的IsEOF參數為循環的判斷變量，當文件未到末尾時，IsEOF為0；當文件到達末尾時，IsEOF為1。

3D模型顯示結果如下：



注意：1、通過元組生成3D模型時，采用gen_object_model_3d_from_points算子；2、一些3D相機的txt文件的數據之間采用@相連，此時應使用@對字符串進行分割。
tif格式
tif圖片格式是工業相機損失較小的圖片格式。一般3D相機會將不同的數據保存在不同的tif圖片中。下圖是我使用的工業相機儲存的tif文件：



其中，PointCloud_X PointCloud_Y PointCloud_Z為將點云的XYZ坐標作為灰度值生成的圖片，NormalMap_X NormalMap_Y NormalMap_Z為將點云的XYZ法線坐標作為灰度值生成的圖片，Texture為一般的灰度圖片。可使用以下代碼重構3D模型：
read_image (PointcloudX, '0-400_IMG_PointCloud_X.tif') 
read_image (PointcloudY, '0-400_IMG_PointCloud_Y.tif')
read_image (PointcloudZ, '0-400_IMG_PointCloud_Z.tif') #分別讀取XYZ坐標
xyz_to_object_model_3d (PointcloudX, PointcloudY, PointcloudZ, ObjectModel3D) #生成3D模型
visualize_object_model_3d (3600, ObjectModel3D, [], [], [], [], [], [], [], PoseOut) #顯示3D模型


其中，讀取的PointcloudX PointcloudY PointcloudZ等圖片也可以先做Blob分析之后再合成3D模型。此時，若PointcloudX PointcloudY PointcloudZ的大小不一致，代碼：
xyz_to_object_model_3d (PointcloudX, PointcloudY, PointcloudZ, ObjectModel3D) 
生成的3D模型將以PointcloudX為準。

注意：與算子gen_object_model_3d_from_points作對比，當通過圖片生成3D模型時，采用xyz_to_object_model_3d算子。
Halcon直接讀取
我購買的工業相機可以直接采用以下代碼實時抓取數據，可以作為其他工業相機實施抓取數據的參考。
open_framegrabber ('PhoXi', 1, 1, 0, 0, 0, 0, 'default', -1, 'default', -1, 'false', 'default', '2018-08-034-LC3', -1, -1, AcqHandle) #打開相機
get_framegrabber_param (AcqHandle, 'revision', Revision) #得到相機參數
GrabDataItems:=['PointCloud', 'Texture', 'NormalMap', 'ConfidenceMap']
set_framegrabber_param (AcqHandle, 'grab_data_items', GrabDataItems) #設置相機參數
grab_data (ImageData, Region, Contours, AcqHandle, Data) #抓取數據
select_obj (ImageData, XYZ, 1) #選擇3維數據XYZ(點云坐標)
select_obj (ImageData, Texture, 2) #選擇1維度數據Texture
select_obj (ImageData, Normals, 3) #選擇3維數據Normals(法線)
select_obj (ImageData, Confidence, 4) #選擇1維數據Confidence
decompose3 (XYZ, XImage, YImage, ZImage) #將XYZ分解為X Y Z三通道
decompose3(Normals, nX, nY, nZ)  #將Normals分解為nX nY nZ三通道