55 lines
756 B
Plaintext
55 lines
756 B
Plaintext
;>>>>> G54:A = +R8 <<<<<
|
|
;>>>>> G54:B = -R9 <<<<<
|
|
|
|
EXTERN SETKOS(INT)
|
|
|
|
DEFINE XSTART AS -50
|
|
DEFINE YSTART AS 15
|
|
DEFINE ZSTART AS 290
|
|
DEFINE XDIFF AS 600
|
|
DEFINE YDIFF AS 1000
|
|
DEFINE FEED_FAST AS 13000.0
|
|
DEFINE FEED_MESS AS 500.0
|
|
|
|
SETKOS(0)
|
|
TRAORI
|
|
G54
|
|
|
|
;P1
|
|
G90 G1 A0 B0 C10 F500
|
|
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R0=$AA_MW[Z]
|
|
STOPRE
|
|
M01
|
|
|
|
;P2
|
|
G90 G1 A0 B0 C10 F500
|
|
G90 G1 X=XSTART Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R1=$AA_MW[Z]
|
|
STOPRE
|
|
M01
|
|
|
|
;P3
|
|
G90 G1 A0 B0 C10 F500
|
|
G90 G1 X=XSTART+XDIFF Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
|
|
G91 G1 Z=-150 F=FEED_MESS MEAS=1
|
|
STOPRE
|
|
R2=$AA_MW[Z]
|
|
STOPRE
|
|
M01
|
|
|
|
|
|
SETKOS(1)
|
|
|
|
|
|
|
|
; BERECHNE
|
|
R8=ATAN((R1-R0)/XDIFF)
|
|
R9=ATAN((R2-R1)/YDIFF)
|
|
|
|
M17
|