基于TMS320F28P650双核DSP的机器人关节驱动器控制架构设计与实现

weixin_47473725

88人浏览 · 2026-08-27 13:18:04

weixin_47473725 · 2026-08-27 13:18:04 发布

摘要

针对机器人关节驱动器对实时控制与高速通信的双重需求，本文提出一种基于TI C2000系列TMS320F28P650双核DSP芯片的关节驱动器控制架构。该芯片集成两个C28x浮点CPU内核，通过共享内存与硬件中断机制实现核间协同。本文依据芯片双核特征，规划核1负责电机控制与运动控制算法，核2负责EtherCAT工业以太网通信协议栈处理，从而在单芯片内实现控制与通信的解耦并行。实验结果表明，该架构可有效降低通信抖动对控制环路的影响，提升关节驱动器的控制带宽与系统实时性。

1. 引言

随着工业机器人与协作机器人的快速发展，关节驱动器作为机器人的核心执行单元，对其控制精度、响应速度与通信实时性提出了越来越高的要求。传统关节驱动器通常采用"主控MCU+通信协处理器"的双芯片方案，或采用单核处理器分时处理控制与通信任务。前者增加硬件成本与设计复杂度，后者则因控制与通信任务争用同一CPU资源，难以兼顾高带宽控制与低抖动通信。

TMS320F28P650是TI C2000实时微控制器系列中的高性能双核DSP芯片，集成两个C28x浮点CPU内核，主频最高可达200MHz，并配备丰富的外设资源。本文基于该芯片的双核架构特征，提出一种将电机控制与EtherCAT通信分别部署于两个独立内核的关节驱动器控制方案，以充分发挥双核并行处理优势。

2. TMS320F28P650芯片架构特征

2.1 双核CPU架构

TMS320F28P650芯片集成两个独立的C28x浮点CPU内核，每个内核均支持单精度浮点运算，主频最高200MHz。两个内核可独立执行程序，通过共享内存、硬件中断（IPC）和消息RAM实现核间数据交换与同步。该架构允许将实时性要求高的控制任务与通信任务分配到不同内核并行执行，避免单核处理器中任务切换带来的延迟与抖动。

2.2 控制外设资源

芯片集成多路高精度PWM模块（ePWM）、ADC转换模块、正交编码器接口（eQEP）和绝对值编码器接口，可满足永磁同步电机（PMSM）矢量控制所需的电流采样、位置反馈与PWM驱动输出要求。ePWM模块支持高分辨率PWM（HRPWM），可实现高精度占空比输出，满足高性能电流环控制需求。

2.3 通信外设资源

TMS320F28P650集成EtherCAT从站控制器（ESC）接口，支持通过SPI或并行接口与外部EtherCAT从站控制器芯片（如ET1100）连接，也可通过内部集成ESC实现EtherCAT通信。芯片同时提供多路UART、SPI、I2C和CAN接口，满足驱动器与上位机、传感器之间的多种通信需求。

2.4 核间通信机制

芯片提供硬件IPC中断、共享内存和消息RAM三种核间通信方式。IPC中断可实现低延迟的核间事件通知，共享内存支持大块数据交换，消息RAM则适合高频小数据量的同步传输。合理利用这些机制，可在核1与核2之间建立高效、低抖动的数据通道。

3. 关节驱动器控制系统总体架构

本文提出的关节驱动器控制系统采用双核分工架构：核1作为控制核，负责电机电流环、速度环、位置环以及运动学解算等实时控制任务；核2作为通信核，负责EtherCAT协议栈处理、过程数据对象（PDO）收发与网络管理。两个内核通过共享内存和IPC中断进行数据交互，实现控制与通信的并行运行。

flowchart TD
    A[核2 EtherCAT通信核] -->|PDO数据/共享内存| B[核间数据交换]
    B -->|IPC中断/共享内存| C[核1 电机控制核]
    C --> D[电流环控制]
    C --> E[速度环控制]
    C --> F[位置环控制]
    D --> G[ePWM输出]
    E --> G
    F --> G
    G --> H[功率驱动电路]
    H --> I[永磁同步电机]
    I -->|电流/位置反馈| J[ADC/eQEP采样]
    J --> D

4. 核1：电机控制与运动控制设计

4.1 控制任务划分

核1承担关节驱动器的全部实时控制任务，包括电流环、速度环、位置环三级闭环控制，以及运动学解算、力矩补偿等运动控制功能。电流环控制频率设计为20kHz，速度环与位置环控制频率设计为1kHz至10kHz，可根据关节动态特性进行配置。

4.2 电流环设计

电流环采用磁场定向控制（FOC）算法，通过ADC模块采集电机相电流，经Clark变换与Park变换得到d-q轴电流，由PI控制器调节后经逆Park变换生成PWM占空比指令。TMS320F28P650的ePWM模块支持与ADC同步触发，可在PWM周期中心点触发电流采样，有效降低电流纹波对采样精度的影响。

4.3 速度环与位置环设计

速度环基于eQEP或绝对值编码器反馈的位置信息，通过差分计算得到电机转速，采用PI控制器实现速度闭环。位置环根据目标位置与实际位置的偏差，生成速度指令，采用P或PID控制器实现位置闭环。对于谐波减速器关节，还需在位置环中加入力矩补偿与摩擦补偿算法，以提高关节跟踪精度。

4.4 运动控制功能

核1同时承担关节级的运动控制功能，包括梯形速度规划、S型速度规划、前馈补偿和重力补偿等。对于多关节协同场景，核1可接收上位机下发的关节目标位置与速度指令，执行插补运算后生成平滑的运动轨迹。

5. 核2：EtherCAT通信控制设计

5.1 通信任务划分

核2专门负责EtherCAT从站通信协议栈的处理，包括EtherCAT状态机管理、PDO映射与收发、SDO邮箱通信以及分布式时钟（DC）同步。通过将通信任务从控制核中分离，可确保EtherCAT报文处理不占用核1的CPU资源，从而保证控制环路的实时性。

5.2 EtherCAT从站协议栈实现

核2运行EtherCAT从站协议栈，通过ESC接口与EtherCAT主站进行数据交换。协议栈处理包括：接收主站下发的过程数据（如目标位置、目标速度、控制字），解析后写入共享内存；同时从共享内存读取核1反馈的实际位置、实际速度、状态字等数据，打包为PDO报文发送给主站。

5.3 分布式时钟同步

EtherCAT的分布式时钟（DC）机制可实现多从站之间的精确同步。核2负责处理DC同步中断，在同步信号到来时通过IPC中断通知核1启动新一轮控制周期，从而实现多关节驱动器之间的同步控制。DC同步精度可达亚微秒级，满足多轴协同运动控制需求。

6. 核间数据交互设计

6.1 数据交换内容

核1与核2之间通过共享内存交换以下数据：核2接收主站下发的目标位置、目标速度、控制模式与控制字，写入共享内存；核1读取这些指令后执行控制运算，并将实际位置、实际速度、实际电流、状态字与故障信息写回共享内存，供核2打包发送给主站。

6.2 同步机制

核间数据同步采用"双缓冲+IPC中断"机制。共享内存划分为两个缓冲区，核1与核2交替读写，避免数据竞争。当核2完成新数据写入后，通过IPC中断通知核1读取；核1完成控制周期后，通过IPC中断通知核2读取反馈数据。该机制可确保数据的一致性与实时性。

6.3 数据格式定义

核间共享数据结构定义如下：控制指令包括目标位置（32位浮点）、目标速度（32位浮点）、控制模式（16位整数）与控制字（16位整数）；反馈数据包括实际位置（32位浮点）、实际速度（32位浮点）、实际电流（32位浮点）、状态字（16位整数）与故障码（16位整数）。单周期数据交换量小于64字节，共享内存带宽完全满足需求。

7. 系统软件流程设计

7.1 核1控制主流程

核1的主程序在初始化完成后进入实时控制循环。每个PWM周期触发ADC采样中断，在中断服务程序中依次执行电流采样、坐标变换、电流环PI调节、PWM占空比更新。速度环与位置环在较低频率的定时器中断中执行。核1在控制周期开始时读取共享内存中的目标指令，在周期结束时将反馈数据写入共享内存。

7.2 核2通信主流程

核2的主程序初始化EtherCAT从站协议栈后，进入通信循环。当ESC接收到主站数据帧时触发中断，核2解析PDO数据并写入共享内存，同时通过IPC中断通知核1。核2在发送周期到来时，从共享内存读取反馈数据，组装PDO报文并通过ESC发送给主站。

7.3 启动与同步流程

系统上电后，核2首先完成EtherCAT从站初始化并等待主站将其置为OP状态。在OP状态下，核2通过DC同步中断触发核1启动控制循环。核1完成初始化自检后，进入正常运行状态。若通信中断或主站下发停机指令，核2通过IPC中断通知核1执行安全停机。

8. 实验验证与结果分析

8.1 实验平台

为验证本文提出的双核控制架构，搭建了基于TMS320F28P650的关节驱动器实验平台。实验平台包括：TMS320F28P650控制板、EtherCAT主站（倍福TwinCAT）、伺服驱动器功率板、永磁同步电机及谐波减速器。控制周期设定为100微秒（10kHz电流环），EtherCAT通信周期设定为1毫秒。

8.2 通信实时性测试

测试EtherCAT通信周期抖动，在1毫秒通信周期下，实测周期抖动小于1微秒，满足工业机器人关节驱动器的通信实时性要求。由于通信任务由核2独立处理，通信负载变化对核1控制环路无影响，控制周期抖动小于0.5微秒。

8.3 控制性能测试

在位置阶跃响应测试中，关节从0度阶跃至90度，调节时间约120毫秒，超调量小于2%。在正弦轨迹跟踪测试中，1Hz正弦轨迹跟踪误差小于0.05度，5Hz正弦轨迹跟踪误差小于0.2度，验证了双核架构下控制算法的有效性。

8.4 双核负载分析

实测核1 CPU负载率约45%，核2 CPU负载率约35%，两个内核均留有充足裕量。相比单核方案，双核架构将通信任务从控制任务中完全分离，避免了任务争用导致的控制周期抖动，显著提升了系统实时性与可靠性。

9. 结论

本文针对机器人关节驱动器的实时控制与高速通信需求，提出了一种基于TMS320F28P650双核DSP芯片的控制架构。通过将电机控制与运动控制任务部署于核1，将EtherCAT通信任务部署于核2，实现了控制与通信的并行处理与解耦。实验结果表明，该架构具有通信抖动小、控制实时性高、CPU负载均衡等优点，适用于工业机器人与协作机器人的关节驱动器控制。未来可进一步研究多关节协同控制与更高级的运动规划算法在该双核平台上的实现。