EtherCAT伺服驱动通信工程 - 第3节

3. 伺服驱动通信模型

EtherCAT作为高性能实时工业以太网协议，其物理层与数据链路层解决了“数据如何快速、确定性地传输”的问题。但伺服驱动器本质上是一个需要被精确控制的执行机构，它必须理解接收到的数据含义，并按照统一的规则对外提供控制接口。这正是本章的核心：CiA402（CANopen驱动与运动控制设备行规）在EtherCAT上的应用。CiA402定义了伺服驱动的对象字典、通信对象（PDO/SDO）、设备状态机以及标准运行模式，使得不同厂商的伺服驱动器能够以统一的方式接入控制系统。理解这一模型，是进行EtherCAT伺服系统调试、优化与故障排查的基石。

上图展示了EtherCAT伺服驱动通信模型的整体架构。主站通过EtherCAT帧与从站控制器（ESC）交换数据，ESC通过FMMU（现场总线内存管理单元）和SyncManager（同步管理器）将过程数据映射到伺服固件可访问的内存区域。伺服固件内部维护着一个符合CiA402规范的对象字典，所有控制参数、状态信息均以标准索引进行寻址。PDO通道负责实时交换周期性的控制字和实际位置等数据，而SDO通道则通过邮箱机制处理非周期的参数读写请求。接下来，我们将深入剖析这一模型的各个组成部分。

3.1 CiA402协议与对象字典

3.1.1 核心原理：CiA402如何统一伺服接口

CiA402是CANopen应用层中针对驱动与运动控制设备的行规（Device Profile），它被EtherCAT的CoE（CANopen over EtherCAT）协议完全继承。该行规的核心价值在于：它定义了一套标准化的对象字典结构，使得任何符合CiA402的驱动器，无论其内部硬件实现如何，对外都呈现相同的控制接口。例如，目标位置总是位于对象0x607A，控制字总是0x6040，状态字总是0x6041。这种标准化极大地降低了系统集成的复杂度——运动控制器无需针对不同品牌的驱动器编写不同的通信驱动代码。

对象字典（OD）是CiA402协议的中枢神经，它是一个有序的对象集合，每个对象通过16位索引（Index）和8位子索引（Subindex）唯一寻址。对象字典不仅存储参数值，还定义了参数的数据类型、访问权限（只读/只写/读写）以及是否在掉电后保存。在EtherCAT从站中，对象字典通常由从站控制器（ESC）的寄存器空间和伺服固件中的RAM/Flash共同实现。

3.1.2 判断方法：如何快速定位对象字典中的关键参数

在实际调试中，工程师需要频繁查阅对象字典。高效的方法不是逐页翻阅手册，而是遵循以下定位逻辑：

1. 明确通信类型：若需周期性下发的数据（如位置指令），优先在0x6000-0x6FFF段查找；若为一次性配置（如PID参数），则在0x2000-0x5FFF段查找。
2. 使用标准索引表：CiA402标准对象（如0x6060运行模式、0x6083轮廓加速度）在所有品牌驱动器中索引号一致，可直接查阅标准文档。
3. 利用EtherCAT从站信息（ESI）文件：ESI文件（XML格式）包含了从站完整的对象字典描述，使用EtherCAT配置工具（如TwinCAT、CODESYS）导入ESI后，可在对象字典浏览器中直接搜索索引或名称。

3.1.3 案例拆解：通过SDO配置电子齿轮比

假设某项目需要将伺服驱动器的电子齿轮比设置为电机每转10000个脉冲对应工作台移动10mm。具体操作如下：

// 使用EtherCAT主站工具（如TwinCAT）发送SDO写请求
// 对象0x6091: 齿轮比分子（Feed Constant）
// 子索引1: 分子值 = 10000
// 子索引2: 分母值 = 10
SDO_Write(0x6091, 0x01, 10000, UNSIGNED32);
SDO_Write(0x6091, 0x02, 10, UNSIGNED32);
// 设置完成后，需将0x6060运行模式切换为位置模式（值=1），并重启使能

此案例中，SDO的非周期性特点完全满足配置需求。若通过PDO周期修改齿轮比，反而会占用宝贵的实时带宽，且可能因频繁写入导致驱动内部计算抖动。

3.1.4 常见误区与总结

• 误区一：混淆PDO与SDO的用途。PDO是“高速公路”上的快速车辆，只运载实时控制数据；SDO是“普通公路”上的货车，适合搬运配置参数。将参数配置放在PDO中会导致总线负载增加且实时性下降。
• 误区二：忽略对象字典的掉电保存属性。部分对象（如0x2000段）默认不保存，掉电后恢复默认值。若需永久保存，必须通过SDO写入0x1010对象（保存参数）触发存储操作。
• 总结：对象字典是伺服驱动的“记忆库”，理解其索引结构和访问规则，是掌握EtherCAT通信的第一步。

3.2 PDO映射与SDO通信机制

3.2.1 核心原理：PDO映射如何构建实时数据通道

PDO（过程数据对象）的设计目标是最小化通信开销，实现确定性的周期数据交换。在EtherCAT中，每个PDO对应一个SyncManager通道，主站和从站通过FMMU将PDO数据映射到ESC的DPRAM（双口RAM）中。PDO映射（PDO Mapping）是指将对象字典中的多个对象（如控制字、目标位置、目标速度）按顺序组合成一个PDO的过程。映射关系由对象0x1600（RxPDO映射参数）和0x1A00（TxPDO映射参数）定义。

例如，一个典型的RxPDO映射可能包含：

// RxPDO映射对象0x1600，子索引0表示映射对象数量=3
0x1600:0x00 = 3
0x1600:0x01 = 0x60400010  // 控制字，16位
0x1600:0x02 = 0x607A0020  // 目标位置，32位
0x1600:0x03 = 0x60FF0020  // 目标速度，32位

映射条目编码格式为：索引（16位）+ 子索引（8位）+ 对象长度（8位）。主站配置工具会根据这些映射参数自动计算PDO的总长度，并分配ESC内存地址。

3.2.2 操作流程：配置PDO映射的完整步骤

1. 停止PDO通信：在修改映射前，必须确保驱动器处于“Switch On Disabled”状态，且主站停止周期通信。
2. 清除现有映射：将0x1600:0x00（映射数量）设置为0，清除子索引1-N。
3. 写入新映射条目：按顺序写入每个映射对象，并更新映射数量。
4. 激活映射：将0x1600:0x00设置为实际映射条目数，并重新启动PDO通信。
5. 验证：通过主站工具读取0x1A00（TxPDO）确认反馈数据映射正确。

3.2.3 实战场景：优化PDO映射以降低总线负载

某包装机械项目，EtherCAT周期为1ms，共连接8台伺服。初始配置中，每台伺服TxPDO映射了10个对象（包括实际位置、实际速度、实际力矩、跟随误差、状态字、数字输入等），导致每周期总线数据量过大，主站CPU占用率高达85%。

分析过程：通过主站抓包分析，发现“跟随误差”和“数字输入”并非每周期必需，仅在故障诊断时需要。于是决定将TxPDO精简为4个对象：状态字、实际位置、实际速度、实际力矩。

实施步骤：

1. 在TwinCAT中停止NC轴，将驱动器置于“Switch On Disabled”。
2. 修改0x1A00映射，将映射数量从10改为4，删除不需要的条目。
3. 重新激活映射，启动周期通信。

结果对比：总线数据量减少约60%，主站CPU占用率降至45%，且系统响应未受影响。后续如需诊断数据，可通过SDO临时读取，或增加一个低速周期的辅助PDO。

3.2.4 常见误区与总结

• 误区一：PDO映射越多越好。过多的映射会增加ESC内存占用和主站处理时间，应遵循“最小必要”原则。
• 误区二：忽略PDO的同步性。EtherCAT支持SM2事件同步和DC（分布式时钟）同步，若PDO映射配置正确但同步模式错误，会导致数据采样时刻不一致，产生控制抖动。
• 总结：PDO映射是EtherCAT实时性的核心，合理的映射设计需要在数据完整性和通信效率之间取得平衡。

3.3 DS402状态机与运行模式

3.3.1 核心原理：状态机如何保障安全与有序控制

CiA402定义了一个标准化的驱动器状态机，包含6个主状态：Start、Not Ready to Switch On、Switch On Disabled、Ready to Switch On、Switched On、Operation Enabled。此外还有两个附加状态：Quick Stop Active和Fault Reaction Active。状态转换由控制字（0x6040）的位0-3和位7触发，驱动器通过状态字（0x6041）反馈当前状态。

状态机的设计哲学是“先安全后使能”。驱动器必须经过一系列安全检查（如急停回路、使能信号、参数合法性）才能进入可运行状态。例如，从“Switch On Disabled”到“Ready to Switch On”需要控制字位0=1、位1=1；从“Ready to Switch On”到“Switched On”需要位0=1、位1=1、位2=1；最终进入“Operation Enabled”需要位0=1、位1=1、位2=1、位3=1。

3.3.2 判断方法：通过状态字快速诊断故障

状态字（0x6041）的位结构提供了丰富的诊断信息：

• 位0（Ready to Switch On）：1表示驱动器已完成初始化，等待使能。
• 位1（Switched On）：1表示主电路已上电。
• 位2（Operation Enabled）：1表示驱动器已使能，可接受运动指令。
• 位3（Fault）：1表示发生故障，需查看0x603F（错误代码）定位原因。
• 位6（Switch On Disabled）：1表示驱动器处于禁用状态，通常为初始上电状态。
• 位7（Warning）：1表示存在警告（如过温预警），但驱动器仍可运行。

3.3.3 案例拆解：运行模式切换与参数配置

某项目需要在不同工艺阶段切换运行模式：在定位阶段使用“轮廓位置模式”（模式值=1），在连续送料阶段使用“速度模式”（模式值=3）。

操作流程：

1. 通过SDO写入0x6060（运行模式）=1，切换至轮廓位置模式。
2. 配置轮廓位置模式参数：0x607A（目标位置）、0x6081（轮廓速度）、0x6083（轮廓加速度）、0x6084（轮廓减速度）。
3. 通过控制字触发状态机：0x06（Shutdown）→ 0x07（Switch On）→ 0x0F（Enable Operation）。
4. 工艺切换时，先将状态机切换至“Switch On Disabled”（控制字=0x00），再写入0x6060=3，重新使能。

关键参数表：

3.3.4 常见误区与总结

• 误区一：跳过状态机直接使能。某些调试人员为图方便，直接向控制字写入0x0F，但驱动器可能因未完成初始化而拒绝执行。必须严格按照状态转换顺序操作。
• 误区二：忽略Quick Stop功能。控制字位7（Quick Stop）是紧急停止信号，触发后驱动器按0x605A（停止选项）定义的减速曲线停车。若未配置0x605A，驱动器可能立即自由停车，造成机械冲击。
• 总结：DS402状态机是伺服驱动的“安全守门员”，运行模式则是“工作模式选择器”。正确理解并应用这两者，是确保设备安全、高效运行的前提。

本章详细阐述了EtherCAT伺服驱动通信模型的四个核心维度：CiA402协议框架、对象字典的寻址与操作、PDO/SDO的映射与通信机制、DS402状态机与运行模式的协同工作。掌握这些内容，意味着你已经具备了阅读伺服驱动器手册、配置EtherCAT主站、排查通信故障的基本能力。在实际项目中，建议始终从对象字典入手，以状态机为操作主线，以PDO映射为性能优化抓手，这样才能构建出既稳定又高效的伺服控制系统。