自定义测量循环

winzhi · 发表于 2023-12-28 09:11:46

子程序1

PROC SUB1(REAL _XYZ , REAL _VALVE , REAL _FEED)
DEF REAL _X_BACK , _Y_BACK , _Z_BACK
_X_BACK=$AA_IW[X]
_Y_BACK=$AA_IW[Y]
_Z_BACK=$AA_IW[Z]
STOPRE
;
IF _XYZ==1
R31=0
MEAS=1 G1 X=_VALVE F=_FEED
STOPRE
IF $AC_MEA[1]==0
      LOOP
         MSG("PROBE X FALSE")
         M0
      ENDLOOP
ENDIF
STOPRE
R31=$AA_IM[X]
STOPRE
G1 X=_X_BACK
ENDIF
;
IF _XYZ==2
R32=0
MEAS=1 G1 Y=_VALVE F=_FEED
STOPRE
IF $AC_MEA[1]==0
      LOOP
         MSG("PROBE Y FALSE")
         M0
      ENDLOOP
ENDIF
STOPRE
R32=$AA_IM[Y]
STOPRE
G1 Y=_Y_BACK
ENDIF
;
IF _XYZ==3
R33=0
MEAS=1 G1 Z=_VALVE F=_FEED
STOPRE
IF $AC_MEA[1]==0
      LOOP
         MSG("PROBE Z FALSE")
         M0
      ENDLOOP
ENDIF
STOPRE
R33=$AA_IM[Z]
STOPRE
G1 Z=_Z_BACK
ENDIF
;
M17
;$AC_MEA[n] 0=FAULSE 1=TURE

winzhi · 发表于 2023-12-28 09:12:09

子程序2

PROC SUB2(REAL _XYZ , REAL _VALVE , REAL _FEED)
DEF REAL _X_BACK , _Y_BACK , _Z_BACK
_X_BACK=$AA_IW[X]
_Y_BACK=$AA_IW[Y]
_Z_BACK=$AA_IW[Z]
STOPRE
;
IF _XYZ==1
MEAS=1 G1 X=_VALVE F=_FEED
STOPRE
IF $AC_MEA[1]==1
      LOOP
         MSG("PROBE X FALSE")
         M0
      ENDLOOP
ENDIF
STOPRE
ENDIF
;
IF _XYZ==2
MEAS=1 G1 Y=_VALVE F=_FEED
STOPRE
IF $AC_MEA[1]==1
      LOOP
         MSG("PROBE Y FALSE")
         M0
      ENDLOOP
ENDIF
STOPRE
ENDIF
;
IF _XYZ==3
MEAS=1 G1 Z=_VALVE F=_FEED
STOPRE
IF $AC_MEA[1]==1
      LOOP
         MSG("PROBE Z FALSE")
         M0
      ENDLOOP
ENDIF
STOPRE
ENDIF
;
M17
;$AC_MEA[n] 0=FAULSE 1=TURE

winzhi · 发表于 2023-12-28 09:12:26

一级子程序
PROC SUB0(REAL _XYZ , REAL _VALVE , REAL _FEED , REAL _SAFETY)
;$AC_MEA[n] 0=FAULSE 1=TURE
;
EXTERN SUB1(REAL,REAL,REAL) ;(X/Y/Z , absolute valve)
EXTERN SUB2(REAL,REAL,REAL) ;(X/Y/Z , absolute valve)
CASE _SAFETY OF 0 GOTOF ST1 1 GOTOF ST2
STOPRE
ST1:
;SUB1(_XYZ,_VALVE,_FEED)

ROBE
;SUB2(_XYZ,_VALVE,_FEED) ;SAFETY MOVE
SUB1(_XYZ,_VALVE,_FEED)

ROBE
STOPRE
M17
ST2:
;SUB1(_XYZ,_VALVE,_FEED)

ROBE
;SUB2(_XYZ,_VALVE,_FEED) ;SAFETY MOVE
SUB2(_XYZ,_VALVE,_FEED) ;SAFETY MOVE
STOPRE
M17

winzhi · 发表于 2023-12-28 09:13:09

运行测试的主程序

DEF REAL _XYZ , _VALVE , _FEED , _SAFETY
EXTERN SUB0(REAL,REAL,REAL,REAL)
;-----------------------
G510G0X0Y5.G90
Z100.D1
;Z
_XYZ=3
_VALVE=0
_FEED=10000
_SAFETY=1 ;SAFETY MOVE ( 0=OFF , 1=ON )
;SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
M01
;Y
_XYZ=2
_VALVE=-5
_FEED=500
_SAFETY=0 ;SAFETY MOVE ( 0=OFF , 1=ON )
;SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
M01
;X
_XYZ=1
_VALVE=30
_FEED=10000
_SAFETY=1 ;SAFETY MOVE ( 0=OFF , 1=ON )
;SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
M01
;Y
_XYZ=2
_VALVE=-5
_FEED=500
_SAFETY=0 ;SAFETY MOVE ( 0=OFF , 1=ON )
;SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
SUB0(_XYZ,_VALVE,_FEED,_SAFETY)
M01
G75Z0
M2

winzhi · 发表于 2023-12-28 09:14:22

PROBE_LELE_V5.DIR.zip (3.06 KB, 下载次数: 0)

		自动登录	找回密码
密码			立即注册