57 lines
868 B
Plaintext
57 lines
868 B
Plaintext
;-> 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
|