;-> AUTOWRITE IN G54:X,Y IF NOT ZERO
;>>>>> G54:X = R18 <<<<<
;>>>>> G54:Y = R19 <<<<<

EXTERN SETKOS(INT)

DEFINE TOL_MOVE AS 10

DEFINE XSTART AS 25
DEFINE YSTART AS 25
DEFINE ZSTART AS 250
DEFINE FEED_FAST AS 13000.0
DEFINE FEED_MESS AS 300.0

H1=ZSTART+OFFSET_LASER_Z-1.5
R18=0
R19=0

SETKOS(0)
SOFT
TRAORI
G54

;X
G90 G1 A0 B0 C-3 F500
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
G91 G1 X=-150 F=FEED_MESS MEAS=1
STOPRE
R18=$AA_MW[X]
STOPRE
M01

;Y
G90 G1 A0 B0 C-3 F500
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
G91 G1 Y=-150 F=FEED_MESS MEAS=1
STOPRE
R19=$AA_MW[Y]
STOPRE
M01


; SETZE
IF (ABS(R18) < TOL_MOVE) AND (ABS(R19) < TOL_MOVE) 
    $P_UIFR[1,X,TR] = R18 + $P_UIFR[1,X,TR]
    $P_UIFR[1,Y,TR] = R19 + $P_UIFR[1,Y,TR]
    STOPRE
ELSE
    MSG("AUSSERHALB TOLERANZ, WERTE X, Y: "<<R18 <<" " <<R19)
    M0
ENDIF

G90 G1 A0 B0 C0 F1700
SETKOS(1)

M17