43 lines
542 B
Plaintext
43 lines
542 B
Plaintext
EXTERN SETKOS(INT)
|
|
|
|
DEFINE TOL_OFFZ AS 2.5
|
|
DEFINE TOL_CHECK AS 10
|
|
DEFINE XMESS AS 5
|
|
DEFINE YMESS AS 5
|
|
DEFINE ZMESS AS 250
|
|
R83=0
|
|
R90=0
|
|
|
|
SOFT
|
|
|
|
;HOME
|
|
SETKOS(0)
|
|
TRAORI
|
|
|
|
|
|
; FAHRE UBER TEIL
|
|
G54
|
|
F17000
|
|
G90 G1 CP X=R51+XMESS Y=R52+YMESS Z=ZMESS A0 B0 C0 G94
|
|
|
|
; PRUFE ISTHERE PART
|
|
R9=$A_DBR[20]
|
|
IF TOL_CHECK < (ZMESS+OFFSET_LASER_Z-R9)
|
|
R90=1
|
|
|
|
; BESTIMME HOHE BAUTEIL UND OFFSETZ_GRIFFHOHE
|
|
CYC_MESSZ1
|
|
R83 = (ZMESS+OFFSET_LASER_Z-R9)-WPR_Z
|
|
IF ABS(R83) > TOL_OFFZ
|
|
MSG("BAUTEILHOEHE AUSSERHALB TOLERANZ: "<<R83)
|
|
M0
|
|
ENDIF
|
|
|
|
ENDIF
|
|
|
|
SETKOS(1)
|
|
;HOME
|
|
|
|
|
|
M17
|