如何通过EtherCAT读取轴的零点状态？

Question

在使用EtherCAT通信协议控制伺服轴时，如何准确读取轴的零点（原点）状态是运动控制系统中的常见需求。许多开发者在通过CoE（CAN over EtherCAT）协议访问伺服驱动器对象字典时，不清楚应读取哪个对象索引来获取零点开关状态。常见问题包括：混淆“归零完成标志”与“零点开关输入信号”的区别，误将位置传感器的零位当作机械原点；或未正确解析PDO映射中Digital Inputs的位字段，导致无法实时获取限位及原点信号。此外，不同厂商（如Beckhoff、INOVANCE、Siemens）对零点信号的对象字典定义存在差异，进一步增加了开发难度。如何跨平台统一读取并解析轴的零点状态，成为实现可靠回零操作的关键技术难点。

Answer 1

一、EtherCAT伺服轴零点状态读取的深度解析

1. 基础概念：什么是“零点”与“归零”？

在运动控制系统中，“零点”（也称机械原点或参考点）是轴执行回零操作后建立的基准位置。该点通常由物理传感器（如光电开关、霍尔元件）触发，用于校准绝对位置或相对坐标系起点。

常见的误解包括：

• 将编码器的“电气零位”误认为是机械原点；
• 混淆“归零完成标志”（Homing Attained）与“零点输入信号”（Home Switch Input）；
• 忽视PDO映射对实时性的影响。

理解这些差异是准确获取零点状态的前提。

2. CoE协议下的对象字典结构分析

EtherCAT使用CANopen over EtherCAT（CoE）作为应用层协议，其核心为对象字典（Object Dictionary），通过索引（Index）和子索引（Subindex）访问设备参数。

与零点相关的常见对象包括：

对象名称	标准索引	数据类型	说明
Digital Inputs	0x60FD	UINT32	包含限位、原点等数字输入信号
Homing Status	0x6041	UINT16	状态字，含归零完成标志位
Homing Attained	0x6041 Bit 12	BIT	归零动作是否成功完成
Home Switch Signal	厂商自定义位域	BIT in 0x60FD	实际零点开关输入电平
Position Sensor Type	0x60FB	UINT32	判断是否使用增量式编码器
Control Word	0x6040	UINT16	发送归零命令
Status Word	0x6041	UINT16	反馈当前运行状态
Min/Max Position Limit	0x607D, 0x607B	INT32	软限位设置
Vendor-Specific Home Input	如0x2001:0x02	厂商定义	某些品牌专用映射
PDO Mapping for DI	0x1A00+ 或 0x1600+	Rec. Struct	决定是否包含数字输入

3. 实时信号采集路径：从PDO到应用层

为了实现高实时性，零点信号应通过过程数据对象（PDO）周期性传输，而非仅用SDO轮询。

典型PDO映射流程如下：

// 示例：配置RPDO（接收）与TPDO（发送）
// TPDO1 映射数字输入至过程数据
SDO_Write(0x1A00, 0x00, 0x01); // Number of mapped objects = 1
SDO_Write(0x1A00, 0x01, 0x60FD0020); // Map 0x60FD[0], 32-bit Digital Inputs

// 启用TPDO传输
SDO_Write(0x1800, 0x02, 0x01); // COB-ID: Sync Manager Event
SDO_Write(0x1800, 0x03, 0x01); // Transmission Type: On SYNC
    

一旦正确映射，主站可在每个EtherCAT周期读取0x60FD的值，并解析其中的零点信号位。

4. 不同厂商实现差异对比

尽管CiA 402规范定义了通用行为，但各厂商在零点信号处理上存在显著差异：

厂商	零点信号对象	位位置	归零完成标志	备注
Beckhoff EL72xx	0x60FD	Bit 12	0x6041 Bit 12	支持多模式回零
INOVANCE IS620N	0x60FD	Bit 10	0x6041 Bit 12	需启用DI功能块
Siemens S210	0x60FD	Bit 9	0x6041 Bit 12	依赖固件版本
Yaskawa Σ-7	0x60FD	Bit 11	0x6041 Bit 12	支持双原点输入
WAGO 750-362	0x60FD	Bit 13	0x6041 Bit 12	需配置I/O模块
KEB F5	0x60FD	Bit 8	0x6041 Bit 12	可重映射DI通道
Lenze 9400	0x60FD	Bit 14	0x6041 Bit 12	支持PLCopen Motion
Mitsubishi MR-J4	0x60FD	Bit 10	0x6041 Bit 12	需设置Pr.PA01=1
Omron G5	0x60FD	Bit 12	0x6041 Bit 12	支持同步捕获
B&R ACOPOS	0x60FD	Bit 15	0x6041 Bit 12	集成于Automation Studio

5. 零点信号解析方法论

要准确提取零点状态，需结合多个对象进行交叉验证：

1. 检查PDO是否已映射0x60FD（Digital Inputs）；
2. 读取0x60FD的原始值，定位原点输入对应的位（如Bit 10）；
3. 根据硬件接线判断是常开（NO）还是常闭（NC）触点；
4. 结合0x6041的状态字，检测Bit 12（Homing Attained）是否置位；
5. 确认控制模式为回零模式（Operation Mode = 6 或 25）；
6. 使用上升沿/下降沿检测避免抖动误判；
7. 记录触发时刻的位置寄存器（0x6064）以校验一致性；
8. 若使用增量编码器，必须执行回零流程才能建立绝对坐标；
9. 对于多圈绝对值编码器，仍需验证机械原点对齐；
10. 在安全逻辑中加入超时与异常检测机制。

6. 跨平台统一接口设计建议

为应对不同厂商设备差异，推荐构建抽象层来统一访问零点状态：

typedef struct {
    uint32_t digital_input_value;
    bool home_switch_active;
    bool homing_attained;
    uint8_t home_bit_position;
    uint16_t status_word;
} AxisHomeInfo;

bool ParseHomeSignal(AxisHomeInfo* info) {
    info->digital_input_value = ReadPdoData(0x60FD);
    info->status_word = ReadPdoData(0x6041);

    // 动态配置位位置（可通过配置文件加载）
    info->home_switch_active = 
        (info->digital_input_value >> info->home_bit_position) & 0x01;

    info->homing_attained = (info->status_word >> 12) & 0x01;

    return info->home_switch_active && info->homing_attained;
}
    

7. 可视化诊断流程图

以下为判断伺服轴是否成功回零的逻辑流程：

graph TD
            A[启动回零命令] --> B{PDO映射包含0x60FD?}
            B -- 是 --> C[读取0x60FD数值]
            B -- 否 --> D[配置TPDO映射0x60FD]
            D --> C
            C --> E[提取指定bit状态]
            E --> F{信号有效? (上升/下降沿)}
            F -- 是 --> G[检查0x6041 Bit12]
            F -- 否 --> H[继续等待或超时]
            G --> I{Bit12=1?}
            I -- 是 --> J[回零成功, 设置原点偏移]
            I -- 否 --> K[检查错误代码0x603F]
            K --> L[处理故障: 干扰、接线错误等]

8. 常见问题与调试技巧

开发过程中常遇到的问题及解决方案：

• 问题：0x60FD始终为0或固定值
  原因：PDO未正确映射或SM同步配置错误
  解决：检查ESC寄存器0x1C12/0x1C13配置
• 问题：归零完成后状态字未更新
  原因：未发送正确的Control Word指令序列
  解决：按CiA 402顺序执行Enable -> Homing Start
• 问题：零点信号抖动导致误触发
  原因：机械振动或电气干扰
  解决：增加软件滤波或硬件RC电路
• 问题：不同批次驱动器位定义不一致
  原因：固件升级或型号变更
  解决：建立设备指纹库并动态加载配置