最近在调一套带CANopen接口的步进电机驱动器顺便把CiA402协议和报文这块彻底捋了一遍。说实话刚开始看CiA402的时候是有点懵的状态机、对象字典、COB-ID、SDO、PDO这些名词堆在一起比单纯用脉冲方向控制复杂不少。但真正把报文一条条抓出来看再对着手册把状态机走通之后会发现它其实没有想象中那么玄乎套路非常固定。这篇文章就是我自己的理解型笔记我把整个协议拆成了几个层面来记第一是它解决什么问题第二是报文格式怎么看第三是实际要让电机转起来该发哪些报文最后是我踩过的坑。内容不涉及厂家驱动器的具体配置软件操作只从协议和报文角度写适合正在接触CANopen步进驱动器、想搞明白CiA402到底在干什么的朋友。1. 先聊清楚CiA402在步进电机控制里到底是个啥1.1 为什么步进电机也需要协议以前用步进电机最简单的方式就是发脉冲PLC或者运动控制卡给脉冲口输出脉冲和方向信号脉冲个数对应位置方向电平对应正反转。这种方式直观但是有个问题——信号线一多就麻烦而且距离一远抗干扰能力就下降。几十米的现场布线那堆脉冲线、方向线、使能线搞在一起排查起来非常痛苦。用CANopen来控步进电机本质上就是把原来那堆脉冲方向信号数字化了。驱动器挂在CAN总线上主机PLC、上位机、控制器通过CAN报文告诉驱动器目标位置是多少、速度是多少、加速度是多少、什么时候开始动。驱动器内部再把数字设定值换算成实际的电流控制驱动电机运转。这样做的好处很明显信号线大大减少两根CAN线搞定全部通讯抗干扰能力强很多。可以双向反馈驱动器把当前位置、状态、报警信息实时回传。一台总线上一挂几十个轴地址区分清楚之后调试维护方便多轴同步性也更好。所以CiA402并不是某个电机品牌私有协议而是CANopen协议里专门针对运动控制设备伺服、步进、变频器制定的一套规范由CAN in Automation组织发布。它的全称叫CANopen device profile for drives and motion control也就是驱动与运动控制设备规范不同厂家的驱动器只要遵循这套规范控制逻辑就是通用的。我这里用的是支持CANopen接口的步进驱动器基本都遵循CiA402。1.2 CiA402的对象字典和状态机思维理解CiA402我觉得最核心的两样东西就是对象字典和状态机。对象字典简单说就是驱动器内部的一张参数表。所有参数都有一个唯一的索引号index用16位十六进制表示比如0x6040、0x607A这一串。要读写某个参数就是通过SDO报文对指定索引进行读写操作。可以把它理解成一个储物柜每个格子放特定类型的参数你要改哪个参数就打开哪个格子。另一个是状态机这点是CiA402里最容易绕晕的地方。它规定了驱动器的运行状态必须在固定的状态之间切换比如上电初始状态、可以运行的状态、报错状态等。驱动器不是你说动它就立刻动它要先从当前状态一步步迁移到运行已使能状态然后接收运动指令才能运转。这套机制保证了安全——比如电机正在高速运行的时候你不可能直接切换模式或者突然改变目标位置必须先经过规定的状态迁移路径。这两种机制配合起来就是整个CiA402的控制骨架通过对象字典配置参数通过状态机确保运行安全通过PDO和SDO两种报文通道来交换数据。理解了这两点后面的报文都有明确的目的了要么是配置参数SDO要么是实时控制PDO要么是心跳与状态上报。2. 报文拆解从COB-ID到8字节数据逐层剥开2.1 报文头COB-ID里的功能码和节点号CAN报文本身没有源地址和目标地址的概念它是广播式的所有节点都能收到总线上的每一帧报文。那怎么知道哪条报文是发给谁的靠的就是COB-IDCommunication Object Identifier通讯对象标识符。COB-ID是一个11位的标识符标准帧它在报文开头决定了这条报文的类型和接收对象。CiA402更准确地说是DS301应用层把COB-ID分成了两个部分功能码部分高4位或者说高几位的组合决定报文类型比如是SDO还是PDO是心跳还是同步帧。节点地址部分低7位决定这帧报文给哪个节点。举个例子0x600格式的报文是SDO请求发送实际发给节点3的SDO报文COB-ID就是0x600 3 0x603。0x580格式是SDO响应节点3的回应报文就是0x580 3 0x583。我把最常见的报文格式整理成了表格报文类型功能码部分方向实际COB-ID举例节点1说明SDO请求主机发给从机0x600主机→从机0x601读参数、写参数SDO响应从机回复主机0x580从机→主机0x581参数读写的应答RPDO1主机发给从机的实时控制0x200主机→从机0x201实时控制字、目标值TPDO1从机发给主机的实时反馈0x180从机→主机0x181状态字、实际位置心跳Heartbeat0x700从机→主机0x701从机告诉主机自己活着NMT报文0x000主机→所有从机0x000启动/停止从机的网络管理刚开始看的时候容易糊涂0x201和0x601到底有啥区别我的理解是SDO是配置通道用来设置参数比如把最大速度设成多少、加减速时间设多少PDO是运行通道用来高频传输实时数据比如每次扫描周期给驱动器发控制字和目标位置。SDO每次只能处理一个对象的读写速率相对慢PDO则是一次性打包几个参数实时性好专门跑在循环任务里。2.2 SDO报文配置参数时的读写格式SDO报文的数据区固定8字节格式是字节0为命令字字节1-2为对象索引小端格式即低字节在前字节3为子索引字节4-7为数据。举个例子我要把节点1的驱动器工作模式索引0x6060子索引0设置成位置模式值1要发的SDO报文就是COB-ID0x6010x600 节点1 数据2B 60 60 00 01 00 00 00拆开来看2B表示写一个32位数据到对象字典。60 60索引0x6060注意这里是小端排列实际索引是0x6060但发送时低字节60在前高字节60在后。00子索引0。01 00 00 00要写入的数据32位小端即数值1。我最初经常在这里卡住因为索引0x6060在文档里是正着写的但发报文要倒过来字段顺序是索引低字节、索引高字节、子索引。不习惯的话画个报文模板对着填就不会错。再说一个更常用的命令字。如果只是读参数命令字用0x40写8位数据用0x2F写16位数据用0x2B写32位数据用0x23。数值不同是因为命令字本身包含了你读写类型信息。我用0x23还是0x2F不匹配的话驱动器会返回SDO中止报文错误码能看到是哪一项不对这个后面排查部分再说。2.3 PDO报文实时控制与反馈的数据通道PDO报文分为RPDOReceive PDO主机发给从机和TPDOTransmit PDO从机发给主机。它和SDO最大的区别是PDO的数据区不需要指定索引因为PDO的映射关系是在配置阶段提前定义好的。也就是说你用SDO告诉驱动器你的RPDO1对应控制字目标位置这两个对象之后每次发RPDO1时数据区直接填这两个参数的值就行不需要再带索引信息。对于42步进、57步进这类步进驱动器最常见的PDO映射就是RPDO1控制字0x60402字节 目标位置0x607A4字节总共6字节数据。TPDO1状态字0x60412字节 实际位置0x60644字节总共6字节数据。要注意的是PDO的COB-ID和映射关系不是出厂就一定启用的很多驱动器需要先用SDO配置好映射并通过设置使能同步/异步模式来生效。实际操作时我会先把对象字典的映射表逐项核对好再切到PDO模式运行。PDO的数据区没有字段名只有纯数据所以排列顺序一定要和映射表对应上。小端格式同样适用——比如目标位置是0x00030D40200000微米要看驱动器的位置单位定义填到PDO数据区时就是40 0D 03 00。很多人第一次发PDO没反应检查半天发现只是字节序反了。3. 实操记录用报文让步进电机动起来以位置模式为例3.1 前提准备节点ID、波特率、对象字典确认开始发报文之前务必先确认几个基础参数节点ID、CAN波特率、驱动器的工作模式。这些参数一般由驱动器上的拨码开关或参数配置软件设定。我记得有次在实验室里折腾半天发报文没反应后来一查是波特率设错了主机从机一个500K一个250K根本没在同一个频道上聊天。节点ID要注意CANopen标准里节点地址范围是1到127但实际设备往往有限制比如某些驱动器只支持1到63。而且节点ID和COB-ID直接相关节点ID一变所有SDO、PDO、心跳的COB-ID都会跟着变。所以调试第一步打开驱动器手册确认节点ID设置方法。对象字典方面位置模式下几个关键索引我列在下面索引名称说明0x6060工作模式1位置模式3速度模式6回零模式0x6040控制字2字节状态机切换命令0x6041状态字2字节驱动器当前状态反馈0x607A目标位置32位有符号整数单位取决于驱动器定义常见为脉冲数或微米0x6081轮廓速度32位位置模式下的运动速度0x6083轮廓加速度32位位置模式下的加速度0x6084轮廓减速度32位位置模式下的减速度0x6064实际位置32位当前编码器或步数反馈0x1017心跳周期毫秒0表示关闭心跳我自己习惯先把这些索引的值都查一遍确认驱动器的固件版本和参数范围再开始发控制报文。这一步别嫌麻烦很多电机不动的问题都是参数范围设错或者单位理解错导致的。3.2 状态机切换的报文序列CiA402里状态机的完整流程我不展开画图了说实话那图我第一次看也觉得复杂但实际用到的最关键路径就是从上电到使能运行。这张表是控制字0x6040的常用取值控制字取值命令含义0x06Shutdown准备上电0x07Switch On上电但未使能0x0FEnable Operation使能运行0x80Fault Reset故障复位0x3F使能 启动运动新目标位置有效驱动器上电后状态字一般是0x00Not ready to switch on或者0x40Switch on disabled。这时候你不能直接发0x0F让它使能必须先走一遍Shutdown、Switch On然后才能使能。有些简便实现里你可能看到有人直接发0x06→0x07→0x0F三步其实完整路径是从0x00先复位再Shutdown但实际操作中如果状态字已经是0x40直接发0x06是可以的。以节点1为例使能过程的SDO或PDO报文序列如下我用PDO1发送控制字COB-ID为0x201第一步用SDO把0x6060设为1切换到位置模式COB-ID: 0x601 Data: 2B 60 60 00 01 00 00 00第二步发送控制字0x06ShutdownCOB-ID: 0x201 Data: 06 00 后面可以补0具体看PDO映射长度第三步发送控制字0x07Switch OnCOB-ID: 0x201 Data: 07 00第四步发送控制字0x0FEnable OperationCOB-ID: 0x201 Data: 0F 00这几步执行完理论上驱动器的状态字应该是0x21或者0x23Operation enabled表示已经使能可以接受运动指令了。如果状态字没到位就要回头查后面排查部分细聊。3.3 发送目标位置与启动运动使能之后要让电机从当前位置运动到目标位置还需要做两件事设置目标位置设置运动速度参数。通常目标位置用SDO写速度加速度也提前用SDO写好或者用PDO打包一起传。这里我以一个非常简单的例子示范把电机从当前位置正转20000步假设驱动器内部单位就是步数。第一步写目标位置0x607A值2000016进制0x4E2032位小端就是20 4E 00 00COB-ID: 0x601 Data: 23 7A 60 00 20 4E 00 00第二步写轮廓速度0x6081值60000步/秒16进制0xEA60小端为60 EA 00 00COB-ID: 0x601 Data: 23 81 60 00 60 EA 00 00第三步写轮廓加速度0x6083和减速度0x6084值看现场设备一般30000左右起步COB-ID: 0x601 Data: 23 83 60 00 30 75 00 00 加速度30000 COB-ID: 0x601 Data: 23 84 60 00 30 75 00 00 减速度30000第四步把控制字设为0x3F启动运动。这个0x3F是0x0F使能再加上bit4New Setpoint置1表示激活新的目标位置。位置模式下必须置这个位电机才会开始动这是一个特别容易忽略的细节COB-ID: 0x201 Data: 3F 00运动执行过程中如果想把电机停下来可以把控制字0x3F改成0x0F或者把目标位置设为当前位置推荐的做法是先停止再改目标。如果电机已经到位控制字通常还是保持0x3F直到你发出新的目标位置或者主动让驱动器回到非使能状态。第五步读取状态字和实际位置确认到位。我一般会用TPDO1把状态字和实际位置自动传回来这样不用每次发SDO去轮询。从机主动上送实际位置上位机这边刷新就很方便。3.4 读取状态确认运行到位看到这里你会不会觉得发了一堆报文电机到底动没动我咋知道答案就是看状态字0x6041。状态字是2字节里面每一位都有含义。最常用的几个位是位含义bit0Ready to switch onbit1Switched onbit2Operation enabledbit3Fault故障bit5Quick stop快速停止激活bit10Target reached目标位置到达正常运行时我想确认电机是否到位就看bit10是否为1。到位之后状态字常见值就是0x23 0x400 0x423Operation enabled Target reached。有人可能会问实际位置反馈也很有用。对如果你用了PDO映射0x6064每帧TPDO里都能拿到实际步数或者编码器反馈值。我调试时习惯把TPDO放到上位机界面上做一个小表实时刷新这样电机到底有没有动、动了多少一目了然。4. 常见问题与排查实录4.1 电机不动先查哪里电机不动是调CiA402时最容易遇到的故障没有之一。我自己的排查顺序是这样先看CAN物理层。总线两端是否接了120欧终端电阻验收测试时我碰到过好几次忘记在总线两端接终端电阻导致通讯不稳定。表现就是报文时好时坏看着像是程序问题实际上物理层就没过关。再看报文通不通。用CAN分析仪抓总线确认你发的SDO报文有没有到达总线驱动器有没有回SDO响应。如果驱动器一直不回0x581说明报文根本没进驱动器或者节点ID不对、波特率不对。然后看状态字。如果驱动器正常接收报文就发SDO去读0x6041看看当前状态字是什么。比如状态字是0x50Switch on disabled说明还没走完使能流程状态字带bit3Fault说明驱动器处于故障状态需要先发0x80复位故障。最后检查目标位置。驱动器使能了、不报故障但电机就是不动看看目标位置和当前位置是否相等或者速度是否设成了0。位置模式里目标位置和当前位置差为0电机当然是不会动的。我列了一个排查速查表每次调试都能用上现象可能原因排查方法完全无报文波特率不匹配、总线未接终端电阻用CAN分析仪抓总线配置好物理层有报文但无响应节点ID不对、SDO命令字错误核对COB-ID检查索引和命令字电机不使能状态机未走完、故障未复位读0x6041按状态机迁移发送控制字电机使能但不转目标位置当前位置、速度0、模式不对读0x6041确认使能状态读0x6060确认模式位置不准单位换算错误、电子齿轮比未配套核对0x608F相关齿轮比参数和单位说明4.2 状态机切不过去怎么办状态机切不过去最常见的表现是发了0x0F控制字但状态字还是老样子。我遇到的一个典型陷阱是顺序问题。CiA402对状态迁移路径有严格要求不能从任意状态直接跳到使能。比如驱动器刚上电状态字是0x00这时候你直接发0x0F它很可能会忽略这个命令因为当前状态下0x0F不在允许的命令集合里。正确的做法是先发0x80Fault Reset再发0x06Shutdown、0x07Switch On、0x0FEnable Operation。如果你是通过SDO发控制字每次发完最好读一下0x6041确认上一步确实生效了再发下一步。我用PDO跑的时候也是一条条控制字排着发中间加一点延时至少50毫秒等驱动器状态稳定了再发下一条。还有一种情况是控制字里的Quick Stop位bit7置1了。CiA402的状态机里如果Quick Stop位为0驱动器会进入快速停止状态这时候你发使能命令是无效的。控制字0x0F里bit7是1所以正常使能没问题但如果你在别的模式下改过控制字可能就踩了这个坑。每次发控制字时建议自己把bit7连同bit3、bit2、bit1、bit0都核对一遍。4.3 位置不准的几类原因位置不准这个问题在步进驱动里有几种典型表现第一种是定位差一点比如目标20000步实际到19995步。这种情况多半是电子齿轮比或者单位换算没算对。CiA402本身并没有强制规定位置单位是什么有的驱动器用步数有的用微米有的用转的千分之一。我一般先在对象字典里查0x6091齿轮比相关索引和0x608F把电机转一圈对应的用户单位算清楚再发目标位置。这里要特别注意32位数据是否会超出范围位置值接近正负21亿边界时也很容易出问题。第二种是回零之后位置偏。很多步进驱动器支持CiA402的Homing模式模式值6用0x6098回零方式、0x6099回零速度、0x609A回零加速度等索引配置回零参数。回零不准最常见的原因是回零方向设反了或者零位开关的信号极性不匹配。我在现场遇到过一次电工把常开和常闭接反了驱动器一直找不到原点最后检查传感器接线才解决。第三种是位置在跑的过程中丢步了。这种情况就要看机械和电流设置了步进电机开环控制丢步的概率不高但负载变化大或者驱动器电流不够时还是会发生。CiA402里通常可以通过0x2030之类的厂家自定义索引读取实际负载率或者通过报警对象来判断是不是过载。真要是机械堵转导致丢步建议考虑闭环步进或伺服方案。4.4 排查时要不要依赖CAN分析仪我的观点是一定要用。不管是USB转CAN适配器、逻辑分析仪还是专门的CAN总线条在调试报文阶段工具越多越好。很多问题肉眼根本看不出来比如SDO响应超时、心跳报文丢失、PDO时序抖动只有抓到波特率和具体错误帧才能定位。用CAN分析仪抓报文时我一般关注三件事抓到的COB-ID是不是我期望的如果发了0x601却抓到了0x601说明程序串口配置或者协议栈转发逻辑有问题。数据区是不是对称的比如SDO写请求发了8字节看驱动器的应答是不是8字节。应答里如果出现错误信息比如命令字最高位为0x80就说明驱动器拒绝了这次写入。心跳是不是一直有驱动器如果启用了心跳0x1017不为0它应该周期性发送0x700节点ID的报文。如果心跳断了主机就知道从机掉线了很多系统会自动停机保护。抓包分析这件事本质上就是眼见为实。协议栈的log写得再好也不如亲手抓一帧报文给人安全感。5. 一点自己的经验总结走完一遍CiA402报文调试之后我最大的感受是这东西不难但是细节极其多。难的不是原理而是每个参数、每个位、每个字节序都得对得上。只要有一个环节错了电机就是不动或者动了但不听话。我给正在折腾这个东西的朋友几个建议第一条一定要把对象字典手册和驱动器手册放在手边。不同厂家虽然遵循同一套CiA402但在单位、默认值、厂家扩展对象上还是有差别。比如有的驱动器默认不启用PDO需要先SDO配置映射有的是上电就支持默认PDO映射。这些差异不看手册根本猜不到。第二条发报文的时候养成写注释、存档的习惯。我会把每种操作对应的报文都存成一个文件比如使能.txt、回零.txt、走绝对位置.txt每行报文后面备注含义。因为在不熟悉的时候可能几周后再调同一批设备翻笔记比重新推理快得多。第三条控制字和状态字的位定义最好背下来至少把0x0F、0x06、0x07、0x80、0x3F这几个常用值和状态字的bit0、bit1、bit2、bit3、bit10记熟。缓存的报文一长你在分析软件里看到一堆十六进制数字如果脑子里没有映射表排查效率会低到怀疑人生。最后别怕报错。CiA402的好处之一就是它有明确的状态字和错误码机制把Fault状态当成一种它告诉你出问题了的信息就好别慌。先复位故障、再走状态机、再发运动指令这条流程走顺了后面所有模式速度模式、回零模式、循环同步模式都是同一个套路。
CANopen步进电机CiA402协议报文详解与调试实践
最近在调一套带CANopen接口的步进电机驱动器顺便把CiA402协议和报文这块彻底捋了一遍。说实话刚开始看CiA402的时候是有点懵的状态机、对象字典、COB-ID、SDO、PDO这些名词堆在一起比单纯用脉冲方向控制复杂不少。但真正把报文一条条抓出来看再对着手册把状态机走通之后会发现它其实没有想象中那么玄乎套路非常固定。这篇文章就是我自己的理解型笔记我把整个协议拆成了几个层面来记第一是它解决什么问题第二是报文格式怎么看第三是实际要让电机转起来该发哪些报文最后是我踩过的坑。内容不涉及厂家驱动器的具体配置软件操作只从协议和报文角度写适合正在接触CANopen步进驱动器、想搞明白CiA402到底在干什么的朋友。1. 先聊清楚CiA402在步进电机控制里到底是个啥1.1 为什么步进电机也需要协议以前用步进电机最简单的方式就是发脉冲PLC或者运动控制卡给脉冲口输出脉冲和方向信号脉冲个数对应位置方向电平对应正反转。这种方式直观但是有个问题——信号线一多就麻烦而且距离一远抗干扰能力就下降。几十米的现场布线那堆脉冲线、方向线、使能线搞在一起排查起来非常痛苦。用CANopen来控步进电机本质上就是把原来那堆脉冲方向信号数字化了。驱动器挂在CAN总线上主机PLC、上位机、控制器通过CAN报文告诉驱动器目标位置是多少、速度是多少、加速度是多少、什么时候开始动。驱动器内部再把数字设定值换算成实际的电流控制驱动电机运转。这样做的好处很明显信号线大大减少两根CAN线搞定全部通讯抗干扰能力强很多。可以双向反馈驱动器把当前位置、状态、报警信息实时回传。一台总线上一挂几十个轴地址区分清楚之后调试维护方便多轴同步性也更好。所以CiA402并不是某个电机品牌私有协议而是CANopen协议里专门针对运动控制设备伺服、步进、变频器制定的一套规范由CAN in Automation组织发布。它的全称叫CANopen device profile for drives and motion control也就是驱动与运动控制设备规范不同厂家的驱动器只要遵循这套规范控制逻辑就是通用的。我这里用的是支持CANopen接口的步进驱动器基本都遵循CiA402。1.2 CiA402的对象字典和状态机思维理解CiA402我觉得最核心的两样东西就是对象字典和状态机。对象字典简单说就是驱动器内部的一张参数表。所有参数都有一个唯一的索引号index用16位十六进制表示比如0x6040、0x607A这一串。要读写某个参数就是通过SDO报文对指定索引进行读写操作。可以把它理解成一个储物柜每个格子放特定类型的参数你要改哪个参数就打开哪个格子。另一个是状态机这点是CiA402里最容易绕晕的地方。它规定了驱动器的运行状态必须在固定的状态之间切换比如上电初始状态、可以运行的状态、报错状态等。驱动器不是你说动它就立刻动它要先从当前状态一步步迁移到运行已使能状态然后接收运动指令才能运转。这套机制保证了安全——比如电机正在高速运行的时候你不可能直接切换模式或者突然改变目标位置必须先经过规定的状态迁移路径。这两种机制配合起来就是整个CiA402的控制骨架通过对象字典配置参数通过状态机确保运行安全通过PDO和SDO两种报文通道来交换数据。理解了这两点后面的报文都有明确的目的了要么是配置参数SDO要么是实时控制PDO要么是心跳与状态上报。2. 报文拆解从COB-ID到8字节数据逐层剥开2.1 报文头COB-ID里的功能码和节点号CAN报文本身没有源地址和目标地址的概念它是广播式的所有节点都能收到总线上的每一帧报文。那怎么知道哪条报文是发给谁的靠的就是COB-IDCommunication Object Identifier通讯对象标识符。COB-ID是一个11位的标识符标准帧它在报文开头决定了这条报文的类型和接收对象。CiA402更准确地说是DS301应用层把COB-ID分成了两个部分功能码部分高4位或者说高几位的组合决定报文类型比如是SDO还是PDO是心跳还是同步帧。节点地址部分低7位决定这帧报文给哪个节点。举个例子0x600格式的报文是SDO请求发送实际发给节点3的SDO报文COB-ID就是0x600 3 0x603。0x580格式是SDO响应节点3的回应报文就是0x580 3 0x583。我把最常见的报文格式整理成了表格报文类型功能码部分方向实际COB-ID举例节点1说明SDO请求主机发给从机0x600主机→从机0x601读参数、写参数SDO响应从机回复主机0x580从机→主机0x581参数读写的应答RPDO1主机发给从机的实时控制0x200主机→从机0x201实时控制字、目标值TPDO1从机发给主机的实时反馈0x180从机→主机0x181状态字、实际位置心跳Heartbeat0x700从机→主机0x701从机告诉主机自己活着NMT报文0x000主机→所有从机0x000启动/停止从机的网络管理刚开始看的时候容易糊涂0x201和0x601到底有啥区别我的理解是SDO是配置通道用来设置参数比如把最大速度设成多少、加减速时间设多少PDO是运行通道用来高频传输实时数据比如每次扫描周期给驱动器发控制字和目标位置。SDO每次只能处理一个对象的读写速率相对慢PDO则是一次性打包几个参数实时性好专门跑在循环任务里。2.2 SDO报文配置参数时的读写格式SDO报文的数据区固定8字节格式是字节0为命令字字节1-2为对象索引小端格式即低字节在前字节3为子索引字节4-7为数据。举个例子我要把节点1的驱动器工作模式索引0x6060子索引0设置成位置模式值1要发的SDO报文就是COB-ID0x6010x600 节点1 数据2B 60 60 00 01 00 00 00拆开来看2B表示写一个32位数据到对象字典。60 60索引0x6060注意这里是小端排列实际索引是0x6060但发送时低字节60在前高字节60在后。00子索引0。01 00 00 00要写入的数据32位小端即数值1。我最初经常在这里卡住因为索引0x6060在文档里是正着写的但发报文要倒过来字段顺序是索引低字节、索引高字节、子索引。不习惯的话画个报文模板对着填就不会错。再说一个更常用的命令字。如果只是读参数命令字用0x40写8位数据用0x2F写16位数据用0x2B写32位数据用0x23。数值不同是因为命令字本身包含了你读写类型信息。我用0x23还是0x2F不匹配的话驱动器会返回SDO中止报文错误码能看到是哪一项不对这个后面排查部分再说。2.3 PDO报文实时控制与反馈的数据通道PDO报文分为RPDOReceive PDO主机发给从机和TPDOTransmit PDO从机发给主机。它和SDO最大的区别是PDO的数据区不需要指定索引因为PDO的映射关系是在配置阶段提前定义好的。也就是说你用SDO告诉驱动器你的RPDO1对应控制字目标位置这两个对象之后每次发RPDO1时数据区直接填这两个参数的值就行不需要再带索引信息。对于42步进、57步进这类步进驱动器最常见的PDO映射就是RPDO1控制字0x60402字节 目标位置0x607A4字节总共6字节数据。TPDO1状态字0x60412字节 实际位置0x60644字节总共6字节数据。要注意的是PDO的COB-ID和映射关系不是出厂就一定启用的很多驱动器需要先用SDO配置好映射并通过设置使能同步/异步模式来生效。实际操作时我会先把对象字典的映射表逐项核对好再切到PDO模式运行。PDO的数据区没有字段名只有纯数据所以排列顺序一定要和映射表对应上。小端格式同样适用——比如目标位置是0x00030D40200000微米要看驱动器的位置单位定义填到PDO数据区时就是40 0D 03 00。很多人第一次发PDO没反应检查半天发现只是字节序反了。3. 实操记录用报文让步进电机动起来以位置模式为例3.1 前提准备节点ID、波特率、对象字典确认开始发报文之前务必先确认几个基础参数节点ID、CAN波特率、驱动器的工作模式。这些参数一般由驱动器上的拨码开关或参数配置软件设定。我记得有次在实验室里折腾半天发报文没反应后来一查是波特率设错了主机从机一个500K一个250K根本没在同一个频道上聊天。节点ID要注意CANopen标准里节点地址范围是1到127但实际设备往往有限制比如某些驱动器只支持1到63。而且节点ID和COB-ID直接相关节点ID一变所有SDO、PDO、心跳的COB-ID都会跟着变。所以调试第一步打开驱动器手册确认节点ID设置方法。对象字典方面位置模式下几个关键索引我列在下面索引名称说明0x6060工作模式1位置模式3速度模式6回零模式0x6040控制字2字节状态机切换命令0x6041状态字2字节驱动器当前状态反馈0x607A目标位置32位有符号整数单位取决于驱动器定义常见为脉冲数或微米0x6081轮廓速度32位位置模式下的运动速度0x6083轮廓加速度32位位置模式下的加速度0x6084轮廓减速度32位位置模式下的减速度0x6064实际位置32位当前编码器或步数反馈0x1017心跳周期毫秒0表示关闭心跳我自己习惯先把这些索引的值都查一遍确认驱动器的固件版本和参数范围再开始发控制报文。这一步别嫌麻烦很多电机不动的问题都是参数范围设错或者单位理解错导致的。3.2 状态机切换的报文序列CiA402里状态机的完整流程我不展开画图了说实话那图我第一次看也觉得复杂但实际用到的最关键路径就是从上电到使能运行。这张表是控制字0x6040的常用取值控制字取值命令含义0x06Shutdown准备上电0x07Switch On上电但未使能0x0FEnable Operation使能运行0x80Fault Reset故障复位0x3F使能 启动运动新目标位置有效驱动器上电后状态字一般是0x00Not ready to switch on或者0x40Switch on disabled。这时候你不能直接发0x0F让它使能必须先走一遍Shutdown、Switch On然后才能使能。有些简便实现里你可能看到有人直接发0x06→0x07→0x0F三步其实完整路径是从0x00先复位再Shutdown但实际操作中如果状态字已经是0x40直接发0x06是可以的。以节点1为例使能过程的SDO或PDO报文序列如下我用PDO1发送控制字COB-ID为0x201第一步用SDO把0x6060设为1切换到位置模式COB-ID: 0x601 Data: 2B 60 60 00 01 00 00 00第二步发送控制字0x06ShutdownCOB-ID: 0x201 Data: 06 00 后面可以补0具体看PDO映射长度第三步发送控制字0x07Switch OnCOB-ID: 0x201 Data: 07 00第四步发送控制字0x0FEnable OperationCOB-ID: 0x201 Data: 0F 00这几步执行完理论上驱动器的状态字应该是0x21或者0x23Operation enabled表示已经使能可以接受运动指令了。如果状态字没到位就要回头查后面排查部分细聊。3.3 发送目标位置与启动运动使能之后要让电机从当前位置运动到目标位置还需要做两件事设置目标位置设置运动速度参数。通常目标位置用SDO写速度加速度也提前用SDO写好或者用PDO打包一起传。这里我以一个非常简单的例子示范把电机从当前位置正转20000步假设驱动器内部单位就是步数。第一步写目标位置0x607A值2000016进制0x4E2032位小端就是20 4E 00 00COB-ID: 0x601 Data: 23 7A 60 00 20 4E 00 00第二步写轮廓速度0x6081值60000步/秒16进制0xEA60小端为60 EA 00 00COB-ID: 0x601 Data: 23 81 60 00 60 EA 00 00第三步写轮廓加速度0x6083和减速度0x6084值看现场设备一般30000左右起步COB-ID: 0x601 Data: 23 83 60 00 30 75 00 00 加速度30000 COB-ID: 0x601 Data: 23 84 60 00 30 75 00 00 减速度30000第四步把控制字设为0x3F启动运动。这个0x3F是0x0F使能再加上bit4New Setpoint置1表示激活新的目标位置。位置模式下必须置这个位电机才会开始动这是一个特别容易忽略的细节COB-ID: 0x201 Data: 3F 00运动执行过程中如果想把电机停下来可以把控制字0x3F改成0x0F或者把目标位置设为当前位置推荐的做法是先停止再改目标。如果电机已经到位控制字通常还是保持0x3F直到你发出新的目标位置或者主动让驱动器回到非使能状态。第五步读取状态字和实际位置确认到位。我一般会用TPDO1把状态字和实际位置自动传回来这样不用每次发SDO去轮询。从机主动上送实际位置上位机这边刷新就很方便。3.4 读取状态确认运行到位看到这里你会不会觉得发了一堆报文电机到底动没动我咋知道答案就是看状态字0x6041。状态字是2字节里面每一位都有含义。最常用的几个位是位含义bit0Ready to switch onbit1Switched onbit2Operation enabledbit3Fault故障bit5Quick stop快速停止激活bit10Target reached目标位置到达正常运行时我想确认电机是否到位就看bit10是否为1。到位之后状态字常见值就是0x23 0x400 0x423Operation enabled Target reached。有人可能会问实际位置反馈也很有用。对如果你用了PDO映射0x6064每帧TPDO里都能拿到实际步数或者编码器反馈值。我调试时习惯把TPDO放到上位机界面上做一个小表实时刷新这样电机到底有没有动、动了多少一目了然。4. 常见问题与排查实录4.1 电机不动先查哪里电机不动是调CiA402时最容易遇到的故障没有之一。我自己的排查顺序是这样先看CAN物理层。总线两端是否接了120欧终端电阻验收测试时我碰到过好几次忘记在总线两端接终端电阻导致通讯不稳定。表现就是报文时好时坏看着像是程序问题实际上物理层就没过关。再看报文通不通。用CAN分析仪抓总线确认你发的SDO报文有没有到达总线驱动器有没有回SDO响应。如果驱动器一直不回0x581说明报文根本没进驱动器或者节点ID不对、波特率不对。然后看状态字。如果驱动器正常接收报文就发SDO去读0x6041看看当前状态字是什么。比如状态字是0x50Switch on disabled说明还没走完使能流程状态字带bit3Fault说明驱动器处于故障状态需要先发0x80复位故障。最后检查目标位置。驱动器使能了、不报故障但电机就是不动看看目标位置和当前位置是否相等或者速度是否设成了0。位置模式里目标位置和当前位置差为0电机当然是不会动的。我列了一个排查速查表每次调试都能用上现象可能原因排查方法完全无报文波特率不匹配、总线未接终端电阻用CAN分析仪抓总线配置好物理层有报文但无响应节点ID不对、SDO命令字错误核对COB-ID检查索引和命令字电机不使能状态机未走完、故障未复位读0x6041按状态机迁移发送控制字电机使能但不转目标位置当前位置、速度0、模式不对读0x6041确认使能状态读0x6060确认模式位置不准单位换算错误、电子齿轮比未配套核对0x608F相关齿轮比参数和单位说明4.2 状态机切不过去怎么办状态机切不过去最常见的表现是发了0x0F控制字但状态字还是老样子。我遇到的一个典型陷阱是顺序问题。CiA402对状态迁移路径有严格要求不能从任意状态直接跳到使能。比如驱动器刚上电状态字是0x00这时候你直接发0x0F它很可能会忽略这个命令因为当前状态下0x0F不在允许的命令集合里。正确的做法是先发0x80Fault Reset再发0x06Shutdown、0x07Switch On、0x0FEnable Operation。如果你是通过SDO发控制字每次发完最好读一下0x6041确认上一步确实生效了再发下一步。我用PDO跑的时候也是一条条控制字排着发中间加一点延时至少50毫秒等驱动器状态稳定了再发下一条。还有一种情况是控制字里的Quick Stop位bit7置1了。CiA402的状态机里如果Quick Stop位为0驱动器会进入快速停止状态这时候你发使能命令是无效的。控制字0x0F里bit7是1所以正常使能没问题但如果你在别的模式下改过控制字可能就踩了这个坑。每次发控制字时建议自己把bit7连同bit3、bit2、bit1、bit0都核对一遍。4.3 位置不准的几类原因位置不准这个问题在步进驱动里有几种典型表现第一种是定位差一点比如目标20000步实际到19995步。这种情况多半是电子齿轮比或者单位换算没算对。CiA402本身并没有强制规定位置单位是什么有的驱动器用步数有的用微米有的用转的千分之一。我一般先在对象字典里查0x6091齿轮比相关索引和0x608F把电机转一圈对应的用户单位算清楚再发目标位置。这里要特别注意32位数据是否会超出范围位置值接近正负21亿边界时也很容易出问题。第二种是回零之后位置偏。很多步进驱动器支持CiA402的Homing模式模式值6用0x6098回零方式、0x6099回零速度、0x609A回零加速度等索引配置回零参数。回零不准最常见的原因是回零方向设反了或者零位开关的信号极性不匹配。我在现场遇到过一次电工把常开和常闭接反了驱动器一直找不到原点最后检查传感器接线才解决。第三种是位置在跑的过程中丢步了。这种情况就要看机械和电流设置了步进电机开环控制丢步的概率不高但负载变化大或者驱动器电流不够时还是会发生。CiA402里通常可以通过0x2030之类的厂家自定义索引读取实际负载率或者通过报警对象来判断是不是过载。真要是机械堵转导致丢步建议考虑闭环步进或伺服方案。4.4 排查时要不要依赖CAN分析仪我的观点是一定要用。不管是USB转CAN适配器、逻辑分析仪还是专门的CAN总线条在调试报文阶段工具越多越好。很多问题肉眼根本看不出来比如SDO响应超时、心跳报文丢失、PDO时序抖动只有抓到波特率和具体错误帧才能定位。用CAN分析仪抓报文时我一般关注三件事抓到的COB-ID是不是我期望的如果发了0x601却抓到了0x601说明程序串口配置或者协议栈转发逻辑有问题。数据区是不是对称的比如SDO写请求发了8字节看驱动器的应答是不是8字节。应答里如果出现错误信息比如命令字最高位为0x80就说明驱动器拒绝了这次写入。心跳是不是一直有驱动器如果启用了心跳0x1017不为0它应该周期性发送0x700节点ID的报文。如果心跳断了主机就知道从机掉线了很多系统会自动停机保护。抓包分析这件事本质上就是眼见为实。协议栈的log写得再好也不如亲手抓一帧报文给人安全感。5. 一点自己的经验总结走完一遍CiA402报文调试之后我最大的感受是这东西不难但是细节极其多。难的不是原理而是每个参数、每个位、每个字节序都得对得上。只要有一个环节错了电机就是不动或者动了但不听话。我给正在折腾这个东西的朋友几个建议第一条一定要把对象字典手册和驱动器手册放在手边。不同厂家虽然遵循同一套CiA402但在单位、默认值、厂家扩展对象上还是有差别。比如有的驱动器默认不启用PDO需要先SDO配置映射有的是上电就支持默认PDO映射。这些差异不看手册根本猜不到。第二条发报文的时候养成写注释、存档的习惯。我会把每种操作对应的报文都存成一个文件比如使能.txt、回零.txt、走绝对位置.txt每行报文后面备注含义。因为在不熟悉的时候可能几周后再调同一批设备翻笔记比重新推理快得多。第三条控制字和状态字的位定义最好背下来至少把0x0F、0x06、0x07、0x80、0x3F这几个常用值和状态字的bit0、bit1、bit2、bit3、bit10记熟。缓存的报文一长你在分析软件里看到一堆十六进制数字如果脑子里没有映射表排查效率会低到怀疑人生。最后别怕报错。CiA402的好处之一就是它有明确的状态字和错误码机制把Fault状态当成一种它告诉你出问题了的信息就好别慌。先复位故障、再走状态机、再发运动指令这条流程走顺了后面所有模式速度模式、回零模式、循环同步模式都是同一个套路。
