;>>>>> 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