67 lines
910 B
Plaintext
67 lines
910 B
Plaintext
;-> 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
|