在多轴工业协作机器人、数控机床进给轴以及自动化立体仓储堆垛机的控制系统中，CANopen（基于 CiA 301 应用层协议与 CiA 402 电机驱动行规）是维系多台伺服驱动器与主控制器之间高速同步运转的经典工业总线纽带。

在工业运动控制场景下，系统面临着极其苛刻的硬实时约束：

• 微秒级多轴同步控制：所有运动轴的伺服驱动器必须在同一物理微秒内同步采样当前编码器实际位置（Actual Position），并同步执行新一轮位置环计算。若各轴之间存在毫秒级的时序离散，机器人末端工具就会走出致命的几何轨迹畸变；
• 最高优先级故障阻断：一旦某台驱动器突发过流、母线过压或机械卡死堵转，该异常必须在微秒级时间内穿透总线上所有常规通信流量，瞬间击穿主控系统并触发全系统协同急停，否则飞速旋转的机械臂将瞬间引发撞机灾难。

为了支撑上述确定性，CANopen 协议栈在底层设计了**同步过程数据对象（Synchronous TPDO）与应急报文（Emergency Object, EMCY）**两大核心机制。

本文将以伺服控制底层驱动开发为蓝本，详解对象字典（OD）的 PDO 动态映射配置，以及基于 CAN 仲裁特性的 EMCY 报文硬抢占响应实战。

---

一、同步 TPDO 触发机制与对象字典（OD）动态映射

在 CANopen 体系中，服务数据对象（SDO）采用请求-应答机制，协议开销大且存在通信等待；而过程数据对象（PDO）剥离了所有协议头，8 字节载荷完全由紧凑的纯业务数据构成，是硬实时数据传输的绝对主力。

[ CANopen 主站 (PLC / 运动控制器) ]
                |
                | 周期性广播 SYNC 同步报文 (COB-ID: 0x080, 周期: 1.00ms)
                v
  +-------------+-------------+-------------+
  |                           |                           |
  v                           v                           v
[ 轴1 伺服驱动器 ]          [ 轴2 伺服驱动器 ]          [ 轴3 伺服驱动器 ]
  |                           |                           |
  (同时硬件锁存编码器位置)    (同时硬件锁存编码器位置)    (同时硬件锁存编码器位置)
  |                           |                           |
  v                           v                           v
TPDO1 (COB-ID: 0x181)       TPDO1 (COB-ID: 0x182)       TPDO1 (COB-ID: 0x183)
发回实际位置与状态字        发回实际位置与状态字        发回实际位置与状态字

1. 同步采样传输（Transmission Type = 1）

将从机驱动器 TPDO1 的通信参数（索引 0x1800，子索引 0x02）配置为 1：

• 驱动器在收到主站发出的全局 SYNC 报文（COB-ID 固定为 0x080）瞬间，硬件输入捕获定时器瞬间冻结当前的 32 位实际物理位置与驱动器状态字；
• 随后驱动器将该数据打包进 TPDO1，并在当前同步周期内依仲裁优先级竞争发回给主站，彻底杜绝了不同驱动器之间由于软件查询时机不同引发的采样相位抖动。

2. 对象字典（Object Dictionary）动态映射步骤

要在伺服驱动器中启用特定的数据映射，必须严格遵循四步时序：

1. 向 0x1800:01 写入带有禁用位（bit31 = 1）的 COB-ID，暂时关闭该 PDO；
2. 向 0x1A00:00 写入 0，清空当前已存在的映射项数量；
3. 依次向 0x1A00:01、0x1A00:02 等子索引写入 32 位映射配置字（格式为：索引(16bit) | 子索引(8bit) | 位宽(8bit)）；
4. 向 0x1A00:00 写入实际映射项总数，并重新使能该 PDO（清除 bit31）。

---

二、EMCY 报文的 CAN 物理层绝对仲裁优势

当电机线圈烧毁、过载或霍尔编码器断线时，错误状态绝对不能通过轮询去发现。

CANopen 协议规定：从站一旦检出内部致命错误，必须立即向总线发射一条 8 字节的 EMCY 应急报文。

1. COB-ID 的极高仲裁优先级

CAN 总线物理层采用非破坏性逐位仲裁机制（Wired-AND 显性逻辑）。报文的 COB-ID（即 11 位 CAN 标识符）数值越小，在总线冲突时优先级越高：

• 网络管理广播（NMT）：COB-ID = 0x000（最高）；
• 同步报文（SYNC）：COB-ID = 0x080；
• EMCY 应急报文：COB-ID = 0x080 + Node_ID（范围 0x081 ~ 0x0FF）；
• 常规过程数据（PDO）：COB-ID = 0x180 + Node_ID 以上；
• 服务数据对象（SDO）：COB-ID = 0x580 + Node_ID（最低）。

从上述 ID 分布清晰可见：EMCY 的 COB-ID 数值极小，其优先级凌驾于全网所有的数据传输（PDO、SDO）之上！ 无论当时总线上正在狂飙多少组数据，EMCY 都能在仲裁场直接将其他业务报文强行压制，在纳秒级抢下总线发射权。

2. EMCY 标准报文帧格式

EMCY 报文严格占用 8 字节数据：

• Byte 0~1（16位）：标准应急错误代码（Emergency Error Code，如 0x2310 表示连续过流，0x3210 表示直流母线过压，0x7300 表示传感器反馈断线）；
• Byte 2（8位）：错误寄存器标志位（对应对象字典 0x1001）；
• Byte 3~7（5字节）：厂商自定义诊断数据（如故障瞬间的相电流实测采样值与逆变桥温度）。

---

三、CANopen 主站 PDO 映射与 EMCY 抢占分发 C 语言核心实现

以下为工业运动控制主站协议栈核心处理代码，展示了 TPDO 接收同步解析以及在 CAN 硬中断底半部瞬间捕获 EMCY 的实战逻辑：

#include <stdint.h>
#include <stdbool.h>
#include <string.h>

#define MAX_CAN_NODES 16

/* CANopen 标准报文类型掩码 */
#define CANOPEN_COB_SYNC      0x080U
#define CANOPEN_EMCY_BASE     0x080U
#define CANOPEN_TPDO1_BASE    0x180U

#pragma pack(push, 1)
typedef struct {
    uint16_t error_code;       /* CiA 301 标准错误代码 */
    uint8_t  error_register;   /* 对应对象字典 0x1001 */
    uint8_t  mfg_specific[5];  /* 厂商内部故障追踪上下文 (电流/温度等) */
} canopen_emcy_payload_t;

typedef struct {
    int32_t actual_position;   /* 映射对象 0x6064:00 (32 位实际位置) */
    uint16_t status_word;      /* 映射对象 0x6041:00 (16 位状态字) */
    int16_t  actual_current;   /* 映射对象 0x6078:00 (16 位实际电流) */
} tpdo1_servo_feedback_t;
#pragma pack(pop)

typedef struct {
    uint8_t node_id;
    bool is_faulted;
    uint16_t last_emcy_code;
    tpdo1_servo_feedback_t feedback;
} servo_axis_state_t;

static servo_axis_state_t g_axes[MAX_CAN_NODES];

/* 紧急故障刹车物理硬件接口声明 */
extern void HW_Emergency_Brake_Trigger_All(void);

/* 
 * CAN 接收中断分发器 (运行于高优先级中断底半部)
 * can_id: 11 位标准标识符
 * data: 8 字节物理数据
 */
void CANopen_Rx_Interrupt_Dispatcher(uint32_t can_id, const uint8_t *data, uint8_t dlc) {
    /* 1. 优先过滤判定是否为极高优先级的 EMCY 报文 (0x081 ~ 0x0FF) */
    if (can_id > CANOPEN_EMCY_BASE && can_id < (CANOPEN_EMCY_BASE + MAX_CAN_NODES)) {
        uint8_t node_id = (uint8_t)(can_id - CANOPEN_EMCY_BASE);
        const canopen_emcy_payload_t *emcy = (const canopen_emcy_payload_t *)data;

        g_axes[node_id].is_faulted = true;
        g_axes[node_id].last_emcy_code = emcy->error_code;

        /* 
         * 核心动作：毫秒级多轴联动安全阻断！
         * 检测到任意单轴抛出过流 (0x23xx) 或编码器故障 (0x73xx)，
         * 立即击发全局安全制动继电器，所有轴硬件抱闸，彻底杜绝机械飞车
         */
        HW_Emergency_Brake_Trigger_All();

        /* 向系统总线控制台输出结构化故障告警 */
        Log_Emergency_Fault(node_id, emcy->error_code, emcy->error_register);
        return;
    }

    /* 2. 解析常规同步反馈 TPDO1 报文 (0x181 ~ 0x1FF) */
    if (can_id > CANOPEN_TPDO1_BASE && can_id < (CANOPEN_TPDO1_BASE + MAX_CAN_NODES)) {
        uint8_t node_id = (uint8_t)(can_id - CANOPEN_TPDO1_BASE);
        if (dlc == sizeof(tpdo1_servo_feedback_t)) {
            memcpy(&g_axes[node_id].feedback, data, sizeof(tpdo1_servo_feedback_t));
        }
        return;
    }
}

/* 主站同步周期定时器中断例程 (以 1.00ms 恒定周期击发) */
void CANopen_Master_Sync_Tick_ISR(void) {
    uint8_t empty_payload = 0;
    
    /* 向总线以极高优先级注入 SYNC 同步广播 (COB-ID: 0x080) */
    HW_CAN_Transmit_Fast(CANOPEN_COB_SYNC, &empty_payload, 0);

    /* 随后触发当前周期的多轴插补轨迹计算 */
    Motion_Controller_Update_Trajectory();
}

---

四、CAN 分析仪抓包与总线对账实战

使用工业 CAN 分析仪抓取 1Mbps 波特率下的总线报文，我们记录了一次伺服电机突发堵转故障时的真实物理时序：

时间戳(ms)   COB-ID   类型   数据 (DLC=8)             解析说明
-------------------------------------------------------------------------------
100.0000     0x080    标准   (无载荷)                 主站发送 SYNC 同步节拍
100.0080     0x181    数据   64 00 00 00 37 02 10 00  轴1 正常发回 TPDO1
100.0160     0x182    数据   20 01 00 00 37 02 12 00  轴2 正常发回 TPDO1
100.0240     0x183    数据   88 02 00 00 37 02 0F 00  轴3 正常发回 TPDO1
...
101.0000     0x080    标准   (无载荷)                 主站发送下一个 SYNC 节拍
101.0042     0x082    数据   10 23 01 55 0A 00 00 00  【轴2 突发堵转抛出 EMCY!】
101.0045     (硬件急停生效，主站光耦输出切断全轴使能，总线立即进入安全锁定状态)

对账分析表明：轴 2 驱动器在检出堵转过流后，发出的 0x082 EMCY 报文在仅 $42\mu\text{s}$ 的窗口内便瞬间压制了原本即将发送的 TPDO1，成功抢占总线并直达主控。主控硬件制动在 $3\mu\text{s}$ 内彻底切断动力回路，避免了数十万元高精度减速机的机械崩齿。

深入掌握 CANopen 同步 PDO 的确定性映射规则，并充分激活 EMCY 报文在 CAN 仲裁场中的绝对物理优先权，是打造零失步、零冲撞、高安全工业运动控制系统的核心底牌。