halcon坐標轉換（機器人坐標轉換用）

#圖像坐標
r:=[431, 355, 507, 53, 507]
c:=[505, 543, 316, 127, 883]
#物理坐標（例如機器人坐標）
r1:=[0, 2.0, -2.0, 10, -2.0]
c1:=[0, 1.0, -5.0, -10, 10]

row:=670
col:=789
vector_to_hom_mat2d (r, c, r1,c1 , HomMat2D)
affine_trans_point_2d (HomMat2D, row,col, Qx, Qy)   #圖像坐標仿射為物理坐標（例如機器人坐標）

hom_mat2d_invert (HomMat2D, HomMat2DInvert)
affine_trans_point_2d (HomMat2DInvert, Qx, Qy, Px, Py) #物理坐標仿射為圖像坐標