ACS Y轴回零程序 项目实战(优化)版——增加设置左右软限位
代码INT yAxis = 1 REAL HomeVel REAL SearchLimitVel REAL HomeOffset REAL TimeOut HomeVel = 50 SearchLimitVel = 5 HomeOffset = 100 TimeOut = 50000 VEL(yAxis) = SearchLimitVel ACC(yAxis) = VEL(yAxis) * 10 DEC(yAxis) = VEL(yAxis) * 10 JERK(yAxis) = VEL(yAxis) * 100 KDEC(yAxis) = VEL(yAxis) * 100 MFLAGS(yAxis).#HOME= 0 FDEF(yAxis).#LL= 0 FDEF(yAxis).#RL= 0 FDEF(yAxis).#SLL= 0 FDEF(yAxis).#SRL= 0 ENABLE(yAxis) TILL MST(yAxis).#ENABLED, TimeOut IF ^MST(yAxis).#ENABLED GOTO FAULT_PROCESS END JOG/v(yAxis), 1 * SearchLimitVel TILL FAULT(yAxis).#RL, TimeOut IF ^FAULT(yAxis).#RL GOTO FAULT_PROCESS END JOG/v(yAxis),- 1 * SearchLimitVel TILL ^FAULT(yAxis).#RL IST(yAxis).#IND= 0 TILL IST(yAxis).#IND, TimeOut IF ^IST(yAxis).#IND GOTO FAULT_PROCESS END SET FPOS(