手把手教你用STM32和ROS实现阿克曼小车PID控制

1. 阿克曼小车与PID控制基础

阿克曼转向机构最早出现在马车时代，后来被汽车工业广泛采用。这种转向方式的特点是车辆转弯时，内侧轮比外侧轮转动更大的角度，使得所有轮胎的延长线都交于同一点，从而减少轮胎磨损。在机器人领域，阿克曼结构常用于需要高速稳定运行的轮式机器人。

PID控制是工业控制中最经典的算法之一，由比例（P）、积分（I）、微分（D）三个环节组成。P项负责快速响应误差，I项消除稳态误差，D项抑制系统震荡。在阿克曼小车中，我们需要同时控制两个关键部分：前轮转向舵机的角度（位置式PID）和后轮电机的差速（速度式PID）。

我去年帮学校机器人社团调试阿克曼赛车时，发现很多新手容易犯一个错误：把舵机控制和电机控制分开调试。实际上这两个系统是强耦合的，舵机角度会影响后轮差速需求，而后轮速度变化又会影响转向稳定性。建议大家在开始编程前，先用纸笔画出小车在不同转向角度时，左右轮的理论速度关系。

2. 硬件搭建与STM32底层开发

2.1 关键硬件选型建议

舵机选择上，我强烈推荐金属齿轮的数码舵机。虽然价格比模拟舵机贵30%左右，但在反复转向时定位更精准。实测某品牌MG996R在2kg·cm扭矩下，转向抖动比模拟舵机小60%。电机方面，带霍尔编码器的直流减速电机是性价比之选，编码器分辨率建议不低于13PPR（每转脉冲数）。

STM32型号选择有个小技巧：F1系列的TIM1/TIM8高级定时器可以同时输出多路互补PWM，非常适合同时控制电机和舵机。我用STM32F103C8T6最小系统板做过测试，完全能满足需求，成本不到20元。如果预算充足，可以考虑F4系列，其硬件FPU能加速PID运算。

2.2 PWM信号生成实战

舵机控制最关键的时基脉冲要求20ms周期（50Hz），高电平宽度0.5-2.5ms对应0-180度。在STM32中配置时，假设使用72MHz主频，预分频设置为24-1，自动重装载值设为60000-1，这样得到的PWM频率正好是50Hz：

// 舵机PWM初始化代码（TIM1通道1） void Servo_PWM_Init(void) { GPIO_InitTypeDef GPIO_InitStruct; TIM_TimeBaseInitTypeDef TIM_TimeBaseStruct; TIM_OCInitTypeDef TIM_OCInitStruct; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA|RCC_APB2Periph_TIM1, ENABLE); // PA8作为TIM1_CH1输出 GPIO_InitStruct.GPIO_Pin = GPIO_Pin_8; GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AF_PP; GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStruct); TIM_TimeBaseStruct.TIM_Period = 60000-1; TIM_TimeBaseStruct.TIM_Prescaler = 24-1; TIM_TimeBaseStruct.TIM_ClockDivision = TIM_CKD_DIV1; TIM_TimeBaseStruct.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStruct); TIM_OCInitStruct.TIM_OCMode = TIM_OCMode_PWM2; TIM_OCInitStruct.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStruct.TIM_Pulse = 4500; // 初始1.5ms(90度) TIM_OCInitStruct.TIM_OCPolarity = TIM_OCPolarity_Low; TIM_OC1Init(TIM1, &TIM_OCInitStruct); TIM_OC1PreloadConfig(TIM1, TIM_OCPreload_Enable); TIM_ARRPreloadConfig(TIM1, ENABLE); TIM_CtrlPWMOutputs(TIM1, ENABLE); TIM_Cmd(TIM1, ENABLE); }

调试时有个实用技巧：先用示波器检查PWM波形，确保周期和脉宽准确。我遇到过因为硬件滤波电容导致舵机响应迟钝的情况，解决方法是在舵机信号线串联一个200Ω电阻。

3. ROS系统集成与通信协议

3.1 ROS Kinetic/Melodic环境配置

建议使用Ubuntu 18.04+ROS Melodic的组合，对新手最友好。安装完成后需要额外安装serial包：

sudo apt-get install ros-melodic-serial

创建功能包时记得添加依赖项：rospy、roscpp、std_msgs、geometry_msgs。我在去年移植到ROS Noetic时发现，新版本需要额外修改CMakeLists.txt中的C++标准设置：

add_compile_options(-std=c++17)

3.2 自定义消息协议设计

STM32与ROS之间建议采用紧凑的二进制协议。下面是我优化过的帧结构：

[0xAA][0x55][长度][命令字][数据...][校验和]

校验和用简单的累加和即可。在ROS节点中，串口读取线程需要处理粘包问题。分享一个经过实战检验的解析函数：

void parseSerialData(uint8_t *buf, int len) { static uint8_t rxBuffer[128]; static int rxIndex = 0; for(int i=0; i<len; i++) { if(rxIndex == 0 && buf[i] != 0xAA) continue; if(rxIndex == 1 && buf[i] != 0x55) { rxIndex = 0; continue; } rxBuffer[rxIndex++] = buf[i]; if(rxIndex >= 3 && rxIndex == (rxBuffer[2]+3)) { uint8_t checksum = 0; for(int j=0; j<rxIndex-1; j++) checksum += rxBuffer[j]; if(checksum == rxBuffer[rxIndex-1]) { processPacket(rxBuffer); } rxIndex = 0; } } }

4. PID算法实现与调参技巧

4.1 位置式PID实现（转向控制）

舵机角度控制适合用位置式PID。这里分享一个带死区和积分限幅的改进版本：

typedef struct { float Kp, Ki, Kd; float max_out; // 输出限幅 float max_iout; // 积分限幅 float deadband; // 死区 float set, fdb; float err, last_err; float Pout, Iout, Dout; } PID_TypeDef; void PID_Calc(PID_TypeDef *pid) { pid->err = pid->set - pid->fdb; if(fabs(pid->err) > pid->deadband) { pid->Pout = pid->Kp * pid->err; pid->Iout += pid->Ki * pid->err; // 积分限幅 if(pid->Iout > pid->max_iout) pid->Iout = pid->max_iout; else if(pid->Iout < -pid->max_iout) pid->Iout = -pid->max_iout; pid->Dout = pid->Kd * (pid->err - pid->last_err); pid->last_err = pid->err; } else { pid->Iout = 0; // 进入死区清零积分 } float output = pid->Pout + pid->Iout + pid->Dout; // 输出限幅 if(output > pid->max_out) output = pid->max_out; else if(output < -pid->max_out) output = -pid->max_out; pid->output = output; }

调参时有个小窍门：先用纯P控制，从小到大调整Kp直到出现轻微震荡，然后取这个值的60%作为基础。Ki一般设为Kp的1/20，Kd设为Kp的3-5倍。

4.2 速度式PID实现（差速控制）

后轮电机需要速度环PID。由于STM32计算能力有限，建议使用简化版的增量式PID：

void Speed_PID_Update(PID_TypeDef *pid, float current_speed) { static float last_output = 0; float err = pid->set - current_speed; float delta = pid->Kp*(err - pid->last_err) + pid->Ki*err + pid->Kd*(err - 2*pid->last_err + pid->last_last_err); pid->last_last_err = pid->last_err; pid->last_err = err; float output = last_output + delta; // 输出限幅 if(output > pid->max_out) output = pid->max_out; else if(output < -pid->max_out) output = -pid->max_out; last_output = output; pid->output = output; }

调试差速控制时，建议先用示波器观察编码器波形，确保计数准确。常见问题包括：编码器线序接反、滤波电容过大导致脉冲丢失、电机启动时电流不足等。