1. 平衡小车与PID控制的本质关系两轮平衡小车本质上是一个倒立摆系统这种系统天生具有不稳定性。就像用手指顶着一根直立的木棍需要不断调整手指位置才能保持平衡。PID控制算法就是实现这种动态平衡的大脑它通过实时计算误差并输出修正量让小车能够像杂技演员一样稳定站立。我第一次调试平衡小车时发现单纯用比例控制P会让小车像喝醉酒一样左右摇摆。这是因为P控制只关注现在偏离了多少却忽略了偏离的速度有多快。后来加入微分控制D后小车终于能稳稳站住——D项就像给系统加了阻尼器能预测未来的运动趋势提前刹车。2. 串级PID的工程逻辑解析2.1 为什么需要串级控制普通PID控制就像单线程程序而串级PID则是多线程协作。在平衡小车中直立环内环和速度环外环就像两个配合默契的工人内环工人直立环反应敏捷专门负责快速调整车身角度外环工人速度环着眼全局通过调整目标角度来间接控制车速这种分工的妙处在于当你想让小车前进时不需要直接控制电机只需告诉速度环请加速它会自动计算出需要让车身前倾多少度剩下的交给直立环完成。2.2 三环协作的物理本质转向环的加入让系统更完善。想象小车是个刚学走路的孩子直立环确保他不摔倒平衡速度环控制他走快走慢速度转向环保证他走直线不跑偏方向这三个环的输出最终会叠加到电机PWM信号上。在代码中通常这样实现// 最终PWM输出 直立环输出 - 速度环输出 ± 转向环输出 Moto1 Balance_Pwm - Velocity_Pwm Turn_Pwm; Moto2 Balance_Pwm - Velocity_Pwm - Turn_Pwm;注意速度环输出是负号这是工程实践中总结出的重要经验——速度控制需要采用正反馈机制。3. 参数整定的实战步骤3.1 直立环PD调参从摇摆到稳定调参就像中医把脉需要观察症状来调整药方先将KI和KD归零KP设为0.5左右用手轻推小车观察反应若恢复太慢增大KP每次0.2若出现高频抖动减小KP当KP调到临界振荡点时如KP1.8加入KD从0.01开始逐步增大KD直到抖动消失通常KD0.03~0.1调试时建议用蓝牙模块实时传输角度数据我用匿名上位机看到的理想波形应该像阻尼振荡曲线2-3个周期内恢复平稳。3.2 速度环PI调参静态到动态直立环调好后速度环就容易多了锁定直立环参数将小车放在地面先调KP_speed从0.3开始过小小车响应迟钝推一下很久才复位过大小车会抽搐式前后移动加入KI_speed消除静差从0.005开始用砝码测试在小车上加10g重量观察能否保持位置若缓慢漂移适当增大KI特别注意速度环的积分项必须限幅我在项目中设置的是#define VELOCITY_INTEGRAL_MAX 1000 // 速度环积分限幅4. STM32代码实现关键细节4.1 传感器数据处理MPU6050的数据质量直接影响控制效果。建议采用卡尔曼滤波或Mahony滤波算法。这是我使用的四元数解算代码片段void MahonyAHRSupdate(float gx, float gy, float gz, float ax, float ay, float az) { float norm; float vx, vy, vz; float ex, ey, ez; // 误差项 // 加速度归一化 norm sqrt(ax*ax ay*ay az*az); ax / norm; ay / norm; az / norm; // 估算重力方向 vx 2*(q1*q3 - q0*q2); vy 2*(q0*q1 q2*q3); vz q0*q0 - q1*q1 - q2*q2 q3*q3; // 向量叉积得到误差 ex (ay*vz - az*vy); ey (az*vx - ax*vz); ez (ax*vy - ay*vx); // 积分误差 exInt Ki * ex; eyInt Ki * ey; ezInt Ki * ez; // 调整陀螺仪读数 gx Kp*ex exInt; gy Kp*ey eyInt; gz Kp*ez ezInt; // 四元数更新 q0 (-q1*gx - q2*gy - q3*gz)*halfT; q1 (q0*gx q2*gz - q3*gy)*halfT; q2 (q0*gy - q1*gz q3*gx)*halfT; q3 (q0*gz q1*gy - q2*gx)*halfT; }4.2 编码器速度计算编码器数据处理有三大坑方向判断必须使用有符号数读取CNT寄存器溢出处理STM32的16位编码器模式会从65535跳变到0滤波处理原始数据需经过低通滤波这是我优化后的编码器读取函数int16_t Read_Encoder(TIM_HandleTypeDef *htim) { int16_t cnt_val (int16_t)(htim-Instance-CNT); htim-Instance-CNT 0; // 注意必须先读取后清零 // 速度滤波一阶低通 static int16_t speed_filtered 0; speed_filtered 0.7*speed_filtered 0.3*cnt_val; return speed_filtered; }5. 调试中的经典问题排查5.1 小车完全不动按照以下顺序排查用万用表测量电机驱动芯片供电电压如L298N的VCC用示波器检查TIMx_CHx引脚是否有PWM波形检查HAL_TIM_PWM_Start()是否在main()中调用查看PID输出值是否被限幅特别是积分项5.2 小车剧烈振荡可能原因及解决方案KP过大表现为高频小幅抖动10HzKD过小表现为低频大幅摆动1-2Hz传感器噪声尝试降低MPU6050的DLPF带宽机械松动检查电机安装是否牢固5.3 速度控制反向这个经典问题困扰我整整两天解决方案检查编码器AB相接线是否反接确认速度环输出极性应该用减法而非加法测试电机转向是否一致可交换电机线测试记得第一次成功让小车稳定站立时那种成就感堪比登月。调试PID就像驯服一匹野马需要耐心观察它的脾气通过参数调整逐渐建立默契。当看到小车在指尖轻触下微微晃动却始终不倒时你会真正理解控制算法的魅力——用数学规律驾驭物理世界。