树莓派CM5与CAN总线在移动机器人控制中的实践

1. 项目背景与核心价值

树莓派Compute Module 5（CM5）作为工业级嵌入式计算机的最新力作，结合CAN总线在工业控制领域的高可靠性，为移动机器人开发者提供了前所未有的性价比方案。我在工业自动化领域深耕八年，见证过从传统PLC控制器到现代嵌入式方案的转型过程，这套组合最让我惊艳的是在保持2000元以内硬件成本的同时，实现了传统数万元级控制器的实时性能。

去年为某仓储物流企业部署AGV车队时，我们通过CM5+CAN方案将单台控制成本降低了72%，且故障率比原有方案下降40%。这种架构的核心优势在于：CM5继承了树莓派丰富的软件生态，而CAN总线解决了移动机器人最头疼的电磁干扰问题。特别适合需要同时处理视觉识别、路径规划和多电机协同的场景，比如巡检机器人、自动化叉车或教育用机器人平台。

2. 硬件选型与接口设计

2.1 CM5载板定制要点

市面主流载板如Waveshare的CM5-IO-BASE虽然能用，但针对机器人应用建议优先考虑带以下特性的载板：

• 双CAN FD接口（MCP2518FD芯片方案）
• 12V-36V宽电压输入
• 带隔离的RS485接口
• 至少4路PWM输出

实测中发现，使用带光耦隔离的CAN接口能有效避免电机启停时导致的通信丢包。我曾用示波器对比过隔离与非隔离方案，在500W伺服电机工作时，非隔离方案的错误帧数量会暴增20倍。

2.2 CAN节点布局规范

移动机器人的典型CAN网络应遵循"一主多从"结构：

code复制[CM5作为主节点]
  ├── [电机驱动器] (节点ID 0x101)
  ├── [IMU传感器] (节点ID 0x201)  
  └── [急停开关模块] (节点ID 0x301)

关键参数设置建议：

• 波特率：1Mbps（短距离）/500Kbps（线长>5m）
• 采样点：建议75%-80%位周期
• 终端电阻：必须在总线两端各接120Ω电阻

警告：我曾见过因终端电阻缺失导致CAN通信时好时坏的案例，症状表现为随机出现"总线关闭"错误，这种问题用逻辑分析仪都难以捕捉，建议上电前先用万用表测量CANH-CANL间阻值是否为60Ω。

3. 实时控制系统搭建

3.1 实时内核配置

CM5默认内核并不适合硬实时控制，需要打上PREEMPT_RT补丁：

bash复制# 下载指定版本内核源码（必须与树莓派官方版本严格匹配）
wget https://github.com/raspberrypi/linux/archive/refs/tags/raspi-5.15.y.zip
unzip raspi-5.15.y.zip

# 应用实时补丁
patch -p1 < patch-5.15.72-rt55.patch

# 关键配置项
CONFIG_PREEMPT_RT_FULL=y
CONFIG_HIGH_RES_TIMERS=y
CONFIG_NO_HZ_FULL=y

编译后实测线程调度延迟可从毫秒级降至50μs以内，足够控制20kHz以下的PWM信号。有个容易忽略的细节：务必关闭CPU频率调节：

bash复制sudo systemctl disable ondemand
sudo cpupower frequency-set --governor performance

3.2 CAN通信协议设计

推荐采用CANopen协议框架，其对象字典机制特别适合机器人多节点协同。以控制直流无刷电机为例，需要定义以下关键PDO：

在CM5上使用can-utils工具测试通信：

bash复制# 发送位置指令到0x101节点
cansend can0 101#6040000F606001607A0000C350

4. 运动控制算法实现

4.1 多轴插补算法

基于ROS2的实时控制方案中，需要在rt线程内实现梯形速度规划。核心算法流程：

1. 路径离散化：将连续轨迹按0.1mm间隔离散为点列
2. 速度前瞻：扫描后续20个点计算允许最大速度
3. 加速度约束：根据电机特性限制加速度变化率

关键C++代码片段：

cpp复制void TrajectoryPlanner::update() {
  // 计算当前段剩余距离
  double remaining = total_length - traveled; 
  
  // 速度规划核心逻辑
  if (remaining < decel_distance) {
    current_vel -= max_acc * dt;
  } else if (current_vel < target_vel) {
    current_vel += max_acc * dt;
  }
  
  // 位置增量计算
  delta_pos = current_vel * dt;
  traveled += delta_pos;
}

4.2 闭环控制实践

通过CAN总线读取电机编码器反馈时，要注意时序同步问题。我的经验是：

1. 使用SYNC报文（CAN ID 0x80）触发所有节点同步采样
2. 在SYNC回调中读取所有PDO数据
3. 控制周期与SYNC周期保持整数倍关系

典型PID调节步骤：

1. 先调P直到出现轻微超调
2. 加入D抑制振荡
3. 最后加I消除静差
4. 用MATLAB的pidTuner工具验证参数

5. 典型问题排查指南

5.1 CAN通信异常

症状：随机出现错误帧或报文丢失

• 检查终端电阻（总线两端各120Ω）
• 用示波器查看CANH-CANL差分电压（正常2V左右）
• 降低波特率测试（从1Mbps降到500Kbps）

5.2 实时性不达标

表现：控制周期抖动大于100μs

• 检查CPU亲和性设置：taskset -pc 3 $(pidof control_node)
• 禁用图形界面：sudo systemctl set-default multi-user.target
• 使用cyclictest测试延迟：cyclictest -t1 -p 80 -n -i 100 -l 1000

5.3 电机抖动问题

诊断流程：

1. 先断开机械负载测试空载运行
2. 检查编码器接线（差分信号需用双绞线）
3. 用CAN分析仪捕获PDO数据，观察位置反馈是否异常
4. 适当增加速度环滤波器截止频率

6. 扩展应用场景

这套方案经适当调整后可适用于：

• 自动驾驶小车：增加GPS/IMU的CAN节点
• 机械臂控制：每个关节作为独立CAN节点
• 农业机器人：通过CAN总线连接土壤传感器

最近在做的果园巡检机器人项目中，我们通过CM5同时处理：

• 4路200万像素摄像头（AI识别病虫害）
• 6个关节的CAN总线伺服控制
• 4G远程监控数据传输
  整机成本控制在1.5万元以内，而同等性能的传统方案至少需要5万元以上。