三轮全向底盘运动控制实战：从运动学解算到PID调参

第一次看到三轮全向底盘在场上灵活移动时，那种无视传统转向限制的自由度让人着迷。但真正动手实现时才发现，要让三个轮子完美协同工作，远不是简单发送PWM信号就能解决的。本文将带你深入三轮全向底盘的控制核心，从运动学原理到STM32代码实现，最后通过PID闭环让底盘运动达到工业级精度。

1. 三轮全向底盘运动学基础

1.1 机械结构与运动特性

三轮全向底盘的核心在于三个安装有全向轮的电机呈120°均匀分布。这种布局使得底盘可以在平面内实现任意方向的平移和旋转组合运动。与传统的差速底盘相比，全向底盘具有以下显著优势：

• 无转向延迟 ：不需要先转向再移动，可直接沿目标方向运动
• 零转弯半径 ：能够绕自身中心旋转
• 横向移动能力 ：可以像螃蟹一样侧向移动

典型的轮组配置如下表所示：

轮子编号	安装角度	正向旋转方向
轮A	0°	顺时针
轮B	120°	逆时针
轮C	240°	顺时针

1.2 运动学正逆解模型

运动学正解 解决的是"已知各轮转速，求底盘整体运动状态"的问题。对于三轮全向底盘，其正解方程为：

v_x = (-ω_B + ω_C)/2
v_y = (ω_B + ω_C - 2ω_A)/√3
ω_z = (ω_A + ω_B + ω_C)/3

其中v_x、v_y为底盘在x、y方向的速度，ω_z为自转角速度，ω_A、ω_B、ω_C为三个轮子的转速。

运动学逆解 则相反，是"给定底盘运动指令，计算各轮所需转速"。这是控制中更常用的形式：

ω_A = v_x - (v_y)/√3 + L·ω_z
ω_B = -v_x/2 + v_y/(2√3) + L·ω_z 
ω_C = -v_x/2 - v_y/(2√3) + L·ω_z

这里的L是轮子到底盘中心的距离。在实际编码时，我们通常会将√3等常数预先计算好，避免实时计算消耗CPU资源。

2. STM32 HAL库实现

2.1 硬件配置要点

使用STM32F103系列作为主控时，需要合理分配硬件资源：

1. 定时器配置 ：

   • 3个PWM通道用于电机控制（建议使用高级定时器TIM1/TIM8）
   • 1个定时器用于编码器接口（如TIM2/TIM3/TIM4）
   • 1个基本定时器用于控制周期（如TIM6/TIM7）

2. 串口配置 ：

   • 至少1个USART用于无线模块通信
   • 可选USART用于调试输出

3. ADC配置 ：

   • 如果使用模拟摇杆遥控，需要配置ADC采样

提示：在CubeMX中配置时，务必开启相应外设的中断，并为DMA传输分配足够缓冲区。

2.2 运动解算代码实现

基于HAL库的运动解算核心代码如下：

// 预先计算的常量
#define SQRT3 1.73205080757f
#define WHEEL_RADIUS 0.05f // 轮子半径(m)
#define ROBOT_RADIUS 0.15f // 底盘半径(m)

typedef struct {
    float vx;  // x方向速度(m/s)
    float vy;  // y方向速度(m/s)
    float wz;  // 自转角速度(rad/s)
} ChassisSpeed;

void Kinematics_Calculate(const ChassisSpeed* speed, float wheel_speeds[3]) {
    // 运动学逆解计算
    wheel_speeds[0] = speed->vx - speed->vy/SQRT3 + ROBOT_RADIUS*speed->wz;
    wheel_speeds[1] = -0.5f*speed->vx + 0.5f*speed->vy/SQRT3 + ROBOT_RADIUS*speed->wz;
    wheel_speeds[2] = -0.5f*speed->vx - 0.5f*speed->vy/SQRT3 + ROBOT_RADIUS*speed->wz;
    
    // 转换为电机转速(RPM)
    for(int i=0; i<3; i++) {
        wheel_speeds[i] = (wheel_speeds[i] * 60.0f) / (2.0f * M_PI * WHEEL_RADIUS);
    }
}

实际应用中，还需要考虑以下优化：

1. 死区处理 ：当摇杆输入值很小时，直接视为零避免电机抖动
2. 速度限幅 ：限制最大转速保护电机
3. 加速度限制 ：避免速度突变导致打滑

3. 从开环到闭环控制

3.1 开环控制的局限性

仅依靠运动学解算的开环控制存在明显缺陷：

• 电机负载变化时速度不一致
• 电池电压波动影响输出
• 机械误差导致运动偏离预期

通过示波器捕获的开环控制波形通常显示：

• 电机响应延迟明显（50-100ms）
• 速度波动范围超过±15%
• 停止时存在明显过冲

3.2 PID闭环实现

为每个电机增加编码器反馈，构建速度闭环。典型PID实现如下：

typedef struct {
    float Kp, Ki, Kd;
    float integral;
    float prev_error;
    float output_limit;
} PIDController;

float PID_Update(PIDController* pid, float setpoint, float measurement, float dt) {
    float error = setpoint - measurement;
    
    // 比例项
    float P = pid->Kp * error;
    
    // 积分项(带抗饱和)
    pid->integral += error * dt;
    if(pid->integral > pid->output_limit) pid->integral = pid->output_limit;
    else if(pid->integral < -pid->output_limit) pid->integral = -pid->output_limit;
    float I = pid->Ki * pid->integral;
    
    // 微分项
    float D = pid->Kd * (error - pid->prev_error) / dt;
    pid->prev_error = error;
    
    // 总和输出
    float output = P + I + D;
    if(output > pid->output_limit) output = pid->output_limit;
    else if(output < -pid->output_limit) output = -pid->output_limit;
    
    return output;
}

3.3 PID调参实战技巧

1. 先调P再调I最后调D ：这是经典调参顺序
2. 使用阶跃响应测试 ：给一个固定速度指令，观察响应曲线
3. 典型问题现象 ：
   • 振荡严重 ：P太大，需要降低
   • 稳态误差 ：需要增加I项
   • 超调明显 ：需要增加D项或减小P项

调试过程中，可以通过串口实时输出数据到上位机软件（如CoolTerm或SerialPlot）可视化曲线。一组经过验证的PID参数范围参考：

参数	取值范围	影响特性
Kp	0.5-2.0	响应速度
Ki	0.01-0.1	消除静差
Kd	0.001-0.01	抑制超调

4. 高级运动控制优化

4.1 运动平滑处理

直接响应遥控器原始输入会导致运动不连贯，需要添加过渡处理：

// 指数平滑滤波
void Smooth_Input(float* current, float target, float factor) {
    *current = *current * (1.0f - factor) + target * factor;
}

// 在控制循环中调用
Smooth_Input(&actual_vx, target_vx, 0.2f);
Smooth_Input(&actual_vy, target_vy, 0.2f); 
Smooth_Input(&actual_wz, target_wz, 0.3f);

4.2 陀螺仪融合

增加MPU6050等IMU传感器可以显著提升旋转控制精度。通过互补滤波融合陀螺仪和加速度计数据：

float Complementary_Filter(float accel_angle, float gyro_rate, float* angle, float dt, float alpha) {
    *angle = alpha * (*angle + gyro_rate * dt) + (1.0f - alpha) * accel_angle;
    return *angle;
}

4.3 运动性能测试

建立系统的测试方案对优化至关重要。推荐测试项目包括：

1. 直线运动测试 ：

   • 测量10次1米直线运动误差
   • 使用手机秒表计时，计算速度一致性

2. 旋转测试 ：

   • 定点旋转360°，记录角度偏差
   • 不同速度下的旋转稳定性

3. 复合运动测试 ：

   • 边移动边旋转的协调性
   • 急停后的姿态保持

经过完整PID调优的三轮全向底盘应能达到以下性能指标：

• 直线运动误差 < 2%
• 旋转定位精度 < 3°
• 速度响应时间 < 100ms
• 最大运动速度 > 1.5m/s