通过图像相机进行mark定位,校正角度*
像素当量 = 视野大小 /图像分辨率
eg: mmpp = 显示区域大小(通过电机实际测量一半图像显示区域的大小)/图像分辨率(假设像素设置为1600*1400)
运用 : mark1 照相时电机位置 pos1_X pos1_Y
mark2 照相时电机位置 pos2_X pos2_Y
Mark1Px( mark1实际电机位置 X )= mmpp*( 偏差像素 - 800(一半屏幕分辨率))*(-1)+ pos1_X
Mark1Py ( mark1实际电机位置 Y )= mmpp*(偏差像素- 600(一半屏幕分辨率))*(-1)+ pos1_X
Mark2Px ( mark2实际电机位置 X) = mmpp*(偏差像素- 800(一半屏幕分辨率))*(-1)+ pos1_X
Mark2Py ( mark2实际电机位置 Y) = mmpp*(偏差像素- 800(一半屏幕分辨率))*(-1)+ pos1_X
角度: double angle = Math.Atan2((Mark2Py - Mark1Py), (Mark2Px - Mark1Px)) * 180 / Math.PI;