- *MARK点定位实现原理
- *变换前P1
- x0 := -15
- y0 :=-15
- *变换前P2
- x1 := 15
- y1 := 15
- *变化前的机械坐标
- X:=[-15,0,15,-15,0,15,-15,0,15]
- Y:=[-15,-15,-15,0,0,0,15,15,15]
- *x方向平移5,y方向平移6,旋转36° 考虑摆放便宜
- *变换后机械坐标值
- x2 := 1.682
- y2 := -14.952
- *变换后P2
- x3 := 8.318
- y3 := 26.952
- *计算角度
- angle_ll(x0,y0,x1,y1, x2, y2, x3, y3, Angle)
- tuple_deg (Angle, Deg)
- X1:=X-x0
- Y1:=Y-y0
- *创建单元矩阵
- hom_mat2d_identity (HomMat2DIdentity)
- hom_mat2d_translate (HomMat2DIdentity, x2, y2, HomMat2DTranslate)
- hom_mat2d_rotate (HomMat2DTranslate, Angle, x2, y2, HomMat2DRotate)
- *变换后的坐标X2 Y2转换好的坐标
- affine_trans_point_2d (HomMat2DRotate, X1, Y1, X2, Y2)
复制代码
|