87 lines
1.4 KiB
Plaintext
87 lines
1.4 KiB
Plaintext
;>>>>> G54:A = +R8 <<<<<
|
|
;>>>>> G54:B = -R9 <<<<<
|
|
|
|
EXTERN SETKOS(INT)
|
|
|
|
DEFINE XSTART AS 20
|
|
DEFINE YSTART AS 20
|
|
DEFINE ZSTART AS 275
|
|
DEFINE XDIFF AS 600
|
|
DEFINE YDIFF AS 1000
|
|
DEFINE FEED_FAST AS 13000.0
|
|
DEFINE FEED_MESS AS 500.0
|
|
|
|
SETKOS(0)
|
|
TRAORI
|
|
G54
|
|
|
|
G90 G1 A0 B0 C10 F500
|
|
|
|
;P1
|
|
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R10=$AA_MW[Z]
|
|
STOPRE
|
|
G90 G1 X=XSTART+1 Y=YSTART Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R11=$AA_MW[Z]
|
|
STOPRE
|
|
G90 G1 X=XSTART Y=YSTART+1 Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R12=$AA_MW[Z]
|
|
STOPRE
|
|
M01
|
|
|
|
;P2
|
|
G90 G1 X=XSTART Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R20=$AA_MW[Z]
|
|
STOPRE
|
|
G90 G1 X=XSTART+1 Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R21=$AA_MW[Z]
|
|
STOPRE
|
|
G90 G1 X=XSTART Y=YSTART+YDIFF+1 Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R22=$AA_MW[Z]
|
|
STOPRE
|
|
M01
|
|
|
|
;P3
|
|
G90 G1 X=XSTART+XDIFF Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R30=$AA_MW[Z]
|
|
STOPRE
|
|
G90 G1 X=XSTART+XDIFF+1 Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R31=$AA_MW[Z]
|
|
STOPRE
|
|
G90 G1 X=XSTART+XDIFF Y=YSTART+YDIFF+1 Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R32=$AA_MW[Z]
|
|
STOPRE
|
|
M01
|
|
|
|
|
|
SETKOS(1)
|
|
|
|
|
|
; BERECHNE
|
|
R0=(R10+R11+R12)/3
|
|
R1=(R20+R21+R22)/3
|
|
R2=(R30+R31+R32)/3
|
|
|
|
R8=ATAN((R1-R0)/XDIFF)
|
|
R9=ATAN((R2-R1)/YDIFF)
|
|
|
|
M17
|