ACS X轴回零程序 项目实战版

代码INT iAxis REAL HomeVel REAL SearchLimitVel REAL HomeOffset REAL timeout iAxis 0 HomeVel 5 SearchLimitVel 10 HomeOffset 157 timeout 50000 VEL(iAxis) SearchLimitVel ACC(iAxis) VEL(iAxis) * 10 DEC(iAxis) VEL(iAxis) * 10 JERK(iAxis) VEL(iAxis) * 100 KDEC(iAxis) VEL(iAxis) * 100 MFLAGS(iAxis).#HOME 0 FDEF(iAxis).#LL 0 FDEF(iAxis).#RL 0 ENABLE (iAxis) TILL MST(iAxis).#ENABLED,timeout IF ^ MST(iAxis).#ENABLED GOTO FAULT_PROCESS END !IF ^MFLAGS(iAxis).#BRUSHOK ! COMMUT(iAxis) ! TILL MFLAGS(iAxis).#BRUSHOK !END JOG/v (iAxis),1*SearchLimitVel TILL FAULT(iAxis).#RL,timeout IF ^FAULT(iAxis).#RL GOTO FAULT_PROCESS END JOG/v (iAxis),-1*SearchLimitVel TILL ^FAULT(iAxis).#RL IST(iAxis).#IND0 TILL IST(iAxis).#IND,timeout IF ^IST(iAxis).#IND GOTO FAULT_PROCESS END SET FPOS(iAxis)FPOS(iAxis)-IND(iAxis)HomeOffset PTP/e (iAxis),0 FDEF(iAxis).#LL 1 FDEF(iAxis).#RL 1 MFLAGS(iAxis).#HOME 1 !!!!!!!!!!!!!!!!!!!!!!!! local int zone_x local real base_x local real step_x zone_x 0!!56.9216 base_x -119.16021 step_x 9.2736 CORRECTON_X(0) 0.00069 * 0 CORRECTON_X(1) 0.00069 * 5 CORRECTON_X(2) -0.00069 * 4 CORRECTON_X(3) -0.00069 * 7 CORRECTON_X(4) -0.00069 * 3 CORRECTON_X(5) -0.00069 * 8 CORRECTON_X(6) -0.00069 * 6 CORRECTON_X(7) -0.00069 * 2 CORRECTON_X(8) -0.00069 * 7 CORRECTON_X(9) 0.00069 * 1 CORRECTON_X(10) -0.00069 * 0 CORRECTON_X(11) -0.00069 * 6 CORRECTON_X(12) 0.00069 * 2 CORRECTON_X(13) -0.00069 * 1 CORRECTON_X(14) -0.00069 * 3 CORRECTON_X(15) 0.00069 * 5 CORRECTON_X(16) 0.00069 * 0 CORRECTON_X(17) 0.00069 * 6 CORRECTON_X(18) 0.00069 * 6 CORRECTON_X(19) -0.00069 * 2 CORRECTON_X(20) 0.00069 * 3 CORRECTON_X(21) 0.00069 * 0 CORRECTON_X(22) -0.00069 * 7 CORRECTON_X(23) 0.00069 * 0 CORRECTON_X(24) 0.00069 * 0 CORRECTON_X(25) 0.00069 * 0 ERRORMAP1D 0, zone_x, base_x, step_x, CORRECTON_X ERRORMAPON 0, zone_x !!!!!!!!!!!!!!!!!!!!!!!! STOP FAULT_PROCESS: FDEF(iAxis).#LL 1 FDEF(iAxis).#RL 1 HALT(iAxis) STOP !????????homeflag !ON (MERR(0)0)|(MST(0).01) !MFLAGS(0).#HOME 0 !RET !ON (MERR(1)0)|(MST(1).01) !MFLAGS(0).#HOME 0 !RET !ON (MERR(2)0)|(MST(2).01) !MFLAGS(0).#HOME 0 !RET !ON (MERR(3)0)|(MST(3).01) !MFLAGS(0).#HOME 0 !STOP代码完整解读这是一段运动控制器伺服 / 步进控制的轴回零 误差补偿程序语法是固高 / 雷赛 / 众为兴类运动控制卡专用脚本核心功能X 轴自动找原点 → 设定坐标系 → 加载点位误差补偿表。我分模块逐行解释你能直接看懂每一步做什么。一、变量定义参数初始化INT iAxis ! 定义轴号变量整数 REAL HomeVel ! 回零速度 REAL SearchLimitVel ! 找限位速度 REAL HomeOffset ! 原点偏移量 REAL timeout ! 超时时间单位ms iAxis 0 ! 控制第0轴X轴 HomeVel 5 ! 回零速度 5 SearchLimitVel 10 ! 找限位速度 10 HomeOffset 157 ! 原点偏移 157 个脉冲/单位 timeout 50000 ! 超时50秒二、运动参数设置速度、加速度、加加速度VEL(iAxis) SearchLimitVel ! 设置运行速度 ACC(iAxis) VEL(iAxis) * 10 ! 加速度 速度×10 DEC(iAxis) VEL(iAxis) * 10 ! 减速度 速度×10 JERK(iAxis) VEL(iAxis) * 100 ! 加加速度S曲线平滑 KDEC(iAxis) VEL(iAxis) * 100 ! 急停减速度三、标志位初始化MFLAGS(iAxis).#HOME 0 ! 清除“回零完成”标志 FDEF(iAxis).#LL 0 ! 禁用左限位 FDEF(iAxis).#RL 0 ! 禁用右限位四、使能伺服上电ENABLE (iAxis) ! 伺服使能 TILL MST(iAxis).#ENABLED,timeout ! 等待伺服准备好超时50s IF ^ MST(iAxis).#ENABLED ! 若没使能成功 GOTO FAULT_PROCESS ! 跳转到故障处理 END五、回零核心流程自动找原点1. 正向 JOG 找右限位JOG/v (iAxis),1*SearchLimitVel ! 正向点动 TILL FAULT(iAxis).#RL,timeout ! 等待触发右限位 IF ^FAULT(iAxis).#RL ! 没碰到限位故障 GOTO FAULT_PROCESS END2. 反向离开限位 → 找原点 INDEX 信号JOG/v (iAxis),-1*SearchLimitVel ! 反向移动 TILL ^FAULT(iAxis).#RL ! 直到离开右限位 IST(iAxis).#IND0 ! 清除原点标志 TILL IST(iAxis).#IND,timeout ! 等待捕获INDEX(Z相信号) IF ^IST(iAxis).#IND ! 没捕获到故障 GOTO FAULT_PROCESS END3. 设定当前坐标 原点SET FPOS(iAxis)FPOS(iAxis)-IND(iAxis)HomeOffset ! 公式当前位置 - 索引偏移 原点偏移 设定为原点坐标 PTP/e (iAxis),0 ! 移动到 0 点 FDEF(iAxis).#LL 1 ! 开启左限位 FDEF(iAxis).#RL 1 ! 开启右限位 MFLAGS(iAxis).#HOME 1 ! 标记【回零成功】六、误差补偿表核心点位精度校正local int zone_x ! 补偿区域号 local real base_x ! 补偿起始坐标 local real step_x ! 补偿区间步长 zone_x 0 base_x -119.16021 ! X轴补偿起点 step_x 9.2736 ! 每9.2736距离一个补偿点定义 0~25 号点位的误差补偿值CORRECTON_X(0) 0.00069 * 0 CORRECTON_X(1) 0.00069 * 5 ... CORRECTON_X(25) 0.00069 * 0每一个数字对应一个位置的精度修正值用于消除机械误差。加载并开启误差补偿ERRORMAP1D 0, zone_x, base_x, step_x, CORRECTON_X ! 加载一维误差补偿表 ERRORMAPON 0, zone_x ! 开启X轴误差补偿七、正常结束 故障处理STOP ! 程序正常结束 FAULT_PROCESS: ! 故障处理 FDEF(iAxis).#LL 1 FDEF(iAxis).#RL 1 HALT(iAxis) ! 紧急停止 STOP整体功能总结最直白初始化设置 X 轴速度、加速度、限位伺服上电检查是否正常使能自动回零先碰右限位反向找电机 Z 相信号设定原点坐标精度补偿加载 25 个点位的误差修正表提升定位精度保护机制任何一步失败 → 立即急停 报警你可能关心的关键问题这是什么设备自动化设备机械手、工作台、切割机、检测设备的X 轴回零 精度校正程序。HomeOffset 157 是什么原点偏移量机械安装时的微调距离。CORRECTON_X 有什么用补偿丝杆 / 导轨误差让设备定位更准微米级精度。故障会发生什么轴立即停止限位保护开启程序终止