DMU50_MPF/MPF/ROB/CALIB/CALIB_WP_C.MPF
2025-03-24 13:36:24 +01:00

41 lines
534 B
Plaintext

;>>>>> G55:C = -R9 <<<<<
EXTERN SETKOS(INT)
DEFINE XSTART AS -60
DEFINE YSTART AS -25
DEFINE ZSTART AS 250
DEFINE YDIFF AS 50
DEFINE FEED_FAST AS 13000.0
DEFINE FEED_MESS AS 500.0
H1=ZSTART+OFFSET_LASER_Z-10
SETKOS(0)
TRAORI
G55
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
R0=$AA_MW[X]
STOPRE
M01
G90 G1 X=XSTART Y=YSTART+YDIFF Z=ZSTART F=FEED_FAST
G91 G1 X=150 F=FEED_MESS MEAS=1
STOPRE
R1=$AA_MW[X]
STOPRE
SETKOS(1)
; BERECHNE
R2=R1-R0
R9=ATAN(R2/YDIFF)
M17