发那科机器人配件（中国）服务中心    

使用 CANopen 协议控制伺服电机是工业自动化中常见的方案，适用于需要高精度、多轴协同或远程控制的场景。以下是实现 CANopen 控制伺服电机的完整流程，包括硬件连接、参数配置和控制逻辑：

一、系统组成与硬件连接

1. 核心组件

• CANopen 伺服驱动器：支持 CANopen 协议（如 CiA 402 标准，定义了伺服驱动的状态机和控制字）。

• 伺服电机：与驱动器匹配（功率、编码器类型需一致）。

• CANopen 主站：如 PLC（带 CAN 模块）、工业电脑（配 CAN 卡）或单片机（带 CAN 控制器）。

• 辅助设备：

• CAN 总线电缆（屏蔽双绞线，推荐截面积 0.5mm² 以上）。

• 终端电阻（120Ω，需接在总线两端，防止信号反射）。

• 电源（驱动器需 DC24V 控制电源 + AC380V/220V 动力电源）。

2. 接线步骤

• CAN 总线连接：

1. 主站的 CAN_H 接驱动器的 CAN_H，主站的 CAN_L 接驱动器的 CAN_L（严格区分，反接会导致通信失败）。

2. 在总线两端的设备（如主站和最远端驱动器）的 CAN_H 与 CAN_L 之间接入 120Ω 终端电阻（部分驱动器可通过拨码设置内置终端电阻）。

• 电源连接：

1. 驱动器控制电源（DC24V）：L + 接 24V 正极，M 接 24V 负极（需与主站共地，减少干扰）。

2. 驱动器动力电源：按铭牌接入 AC380V/220V（注意接地保护）。

• 电机连接：

1. 电机三相线（U、V、W）接驱动器对应端子（相序错误会导致电机反转，可通过参数调整或交换线缆纠正）。

2. 编码器线：按驱动器手册接编码器信号（A、B、Z 相或差分信号），确保反馈正常。

二、CANopen 协议核心配置（基于 CiA 402 标准）

CANopen 通过对象字典（Object Dictionary）定义设备参数，控制伺服需重点配置以下对象：

1. 基础参数配置（非易失性，需保存到驱动器）

• 节点 ID（索引 0x1005）：设置驱动器的 CANopen 节点地址（如 1-127，需与主站配置一致）。

• 波特率（索引 0x1006）：设置 CAN 总线速率（如 250kbit/s、500kbit/s、1Mbit/s，主从站必须相同）。

• 控制模式（索引 0x6060）：

• 0x01：位置模式（控制电机转动到指定位置）。

• 0x03：速度模式（控制电机以指定转速运行）。

• 0x04：扭矩模式（控制电机输出指定扭矩）。

2. 控制与状态字（实时通信）

• 控制字（索引 0x6040）：主站发送指令控制电机状态，关键位定义：

  位	功能（1 有效）	典型组合指令
  0	启动使能（Switch On）	0x0006 → 准备运行
  1	关闭使能（Switch Off）	0x0007 → 使能运行
  2	故障复位（Reset）	0x0080 → 复位故障
  4	点动模式（Jog）	0x001F → 点动正转

• 状态字（索引 0x6041）：驱动器返回当前状态，关键位定义：

  位	状态含义	正常运行状态值
  0	准备就绪（Ready）	0x0016 → 准备就绪
  1	运行中（Switched On）	0x0018 → 已使能
  3	故障（Fault）	0x000F → 故障报警

3. 运动参数（根据控制模式配置）

• 位置模式：

• 目标位置（0x607A）：单位为脉冲或用户单位（需与电子齿轮比匹配）。

• 运行速度（0x6081）：限制目标位置的运行速度。

• 速度模式：

• 目标速度（0x6042）：单位为 rpm 或用户单位（需设置速度单位参数 0x60A4）。

• 扭矩模式：

• 目标扭矩（0x6071）：单位为百分比或 Nm（需设置扭矩常数 0x2030）。

三、控制流程（以位置模式为例）

1. 初始化通信：

• 主站发送 NMT 指令（Network Management）：0x01 0x00（所有节点进入预操作状态）→ 0x01 [节点 ID]（指定节点进入操作状态）。

• 读取驱动器状态字（0x6041），确认状态为 0x0016（准备就绪）。

2. 使能驱动器：

• 主站向控制字（0x6040）写入 0x0006（准备运行）→ 等待状态字变为 0x0016。

• 写入 0x0007（使能运行）→ 等待状态字变为 0x0018（已使能）。

3. 发送位置指令：

• 向目标位置（0x607A）写入目标值（如 10000 脉冲）。

• 向控制字（0x6040）写入 0x000F（启动运动）→ 电机开始运行。

4. 停止与复位：

• 写入 0x0007（停止运动，保持使能）→ 电机减速停止。

• 若需关闭使能：写入 0x0006 → 0x0000。

• 若出现故障（状态字 0x000F）：写入 0x0080（故障复位），排查故障后重新使能。

四、编程示例（PLC 主站，结构化文本 ST）

以下是基于 PLCopen 标准的 CANopen 控制程序片段（以西门子 S7-1200+CAN 模块为例）：

st

// 定义CANopen对象字典索引
VAR_GLOBAL
    NodeID: UINT := 1; // 伺服驱动器节点ID
    CtrlWord: UINT := 0; // 控制字
    StatusWord: UINT := 0; // 状态字
    TargetPos: DINT := 0; // 目标位置
END_VAR

// 初始化通信
IF NOT InitDone THEN
    CANopen_NMT(NodeID := NodeID, Command := 16#01); // 进入操作状态
    InitDone := TRUE;
END_IF

// 读取状态字
StatusWord := CANopen_ReadObject(NodeID := NodeID, Index := 16#6041, SubIndex := 0);

// 使能驱动器
CASE DriveState OF
    0: // 未初始化
        IF StatusWord = 16#0016 THEN
            CtrlWord := 16#0006; // 准备运行
            DriveState := 1;
        END_IF
    1: // 准备使能
        CANopen_WriteObject(NodeID := NodeID, Index := 16#6040, SubIndex := 0, Data := CtrlWord);
        IF StatusWord = 16#0016 THEN
            CtrlWord := 16#0007; // 使能运行
            DriveState := 2;
        END_IF
    2: // 已使能
        IF StatusWord = 16#0018 THEN
            // 发送目标位置（示例：10000脉冲）
            TargetPos := 10000;
            CANopen_WriteObject(NodeID := NodeID, Index := 16#607A, SubIndex := 0, Data := TargetPos);
            CtrlWord := 16#000F; // 启动运动
            CANopen_WriteObject(NodeID := NodeID, Index := 16#6040, SubIndex := 0, Data := CtrlWord);
            DriveState := 3;
        END_IF
END_CASE

五、关键注意事项

1. 总线抗干扰：

• 采用屏蔽双绞线，屏蔽层单端接地（主站侧）。

• 避免与强电电缆（如动力线）并行敷设，间距≥30cm。

• 波特率选择：短距离（<100m）用 1Mbit/s，长距离（<500m）用 250kbit/s。

2. 参数一致性：

• 电子齿轮比（0x6090/0x6091）需根据电机编码器线数和负载减速比设置，确保位置指令与实际位移一致。

• 限位开关（0x607E/0x607F）需正确配置（硬件 / 软件限位），防止超程故障。

3. 故障排查：

• 通信失败：检查 CAN 线连接、终端电阻、节点 ID 和波特率。

• 电机不转：检查控制字序列是否正确、状态字是否有故障码（需查驱动器手册解码）。

• 运行不稳定：检查编码器接线、增益参数（位置环 / 速度环 PID）是否匹配负载特性。

通过以上步骤，可实现 CANopen 协议对伺服电机的精准控制。实际应用中需结合具体驱动器手册（如台达 ASD-A2、施耐德 LXM32 等）调整参数细节，确保系统稳定运行。