通过图像相机进行mark定位,校正角度

通过图像相机进行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;

你可能感兴趣的:(工作笔记,定位,c#)