从零实现麦轮小车的FPGA+STM32双核协同控制

1. 麦轮小车的核心原理与双核架构优势

第一次接触麦克纳姆轮时，我被它的运动方式惊艳到了——普通轮子只能前后滚动，麦轮却能实现横向平移、斜向移动甚至原地旋转。这种神奇特性源于轮毂上45°斜向排列的滚轮组，当四个麦轮以特定组合方式旋转时，会产生合成矢量力。但要让这种理论转化为稳定可控的运动，就需要精准的电机控制。

传统方案用STM32单独控制时，我遇到过两个致命问题：一是处理高频编码器信号会导致主控中断过载，二是PID计算与运动解算抢占资源。后来尝试FPGA+STM32双核架构后，性能瓶颈迎刃而解。FPGA的并行特性天生适合处理多路编码器信号，实测可稳定捕获200kHz的脉冲；STM32则专注运动控制算法，双核通过SPI通信，带宽足够传输转速数据和控制指令。

这种架构的黄金分工在于：

• FPGA：负责4路霍尔编码器的脉冲计数、转速换算、PWM波形生成
• STM32：处理遥控指令、运动学解算、PID调速、异常检测
• 协同机制：FPGA每10ms通过SPI发送转速数据包，STM32返回PWM占空比参数

2. FPGA硬件逻辑设计实战

2.1 编码器信号处理电路

驱动器的霍尔输出信号往往带有毛刺，直接接入FPGA会导致误计数。我在输入端设计了三级滤波：

1. RC低通滤波（截止频率1kHz）
2. 施密特触发器整形（74HC14）
3. FPGA内部的数字滤波（连续3个时钟周期采样）

Verilog核心计数逻辑如下：

always @(posedge clk_50M or negedge rst_n) begin if(!rst_n) begin pulse_cnt <= 0; end else begin // 检测A相信号上升沿 if(encoder_a_dly[1] & !encoder_a_dly[0]) pulse_cnt <= pulse_cnt + 1; end end

2.2 转速换算模块设计

采用"定时窗口+脉冲计数"法，每5ms统计脉冲数。为降低量化误差，我增加了线性插值处理：

// 时钟分频产生5ms定时信号 always @(posedge clk_50M) begin if(timer_cnt == 249999) begin timer_cnt <= 0; pulse_snap <= pulse_cnt; pulse_cnt <= 0; end else begin timer_cnt <= timer_cnt + 1; end end // 转速计算（单位：RPM） assign rpm = (pulse_snap * 60 * 1000) / (5 * ENCODER_PPR);

实测发现，当转速低于100RPM时误差较大。后来增加了一个滑动平均滤波器，窗口大小为8，稳定性显著提升。

3. STM32控制算法实现

3.1 麦轮运动学解算

麦克纳姆轮的运动控制需要将全局坐标系下的速度向量（Vx, Vy, ω）转换为四个轮子的转速。推导过程如下：

// 轮子布局示意图 // LF(1) RF(2) // \ / // \ / // \__/ // / \ // / \ // LB(3) RB(4) void Mecanum_Calc(float vx, float vy, float omega, float* wheel_rpm) { const float L = 0.15f; // 轮距(m) const float R = 0.05f; // 轮半径(m) wheel_rpm[0] = ( vx - vy - omega*L ) / R; // LF wheel_rpm[1] = ( vx + vy + omega*L ) / R; // RF wheel_rpm[2] = ( vx + vy - omega*L ) / R; // LB wheel_rpm[3] = ( vx - vy + omega*L ) / R; // RB }

3.2 PID调速算法优化

传统位置式PID在电机控制中容易产生积分饱和，我改用了变积分分离PID：

typedef struct { float Kp, Ki, Kd; float integral; float last_error; float output; } PID_Controller; void PID_Update(PID_Controller* pid, float target, float feedback) { float error = target - feedback; // P项 pid->output = pid->Kp * error; // 积分分离：误差较大时停止积分 if(fabs(error) < 50.0f) { pid->integral += pid->Ki * error * 0.01f; // 10ms周期 pid->output += pid->integral; } // D项 pid->output += pid->Kd * (error - pid->last_error) / 0.01f; pid->last_error = error; }

调试时发现电机启停瞬间会有抖动，后来加入输出限幅和死区补偿后解决：

// 输出限幅 if(pid->output > 1000) pid->output = 1000; else if(pid->output < -1000) pid->output = -1000; // 死区补偿（针对PWM驱动器的死区特性） if(fabs(pid->output) < 50) { pid->output = (pid->output > 0) ? 50 : -50; }

4. 双核通信与同步策略

4.1 SPI通信协议设计

FPGA作为SPI从机，STM32每10ms主动发起通信。数据帧格式如下：

STM32的接收中断处理：

void HAL_SPI_RxCpltCallback(SPI_HandleTypeDef *hspi) { if(rx_buf[0] == 0xA5 && crc8_check(rx_buf, 10)) { for(int i=0; i<4; i++) { motor[i].real_rpm = (int16_t)((rx_buf[2*i+1]<<8)|rx_buf[2*i+2]); } } }

4.2 时间同步机制

双核时钟不同步会导致控制周期漂移，我的解决方案是：

1. FPGA内部用50MHz时钟分频产生1kHz时基
2. STM32通过IO口检测FPGA的同步脉冲（每10ms一个上升沿）
3. 在同步脉冲中断中启动控制计算

// STM32同步中断回调 void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin) { if(GPIO_Pin == SYNC_PIN) { Mecanum_Control_Update(); // 运动控制更新 } }

5. 系统调试与性能优化

5.1 实时性测试数据

使用逻辑分析仪抓取关键时序：

• 编码器脉冲到转速计算延迟：<50μs
• SPI通信周期：稳定10ms±10μs
• 运动控制计算时间：1.2ms（STM32@168MHz）

5.2 抗干扰设计要点

• 电源隔离：电机驱动电源与逻辑电源用DC-DC隔离模块
• 信号隔离：编码器信号通过高速光耦（6N137）接入FPGA
• PCB布局：
  • 电机驱动线路与信号线分层走线
  • 晶振周围做包地处理
  • SPI信号线等长走线（误差<50mil）

5.3 运动性能实测

在2m×2m测试场地进行轨迹跟踪测试：

• 直线运动误差：<2cm/m
• 90°转向偏差：<3°
• 横向平移精度：±5cm（受地面摩擦影响较大）

遇到最棘手的问题是低速时的"台阶效应"，最终通过以下措施改善：

1. PWM频率从1kHz提升到20kHz（超出人耳范围）
2. 在运动解算中增加速度前馈补偿
3. 电机齿轮箱涂抹阻尼脂减少回程间隙

6. 关键问题排查记录

问题现象：小车斜向运动时出现规律性抖动
排查过程：

1. 用示波器检查各电机PWM波形，发现3号电机占空比有周期性波动
2. 检查FPGA转速数据，3号电机反馈值存在异常毛刺
3. 更换编码器接线后问题依旧
4. 最终发现是电机电源线过长（超过30cm）导致压降

解决方案：

• 缩短电源走线长度至15cm内
• 在电机端口增加1000μF电解电容
• 在PID参数中适当降低微分增益

问题现象：SPI通信偶尔丢帧
排查过程：

1. 逻辑分析仪显示CS信号有时提前拉高
2. 检查STM32代码发现SPI DMA未等待传输完成
3. FPGA端检测到CS异常上升时未复位状态机

解决方案：

// STM32修改为阻塞式传输 HAL_SPI_TransmitReceive(&hspi1, tx_buf, rx_buf, 11, 100);

同时在Verilog代码中加入：

always @(posedge cs_n) begin state <= IDLE; end

7. 进阶开发方向

完成基础运动控制后，可以进一步扩展：

1. SLAM导航：加装激光雷达（如RPLIDAR A1），移植Cartographer算法
2. 机器视觉：使用OpenMV进行色块跟踪或AprilTag识别
3. 无线控制：通过ESP8266实现WiFi遥控，参考以下TCP通信代码：

// ESP8266 AT指令配置 void WiFi_Init() { Send_AT_Command("AT+CWMODE=1", 1000); Send_AT_Command("AT+CWJAP=\"SSID\",\"PASSWORD\"", 5000); Send_AT_Command("AT+CIPSTART=\"TCP\",\"192.168.4.1\",8080", 3000); }

在3D打印的底盘上加装云台和机械臂，就能升级为移动操作机器人——这正是我目前正在迭代的2.0版本。从电机控制到智能移动，这个小车平台能伴随开发者不断成长，这也是双核架构带来的扩展优势。