1. 为什么 CiA-402 的控制字值得单独拎出来讲做伺服和运动控制的朋友绕不开 CiA-402 这个协议子集。它本质上是一套跑在 CANopen 之上的设备行规把伺服驱动器的状态、参数、运动模式全部标准化了。你只要按这套规则发控制字不同品牌的驱动器理论上都能听懂。但实际项目里真正让人头疼的不是协议本身而是**控制字Controlword对象字典索引 0x6040**这一串 16 位数据到底怎么拼、什么时候发、发了之后驱动器为什么不理你。我见过太多现场PLC 程序里控制字写死了 0x000F结果驱动器上使能了但电机不转或者 PV 模式下速度给定写进去了电机纹丝不动查了半天发现是控制字里某个 bit 没置对。这些问题的根源都是对 CiA-402 状态机和控制字位定义理解不够深。这篇内容就是把我这些年调试 CiA-402 的经验整理出来从状态机的基本逻辑讲起把 PP、PV、PT、CSP、CSV、CST 六种模式的控制字用法逐一拆解再补上前馈和停机策略这两个容易被忽略但实际很关键的环节。适合正在做伺服调试的工程师、写运动控制程序的开发者以及需要对接不同品牌驱动器的系统集成人员。不管你是刚接触 CANopen 的新手还是已经调过几台设备但总觉得没吃透的老手应该都能从里面找到有用的东西。2. CiA-402 状态机与控制字基础拆解2.1 状态机的本质一个被控制字驱动的有限状态机CiA-402 的状态机不是什么高深的东西你可以把它理解成一个被控制字和驱动器内部事件共同驱动的有限状态机。控制字是输入状态字Statusword0x6041是输出驱动器根据当前状态和控制字的组合决定下一步跳到哪里。整个状态机有这几个核心状态Not Ready to Switch On上电后的初始状态驱动器还在自检Switch On Disabled自检完成等待使能指令Ready to Switch On驱动器准备好但功率级还没上电Switched On功率级已上电但电机还没使能Operation Enabled电机使能可以接收运动指令Quick Stop Active快速停机状态Fault Reaction Active故障响应中Fault故障状态需要复位状态之间的跳转不是随便跳的必须按顺序来。比如你不能从 Switch On Disabled 直接跳到 Operation Enabled中间必须经过 Ready to Switch On 和 Switched On。这就像开车你不能从熄火状态直接挂挡踩油门得先通电、自检、松手刹一步步来。控制字里负责状态跳转的关键 bit 有这么几个Bit名称作用0Switch On请求进入 Switched On 状态1Enable Voltage使能电压输出2Quick Stop低电平触发快速停机3Enable Operation使能操作进入 Operation Enabled7Fault Reset故障复位上升沿有效典型的使能序列是这样的先发 0x0006Shutdown驱动器从 Operation Enabled 回到 Ready to Switch On再发 0x0007Switch On进入 Switched On最后发 0x000FEnable Operation进入 Operation Enabled。每一步都要等状态字确认到位再发下一步不能一口气全发完。注意有些驱动器对控制字的 bit 2Quick Stop处理方式不同有的低电平有效有的可以通过对象字典配置成高电平有效。调试前一定要查驱动器手册别想当然。2.2 控制字位定义详解每个 bit 都有它的脾气控制字是 16 位但实际用到的就那么几个 bit。我把常用的列出来顺便说说实际调试中容易踩的坑。Bit 0-3状态跳转核心位这四个 bit 组合决定了状态机怎么走。常见的组合值0x0006二进制 0000 0000 0000 0110Shutdownbit1 和 bit2 置位0x0007二进制 0000 0000 0000 0111Switch Onbit0、1、2 置位0x000F二进制 0000 0000 0000 1111Enable Operationbit0-3 全置位0x0002二进制 0000 0000 0000 0010Quick Stop只有 bit1 置位这里有个细节bit 2 是 Quick Stop低电平有效。也就是说正常运行时 bit 2 必须是 1如果你把它写成 0驱动器会立刻执行快速停机。我见过有人用 0x000B 去使能结果电机一使能就停查了半天才发现 bit 2 没置位。Bit 4-6运行模式相关这三个 bit 在特定模式下有特殊含义。比如在 PP 模式下bit 4 是新设定点New Set-pointbit 5 是立即更新Change Set Immediatelybit 6 是绝对/相对Absolute/Relative。在 PV 模式下bit 4-6 通常不用但有些驱动器会用来做速度斜坡的使能。Bit 7故障复位这个 bit 是上升沿有效。也就是说你从 0 写到 1 的那一瞬间驱动器会尝试复位故障。如果你一直保持 1它不会反复复位。实际调试时我习惯在故障复位后把这一位清掉避免下次故障时误触发。Bit 8暂停Halt这个 bit 在 PV、CSP、CSV 模式下用来暂停运动。置 1 时驱动器会按预设的减速度停下来清 0 后继续。注意暂停不是急停它是有斜坡的。Bit 9绝对/相对位置在 PP 模式下有些驱动器把绝对/相对的选择放在 bit 9而不是 bit 6。这个要看具体驱动器的实现不能一概而论。Bit 10保留通常不用但有些驱动器会用来做特殊功能比如力矩限制的使能。Bit 11-15厂商自定义这部分每个品牌都不一样有的用来做增益切换有的用来做特殊模式选择。调试前一定要查手册。2.3 状态字你的眼睛控制字是你说的话状态字是驱动器的回答。不看状态字就发控制字等于闭着眼睛开车。状态字里最关键的是低 7 位它们直接对应状态机的当前状态。状态字低 7 位十六进制对应状态0x00Not Ready to Switch On0x40Switch On Disabled0x21Ready to Switch On0x23Switched On0x27Operation Enabled0x07Quick Stop Active0x0FFault Reaction Active0x08Fault实际编程时我习惯写一个状态判断函数把状态字读回来跟这些值比对确认当前状态后再发下一步控制字。这样虽然多几步判断但能避免很多莫名其妙的问题。实操心得有些驱动器的状态字在跳转过程中会有短暂的不稳定比如从 Switched On 到 Operation Enabled 的瞬间状态字可能先变成 0x27 又跳回 0x23。我的做法是加一个 10-20ms 的延时再读或者连续读三次取稳定值。3. 六种运动模式的控制字实战3.1 PP 模式Profile Position点位运动的标准玩法PP 模式是最常用的点位运动模式适合做定距离移动、多段位置切换这类场景。它的控制字用法比 PV 模式复杂一些因为涉及到设定点的更新和切换。PP 模式的控制字关键 bitBit 4New Set-point置 1 告诉驱动器有新目标位置了驱动器读取目标位置后会清零这一位Bit 5Change Set Immediately置 1 表示立即更新目标位置不等当前运动完成置 0 表示等当前运动完成后再更新Bit 6Absolute/Relative置 1 绝对位置置 0 相对位置典型操作流程先使能驱动器到 Operation Enabled 状态控制字 0x000F写入目标位置0x607A和目标速度0x6081发控制字 0x001Fbit 4 置位触发新设定点等待状态字 bit 12Set-point Acknowledge置位确认驱动器已接收清除 bit 4准备下一次设定点这里有个容易搞混的地方bit 4 是上升沿触发你发一次 0x001F驱动器接收后会把状态字的 bit 12 置 1。你看到 bit 12 置 1 后要把控制字的 bit 4 清掉否则下一次设定点无法触发。我见过有人一直保持 0x001F结果第二个点位死活不动。注意有些驱动器要求 bit 4 和 bit 5 配合使用。如果你做连续点位切换bit 5 置 1 可以让驱动器不等当前运动完成就接收新目标适合做轨迹插补。但这样对驱动器的动态性能要求更高参数没调好容易过冲。3.2 PV 模式Profile Velocity速度控制的基本功PV 模式是速度控制模式驱动器按你给定的目标速度0x60FF运行加减速按预设的斜坡0x6083 加速度、0x6084 减速度执行。这个模式的控制字最简单使能后基本不用动。PV 模式的控制字使能到 Operation Enabled 后控制字保持 0x000F 即可需要暂停时置 bit 8Halt控制字变成 0x010F需要急停时清 bit 2控制字变成 0x000B实际调试时PV 模式最容易出的问题是速度给定和实际速度对不上。这通常是因为速度单位没搞对。CiA-402 里速度单位通常是用户单位/秒而用户单位和实际物理单位的换算关系在对象字典 0x6091齿轮比和 0x6092进给常数里定义。如果这两个参数没设对你写 1000 进去电机可能转得飞快或者慢如蜗牛。我的做法是先算清楚一个用户单位对应多少毫米或多少度然后反推目标速度应该写多少。比如丝杠导程 10mm编码器 10000 线齿轮比 1:1那么一个用户单位对应 10mm/10000 0.001mm。要让电机以 100mm/s 运行目标速度就是 100/0.001 100000。3.3 PT 模式Profile Torque力矩控制的正确打开方式PT 模式是力矩控制模式目标力矩写在 0x6071力矩斜坡在 0x6087。这个模式在需要恒张力控制、压装、拧紧等场景下很有用。PT 模式的控制字用法和 PV 类似使能后保持 0x000F。但有几个特殊点力矩给定是千分比1000 对应额定力矩的 100%有些驱动器需要额外使能力矩限制通过对象字典 0x6072 设置力矩模式下速度限制很重要防止飞车实操心得PT 模式调试时我习惯先把速度限制设得很低比如额定转速的 10%确认力矩方向正确后再逐步放开。这样即使力矩给定反了也不会造成太大问题。3.4 CSP 模式Cyclic Synchronous Position插补运动的核心CSP 模式是周期同步位置模式驱动器每个周期接收一个新的目标位置内部做位置插补。这个模式适合做多轴插补、电子凸轮、飞剪这类应用。CSP 模式的控制字使能后保持 0x000F需要暂停时置 bit 8位置给定通过 PDO 周期发送通常用 RPDO 映射 0x607ACSP 模式的关键是同步周期。驱动器需要在每个周期收到新的位置给定如果周期不稳定或者丢帧电机会抖动甚至报跟随误差。我一般会把同步周期设在 1-4ms具体看驱动器和总线负载。这里有个坑CSP 模式下如果你突然停止发送位置给定驱动器会保持最后一个位置但如果有外部力电机会被推动。所以停机时不能直接停发 PDO要先切到其他模式或者用 Halt 位。3.5 CSV 模式Cyclic Synchronous Velocity速度插补的利器CSV 模式是周期同步速度模式每个周期接收新的速度给定。适合做速度同步、卷绕控制这类应用。CSV 模式的控制字和 CSP 类似使能后保持 0x000F。速度给定通过 RPDO 映射 0x60FF 周期发送。CSV 模式比 PV 模式响应更快因为没有内部斜坡生成速度完全由上位机控制。但这也意味着上位机要负责加减速规划如果速度给定突变电机会有冲击。注意CSV 模式下速度给定的单位是用户单位/秒和 PV 模式一样。但因为没有内部斜坡建议在上位机做速度限幅和斜坡处理。3.6 CST 模式Cyclic Synchronous Torque力矩插补CST 模式是周期同步力矩模式每个周期接收新的力矩给定。适合做力控、碰撞检测这类应用。CST 模式的控制字用法和 CSV 类似力矩给定通过 RPDO 映射 0x6071 周期发送。CST 模式调试时速度限制是必须设的。因为力矩模式下电机没有速度闭环如果负载突然消失电机会飞车。我一般会把速度限制设在额定转速的 120% 左右既不影响正常运动又能防止失控。4. 前馈与停机策略容易被忽略但很关键4.1 前馈控制在 CiA-402 里的实现前馈控制是提高伺服响应和减少跟随误差的重要手段。在 CiA-402 里前馈通常通过对象字典里的速度前馈0x60FF 的附加给定和力矩前馈0x6071 的附加给定来实现。速度前馈的作用是在位置控制模式下提前给驱动器一个速度给定让电机不用等位置误差积累就能开始运动。这样可以显著减少跟随误差提高轨迹精度。力矩前馈的作用是提前给驱动器一个力矩给定补偿摩擦力和重力。这在垂直轴或者大惯量负载上特别有用。实际使用时前馈增益需要根据负载特性调整。增益太小效果不明显太大容易引起振荡。我的经验是先加 50% 的速度前馈观察跟随误差变化再逐步调整。力矩前馈一般从 20%-30% 开始试。实操心得前馈控制不是万能的。如果机械系统本身有间隙或者弹性变形前馈反而可能引起振荡。这种情况下先把机械问题解决再考虑前馈。4.2 停机策略正常停机、快速停机和急停的区别CiA-402 定义了三种停机方式对应不同的控制字操作停机方式控制字操作停机行为正常停机清 bit 0-3发 0x0006按减速度斜坡停机然后进入 Switched On快速停机清 bit 2发 0x000B按快速停机斜坡停机进入 Quick Stop Active急停清 bit 1发 0x000D立即切断功率级电机自由停车正常停机适合计划内的停止比如完成一个点位运动后。快速停机适合异常情况比如限位触发。急停是最后手段只在紧急情况下使用因为自由停车可能导致机械冲击。实际编程时我习惯把停机逻辑封装成一个函数根据不同的触发条件选择不同的停机方式。比如def stop_motion(drive, stop_type): if stop_type normal: drive.write_controlword(0x0006) elif stop_type quick: drive.write_controlword(0x000B) elif stop_type emergency: drive.write_controlword(0x000D)注意急停后驱动器会进入 Fault 状态需要手动复位才能重新使能。所以急停不能随便用只在真正紧急的情况下才用。4.3 停机过程中的状态监控停机不是发完控制字就完事了还要监控状态字确认停机完成。正常停机和快速停机都有对应的状态字变化正常停机状态字从 0x27 变成 0x23再变成 0x21快速停机状态字从 0x27 变成 0x07急停状态字从 0x27 变成 0x08Fault我一般会写一个等待函数轮询状态字直到达到目标状态或者超时报警。超时时间根据负载惯量和减速度设置一般 2-5 秒。5. 常见问题与排查技巧实录5.1 控制字发了但驱动器没反应这是最常见的问题排查思路如下检查状态字先读状态字确认驱动器当前在什么状态。如果状态字是 0x00 或 0x40说明驱动器还没准备好可能是电源问题或者自检没通过。检查控制字位定义确认你发的控制字是否符合驱动器手册的要求。不同品牌对 bit 2 的处理可能不同。检查 PDO 映射如果控制字是通过 PDO 发送的确认 PDO 映射是否正确RPDO 的 COB-ID 是否匹配。检查同步周期如果是 CSP/CSV/CST 模式确认同步周期是否稳定有没有丢帧。5.2 电机使能了但不转使能成功状态字 0x27但电机不转通常有这几个原因目标速度或位置为 0检查 0x60FF 或 0x607A 是否写入了有效值运行模式没设置检查 0x6060 是否设置成了正确的模式Halt 位被置位检查控制字 bit 8 是否为 0力矩限制太低检查 0x6072 是否设得太小机械抱闸没打开有些电机带抱闸需要额外控制5.3 电机抖动或振荡抖动通常和增益参数有关但也可能是控制字的问题CSP 模式下同步周期不稳定检查总线负载和同步信号前馈增益太大降低前馈增益试试速度限制设得太高在 CST 模式下速度限制太高会导致振荡位置给定突变在 CSP 模式下位置给定突变会引起冲击5.4 故障复位失败故障复位失败通常是因为故障原因还没消除。排查步骤读状态字确认是否在 Fault 状态0x08读错误代码0x603F确认故障原因排除故障原因后发控制字 0x0080bit 7 置位复位等待状态字变成 0x40Switch On Disabled实操心得有些驱动器的故障复位需要控制字 bit 7 从 0 到 1 的上升沿如果你一直保持 0x0080复位不会生效。我的做法是发一次 0x0080等 10ms再发 0x0000然后再发 0x0080。5.5 常见问题速查表现象可能原因排查方法控制字无响应状态机不在可跳转状态读状态字确认当前状态使能后电机不转目标值为 0 或模式不对检查 0x6060 和 0x60FF/0x607A电机抖动增益太高或同步周期不稳降低增益检查总线负载故障复位失败故障原因未消除读 0x603F 确认故障代码停机后无法重新使能状态机卡在 Quick Stop发 0x0006 回到 Ready to Switch On速度给定不生效单位换算错误检查 0x6091 和 0x60926. 调试工具与实操建议6.1 常用调试工具调试 CiA-402 驱动器我常用的工具组合是CAN 分析仪比如 PEAK PCAN-USB 或者 Kvaser Leaf用来抓报文驱动器上位机软件大部分品牌都有自己的调试软件可以监控状态字和控制字PLC 或运动控制器用来发控制字和读状态字示波器用来观察电流和速度波形CAN 分析仪是必备的因为很多问题只有看报文才能定位。比如 PDO 映射错误、同步周期不稳定这些在应用层看不出来但抓报文一目了然。6.2 调试步骤建议我的调试流程一般是这样的单独调试驱动器先用上位机软件让电机转起来确认驱动器本身没问题接入控制器用 PLC 或运动控制器发控制字确认通信正常调试状态机先走一遍完整的使能序列确认状态跳转正常调试运动模式从 PV 模式开始再试 PP 模式最后试 CSP/CSV/CST优化参数调整增益、前馈、斜坡参数直到运动性能满足要求每一步都要确认无误再进入下一步不要跳步。我见过有人直接上 CSP 模式结果状态机都没走通查了半天。6.3 实操心得最后分享几个我踩过的坑控制字不要写死有些驱动器需要根据状态动态调整控制字写死了容易出问题状态字要实时读不要假设驱动器一定在某个状态每次发控制字前都读一下状态字PDO 映射要仔细RPDO 和 TPDO 的映射关系一定要和驱动器手册一致错了就是通信正常但数据不对同步周期要稳定CSP/CSV/CST 模式下同步周期不稳定会导致电机抖动建议用硬件同步信号停机逻辑要完善不要只写正常停机快速停机和急停也要考虑特别是安全相关的应用CiA-402 这套协议看起来复杂但核心就是状态机加控制字。把状态机的跳转逻辑搞清楚把控制字的每个 bit 弄明白剩下的就是根据具体模式调整参数。我调试过十几个品牌的驱动器虽然细节有差异但大框架都是一样的。希望这篇内容能帮你少走一些弯路。