;-> AUTOWRITE IN G54:C IF NOT ZERO
;>>>>> G54:C = R19 <<<<<

EXTERN SETKOS(INT)

DEFINE TOL_ANGLE AS 4

DEFINE XSTART AS -100
DEFINE YSTART AS 15
DEFINE ZSTART AS 250
DEFINE YDIFF AS 1000
DEFINE FEED_FAST AS 13000.0
DEFINE FEED_MESS AS 500.0

H1=ZSTART+OFFSET_LASER_Z-2
R19=0

SETKOS(0)
SOFT
TRAORI
G54


;P1
G90 G1 A0 B0 C10 F500
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
G91 G1 X=150 F=FEED_MESS MEAS=1
STOPRE
R10=$AA_MW[X]
STOPRE
M01


;P2
G90 G1 X=XSTART Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
G91 G1 X=150 F=FEED_MESS MEAS=1
STOPRE
R11=$AA_MW[X]
STOPRE



; BERECHNE
R12=R11-R10
R19= - ATAN(R12/YDIFF)
STOPRE


; SETZE
IF ($P_UIFR[1,Z,RT] == 0)
    IF (ABS(R19) < TOL_ANGLE) 
        $P_UIFR[1,Z,RT] = R19; + $P_UIFR[1,Z,RT]
        STOPRE
    ELSE
        MSG("AUSSERHALB TOLERANZ, WERT C: " <<R19)
        M0
    ENDIF
ELSE
    MSG("G54:C NOT WRITTEN, RESET IT MANUALLY")
    M0
ENDIF


SETKOS(1)

M17