法兰克FANUC探头宏程序内外分中程序

法兰克FANUC探头宏程序内外分中程序
%
O6999(TAN-TO)
(programmerO202146)
#5201=0
#5202=0
#5203=0
G69G40G49G80G90G17
G91G28Z0.0
M01
M06T14
M19
M100
M101
G00G90G55
G5.1Q0
G43H14Z100.

#551=1 (1 wai mian, 0 li miam)

#561=74 (X-X)
#562=147.4 (Y-Y)
#563=1 (tan zhen zhi jing D)
#564=-2 (tan z xiang XY tiao zheng)
#565=0.0 (tan z z zhi)
#566=-3. (tan xy zhi,z xiang ding wei)
#567=30. (an qian gao du)

IF[#551EQ0.]GOTO1010
#571=#5612+#5632 (X1-X1)
#572=#5622+#5632 (Y1-Y1)
#573=#5612+#564 (X2-X2-Z)
#575=0.3 (xy jin ge ju li)
#576=0.3 (z jin ge ju li)
GOTO1011
N1010
#571=#5612-#5632 (X1-X1)
#572=#5622-#5632 (Y1-Y1)
#573=#5612+#564 (X2-X2-Z)
#575=-0.3 (xy jin ge ju li)
#576=0.3 (z jin ge ju li)
N1011
N591
G65P9810X-6.Y[#572+#575] F8000.

G65P9810Z#566
G65P9811Y[#572]
#591=#136
G65P9810Z#567
N581
G65P9810X-#573Y57.
G65P9810Z[#565+#576]
G65P9811Z[#565]
#581=#137
G65P9810Z#567
N592
G65P9810X-[#571+#575]Y57.
G65P9810Z#566
G65P9811X-[#571]
#592=#135
G65P9810Z#567
N582
G65P9810X-#573Y-57.
G65P9810Z[#565+#576]
G65P9811Z[#565]
#582=#137
G65P9810Z#567
N593
G65P9810X-[#571+#575]Y-57.
G65P9810Z#566
G65P9811X-[#571]
#593=#135
G65P9810Z#567
N594
G65P9810X-6.Y-[#572+#575]
G65P9810Z#566
G65P9811Y-[#572]
#594=#136
G65P9810Z#567
N583
G65P9810X#573Y-57.
G65P9810Z[#565+#576]
G65P9811Z[#565]
#583=#137
G65P9810Z#567
N595
G65P9810X[#571+#575]Y-57.
G65P9810Z#566
G65P9811X[#571]

#595=#135
G65P9810Z#567
N584
G65P9810X#573Y57.
G65P9810Z[#565+#576]
G65P9811Z[#565]
#584=#137
G65P9810Z#567
N596
G65P9810X[#571+#575]Y57.
G65P9810Z#566
G65P9811X[#571]
#596=#135
G65P9810Z#567

#611=[[#592+#593]2+[#595+#596]2]2
#612=[#591+#594]2
#613=[#581+#582+#583+#584]4

#614=[#593+#595]2
#615=[#592+#596]2
#616=ATAN[[#614-#615]114.]
(JIAO DU)
#617=#595-#596

#1=1
#2=4
#3=580
#4=0.05
#5=#3+#1
#7=#3+#2
#585=#581
#586=#581
N101
IF[#[#5]GE#585]THEN#585=#[#5]
IF[#[#5]LE#586]THEN#586=#[#5]
#5=#5+1
IF[#5LE#7]GOTO101
#587=#585-#586

M05
G91G28Z0.
M100
M101

IF[ABS[#587]GT#4]THEN#3000=1 (P-M-DU- NG)
IF[ABS[#611]GT0.2]THEN#3000=1 (X-NG)
IF[ABS[#612]GT0.2]THEN#3000=1 (Y-NG)
IF[ABS[#613]GT0.2]THEN#3000=1 (Z-NG)
IF[ABS[#616]GT0.1]THEN#3000=1 (JIAO-DU NG)
IF[ABS[#617]GT0.1]THEN#3000=1 (ZHI-XIAN-DU NG)
#5201=#611
#5202=#612
#5203=#613
M30