ACS T轴回零程序 项目实战

代码

INT tAxis = 3 REAL HomeVel REAL SearchLimitVel REAL HomeOffset REAL TimeOut HomeVel = 100 SearchLimitVel = 20 HomeOffset = 0 TimeOut = 50000 VEL(tAxis) = SearchLimitVel ACC(tAxis) = VEL(tAxis) * 10 DEC(tAxis) = VEL(tAxis) * 10 JERK(tAxis) = VEL(tAxis) * 100 KDEC(tAxis) = VEL(tAxis) * 100 WAIT 500 !IF isTHome = 1 ! ENABLE(tAxis) ! PTP/e(tAxis), 0 ! STOP !END MFLAGS(tAxis).#HOME= 0 ENABLE(tAxis) TILL MST(tAxis).#ENABLED, TimeOut IF ^MST(tAxis).#ENABLED GOTO FAULT_PROCESS END JOG/v(tAxis),- 1 * SearchLimitVel IST(tAxis).#IND= 0 TILL IST(tAxis).#IND, TimeOut IF ^IST(tAxis).#IND GOTO FAULT_PROCESS END SET FPOS(tAxis) = FPOS(tAxis) - IND(tAxis) + HomeOffset VEL(tAxis) = HomeVel ACC(tAxis) = VEL(tAxis) * 10 DEC(tAxis) = V