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