新代系统-坐标旋转宏程式（XY测量程序）

新代系统-坐标旋转宏程序（XY测量程序）

%@MACRO; //O1001(XY测量程序)

#11 := 30.; //(X宽度/2)
#12 := 60.; //(Y宽度/2)
#13 := -1.5; //(碰触XY时的Z坐标)
#14 := 2.; //(安全距离)
#15 := 3000; //(安全定位速度)
#16 := 10.; //(安全高度)
#17 := 0.86; //(玻璃厚度)
#19 := 0.02; //(玻璃厚度公差)
#20 := 0.02; //(XY公差)
#25 := 0.5; //(探针半径)

#22 := 55.; //(碰触X时的Y坐标 HOME)
#21 := 0.; //(碰触Y时的X坐标)

#31 := 25.; //(测玻璃厚度时的X坐标)
#32 := 55.; //(测玻璃厚度时的Y坐标)

#33 := 60.03 ; //(测高度 听筒高光时的Y坐标)
#34 := -59.94 ; //(测高度 HOME高光时的Y坐标)

#35=2. ;//(Q)

@700:=#25;
@701:=@700;
@706:=0.1;

G90;

G91G28Z0;
M6T1;

G90G00G59X0.Y#33;
G43H1Z5.;
M21;
G0C0.;
M80;//(PORBE ON);
G4X0.5;
WAIT();
;
;//(************************ Z-1)
@206:=#15;
@224:=0.;
@225:=#33 ;
G65P9810X@224 Y@225 F@206 ;
@226:=#14 ;
G65P9810Z@226 ;
@226:=#17 ;
@217:=#35 ;
G65P9811Z@226 Q@217;
@1011:=@142;
;//(************************ Z-2)
@225:=#34 ;
G65P9810 Y@225;
@226:=#17 ;
@217:=#35 ;
G65P9811 Z@226 Q@217;
@1012:=@142;

;//(************************ Y-1)
@206:=#15;
@224:=#21;
@225:=-#12-#14 ;
G65P9810X@224 Y@225 F@206 ;
@226:=#13 ;
G65P9810Z@226 ;
@225:=-#12 ;
@217:=#35 ;
G65P9811Y@225 Q@217;
@1001:=@141;
@226:=#16 ;
G65P9810Z@226 ;

G0C270.;

;//(************************ X+2)
@224:=#11+#14;
@225:=-#22 ;
G65P9810X@224 Y@225 ;
@226:=#13 ;
G65P9810Z@226 ;
@224:=#11 ;
@217:=#35 ;
G65P9811X@224 Q@217;
@1002:=@140;

;//(************************ X+3)
@224:=#11+#14;
@225:=#22 ;
G65P9810X@224 Y@225 ;
@226:=#13 ;
G65P9810Z@226 ;
@224:=#11 ;
@217:=#35 ;
G65P9811X@224 Q@217;
@1003:=@140;

@226:=#16 ;
G65P9810Z@226 ;

G0C180.;

;//(************************ Y+4)
@224:=#21;
@225:=#12+#14 ;
G65P9810X@224 Y@225 ;
@226:=#13 ;
G65P9810Z@226 ;
@225:=#12 ;
@217:=#35 ;
G65P9811Y@225 Q@217;
@1004:=@141;
@226:=#16 ;
G65P9810Z@226 ;

G0C90.;

;//(************************ X-5)
@224:=-#11-#14;
@225:=#22 ;
G65P9810X@224 Y@225 ;
@226:=#13 ;
G65P9810Z@226 ;
@224:=-#11 ;
@217:=#35 ;
G65P9811X@224 Q@217;
@1005:=@140;

;//(************************ X-6)
@224:=-#11-#14;
@225:=-#22 ;
G65P9810X@224 Y@225 ;
@226:=#13 ;
G65P9810Z@226 ;
@224:=-#11;
@217:=#35 ;
G65P9811X@224 Q@217;
@1006:=@140;

@226:=#16 ;
G65P9810Z@226 ;

//(PROBE OFF)
M81;

G91G28Z0;

WAIT();

IF ABS(@1001) > #20 THEN
GOTO202;
ELSEIF ABS(@1002)>#20 THEN
GOTO202;
ELSEIF ABS(@1003)>#20 THEN
GOTO202;
ELSEIF ABS(@1004)>#20 THEN
GOTO202;
ELSEIF ABS(@1005)>#20 THEN
GOTO202;
ELSEIF ABS(@1006)>#20 THEN
GOTO202;
END_IF;

WAIT();

#31 := (@1002+@1006)/2.+@1741+#20121;
#32 := (@1001+@1004)/2.+@1742+#20122;

#33 := (@1003+@1005)/2.+@1751+#20121;
#34 := (@1001+@1004)/2.+@1752+#20122;

G90;
G10L2P1X(#31)Y(#32);//(SET G54 XYZ #20021 2 3)
G10L2P2X(#33)Y(#34);//(SET G55 XYZ #20041 2 3)

#1 := 2.*#22;
#2 := (@1002+@1006)/2.;
#3 := (@1003+@1005)/2.;
@996:=ATAN((@1002-@1003)/#1);
@997:=ATAN((@1006-@1005)/#1);

IF #2 = #3 THEN
GOTO11;
ENDIF;

#4:=(#2-#3)/#1;
WAIT();
@999:=ATAN(#4);
GOTO12;
N11;
WAIT();
@999:=0;

//————–JIAODU————–
N12;
IF ABS(@999) > 0.09 THEN
GOTO200;
END_IF;
GOTO210;

N200;
ALARM (10001, “工件太斜”);
GOTO210;
N201;
ALARM (10002, “X 偏差过大”);
GOTO210;
N202;
ALARM (10003, “XY测量结果偏差过大”);
GOTO210;
N210;
M01;
M99;

———————————–

G68X0Y60.03R@999
XY:坐标之旋转中心;
R: 旋转角度,逆时针旋转为正值,顺时针旋转为负值,0度-360度.