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

66 lines
930 B
Plaintext

;>>>>> IN SETKOS.MPF:LASER <<<<<
;>>>>> $MC_ROBX_TTCFL_POS[0] = -X_L <<<<<
;>>>>> $MC_ROBX_TTCFL_POS[2] = -Y_L <<<<<
EXTERN SETKOS(INT)
DEFINE XSTART AS -70
DEFINE YSTART AS 630
DEFINE ZSTART AS 200
DEFINE XPROBE AS 250.0
DEFINE FEED_FAST AS 11000.0
DEFINE FEED_MESS AS 200.0
H1=370.0
R1=0
R2=0
R3=0
R4=0
SETKOS(0)
TRAORI
G54
G90 G1 A0 B0 C10 F1700
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
G91 G1 X=XPROBE F=FEED_MESS MEAS=1
STOPRE
R1=$AA_MW[X]
STOPRE
M01
G90 G1 A0 B0 C45 F1700
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
G91 G1 X=XPROBE F=FEED_MESS MEAS=1
STOPRE
R2=$AA_MW[X]
STOPRE
M01
G90 G1 A0 B0 C90 F1700
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
G91 G1 X=XPROBE F=FEED_MESS MEAS=1
STOPRE
R3=$AA_MW[X]
STOPRE
M01
G90 G1 A0 B0 C130 F1700
G90 G1 X=XSTART Y=YSTART Z=ZSTART F=FEED_FAST
G91 G1 X=XPROBE F=FEED_MESS MEAS=1
STOPRE
R4=$AA_MW[X]
STOPRE
M01
G90 G1 A0 B0 C0 F1700
HOME
SETKOS(1)
M17