ACS Z轴回零程序 项目实战

代码

INT zAxis = 2 REAL HomeVel REAL SearchLimitVel REAL HomeOffset REAL TimeOut HomeVel = 5 SearchLimitVel = 1 HomeOffset = 0 TimeOut = 50000 VEL(zAxis) = SearchLimitVel ACC(zAxis) = VEL(zAxis) * 10 DEC(zAxis) = VEL(zAxis) * 10 JERK(zAxis) = VEL(zAxis) * 100 KDEC(zAxis) = VEL(zAxis) * 100 MFLAGS(zAxis).#HOME= 0 FDEF(zAxis).#LL= 0 FDEF(zAxis).#RL= 0 FDEF(zAxis).#SLL= 0 FDEF(zAxis).#SRL= 0 ENABLE(zAxis) TILL MST(zAxis).#ENABLED, TimeOut IF ^MST(zAxis).#ENABLED GOTO FAULT_PROCESS END JOG/v(zAxis),- 1 * SearchLimitVel TILL FAULT(zAxis).#LL, TimeOut IF ^FAULT(zAxis).#LL GOTO FAULT_PROCESS END JOG/v(zAxis), 1 * SearchLimitVel TILL ^FAULT(zAxis).#LL IST(zAxis).#IND= 0 TILL IST(zAxis).#IND, TimeOut IF ^IST(zAxis).#IND GOTO FAULT_PROCESS END SET FPOS(zAx