伺服电机运动控制协议CiA402

伺服电机运动控制协议CiA4021. CiA402协议2 问题分析运动控制命令下发但电机不运动2.1 分析原因2.2 分区与基础状态含义1Power Disabled断电未励磁大区电机完全无法运转2Power Enabled上电励磁大区正常工作核心区你的设备日常运行区3Fault故障大区硬件报错锁定2. 标准正常使能跳转路径对应你手册三步指令3.3 总结1. CiA402协议关于该协议笔者之前也没有关注。也是遇到了具体的问题笔者查阅资料分析可能与笔者使用伺服电机时的状态机有关。状态机是什么东西其实就是电机当前所处的状态。伺服电机厂家在设置电机驱动成时要考虑电机在什么状态定义了电机运动控制的状态以及各个状态之间的转化才能有有条理地控制电机。CiA402协议中重要的一条就是关于状态机的定义。我们看下面这张图。只有在Operation Enable下才是驱动器正常运行的状态。状态机各状态对应说明以某款电机为例关于驱动器的启停控制指令和状态描述主要通过状态字6040h和状态字6041h来实现。2 问题分析运动控制命令下发但电机不运动笔者遇到“运动控制命令下发电机不运动”的情况该情况是在频繁测试电机运动的情况下出现也就是对电机做疲劳性测试的时候出现。且出现上述情况时读取电机故障码为0x00也就是没有发生下面这些硬件故障。2.1 分析原因电机初始运动时必须下发三条命令使得电机到Operation Enable 状态。这三条初始化命令笔者只在电机上电后发一次。后续的所有运动控制只下发速度加减速目前位置的命令。那么当“运动控制命令下发电机不运动”这种情况的可能原因是电机跳出了Operation Enable 状态在非Operation Enable 状态下即使给电机发目标位置的命令电机也不运动。且此时无硬件故障报警。可能存在导致电机跳出Operation Enable状态的场景1 快速停止激活Quick Stop Active 触发原因外接急停 /限位开关瞬时抖动、总线误发快速停止控制字、电压波动触发驱动器软快停表现驱动器不会记故障码只是进入快停锁定态拒绝新定位指令协议硬性规定只能下发0x06Shutdown退出该状态直接发启动命令无效是你偶发停机头号诱因。 2.状态机卡在过渡中间态 CiA402标准合法使能链路固定0x06(关机复位) → 0x07(上电预备) → 0x0F(运行使能)触发原因高频循环启停、指令下发时序错位、单次指令丢包状态停在0x07(Switched On)过渡态没抵达最终可运行态表现参数能正常读写但触发运动指令无响应无任何报警跳过 0x06 直接重复发 0x0F协议不允许越级跳转无法脱困。 3临时IO 信号边沿触发锁定 触发原因限位、使能 DI 口接线松动、机械振动造成通断瞬跳瞬时触发锁定逻辑信号很快恢复正常表现信号回弹后锁定标记不会自动清除驱动器静默拒动全程不生成故障记录。 4通讯扰动带来的状态位偏移 触发原因485 /总线电磁干扰控制寄存器6040h个别 bit 被异常改写使能标志失效 表现表面通讯应答正常内部运行权限丢失无故障码补发0x06 可刷新修正状态位。驱动器能不能执行运动指令完全由当前所处状态决定不是收到指令就会跑。2.2 分区与基础状态含义1Power Disabled断电未励磁大区电机完全无法运转Not Ready to Switch On刚上电自检阶段仅初始化硬件不能读写参数、不能运动Switch on Disabled通讯连通、可改参数但电机不通电励磁所有运动命令无效2Power Enabled上电励磁大区正常工作核心区你的设备日常运行区Ready to Switch On参数可配置电机未励磁Switched on电机预备通电、输出电压就绪但禁止执行运动动作只等待最终使能Operation Enable唯一可以正常跑定位 / 速度指令的合法运行态Quick Stop Activ快速停止激活最常见非故障锁定态电机维持励磁但冻结所有新运动指令不报硬件故障3Fault故障大区硬件报错锁定Fault Reaction Active触发故障后紧急停机电机暂保持励磁Fault彻底故障锁定必须先清除故障码才能重回正常链路。2. 标准正常使能跳转路径对应你手册三步指令Switch on Disabled(0x06指令触发跳转2)→Ready to Switch On(0x07 指令触发跳转 3) →Switched on(0x0F 指令触发跳转 4) →Operation Enable可运动这条递进链路不允许越级跳转跳过前置指令直接发最终使能命令状态机不会响应。3.3 总结所以用户手册中三条初始化命令每次运动控制命令下发时不能省。这是保障伺服电机能够按照状态机控制顺序正常影响控制命令的关键。能够在电机非预期跳出Operation Enable状态时修正电机状态正常影响控制命令。############################################################################################################交流使人进步碰撞产生火花 欢迎 大家留言评论############################################################################################################