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) #物理坐标仿射为图像坐标