1. 串级PID基础概念与智能车应用场景当你第一次尝试让智能车提速时可能会遇到一个令人头疼的问题车子突然像喝醉酒一样开始甩尾。这时候单环PID控制器就显得力不从心了而串级PID正是解决这个问题的利器。我刚开始玩智能车时也踩过这个坑后来发现串级PID简直是三轮差速车的救星。串级PID的核心思想很简单——就像公司里的层级管理。外环角度环是部门经理负责制定大方向内环角速度环是一线主管负责具体执行。具体到代码实现外环每3ms运行一次内环每1ms运行一次这种3:1的运行比例在实际测试中表现非常稳定。下面这个代码片段展示了最基本的框架time; if(time3) { Out_dwdircontrol(TempAngle); //外环 time0; } Out_dndiranglecontrol(Out_dw); //内环在智能车竞赛中我们常用ICM20602这类陀螺仪获取角速度数据。这个传感器能测量XYZ三轴的角速度对于三轮车来说只需要选择变化最剧烈的那个轴的数据通常是Z轴。安装时一定要把陀螺仪固定在车身中心线上这样才能获得准确的测量数据。2. 陀螺仪数据采集与处理实战拿到陀螺仪后第一步就是验证数据准确性。我建议先把三个轴的原始数据都打印出来然后左右摇晃小车观察哪个轴的数据变化最明显。以逐飞的ICM20602为例初始化后可以通过以下代码读取Z轴角速度int16_t gyroz1 ICM20602_Gyro_GetData(Z_AXIS);数据处理时有个重要技巧不要直接使用原始数据。陀螺仪数据通常会有零偏静止时不为零我习惯在车子静止时采集100次数据求平均值作为零偏补偿值。实际使用时记得减去这个零偏float real_gyroz gyroz1 - gyro_offset;陀螺仪积分是处理赛道元素的秘密武器。和编码器积分原理类似速度积分得距离角速度积分得到角度。这个技巧在处理圆环元素时特别有用tly_jifen gyroz1; //陀螺仪积分但要注意积分漂移问题我的经验是配合编码器数据一起使用两种传感器数据互补能大幅提高稳定性。当处理完一个赛道元素后记得清零积分值避免误差累积。3. 串级PID参数整定方法论调参是门艺术我总结了一套由内而外分步击破的方法。先调内环再调外环这个顺序千万不能错内环调试步骤暂时屏蔽外环给内环一个固定输入值比如100去掉速度环直接把方向内环输出给电机观察小车是否以固定角速度旋转用手拍打小车施加干扰看它能否快速恢复稳定内环调好的标志是受到干扰后能迅速回归设定值且不产生持续振荡。如果出现振荡需要适当减小P值或增大D值。外环调试技巧调参方法和单环PID类似但响应会更柔和增大P值会增强转向力度但过大会导致抖动D值能抑制振荡但太大会让系统反应迟钝我的经验值是外环P约为内环P的1/3实际调试时可以准备一个参数表记录每次调整的效果参数组合直线稳定性弯道响应抗干扰性综合评价P30,D15★★★☆★★☆☆★★★☆中等P35,D20★★★★★★★☆★★★★优秀P40,D15★★☆☆★★★★★★☆☆不推荐4. 赛道元素处理与性能优化当基本参数调好后就要面对各种赛道元素的挑战了。圆环是公认的杀手级元素这里分享我的独家处理方案进入圆环前开始陀螺仪积分当积分值接近360度时准备退出配合编码器距离检测作为双重验证设置5%的误差容限防止过度修正// 圆环处理示例 if(ring_flag){ if(fabs(tly_jifen) 342){ // 342度360*0.95 ring_flag 0; tly_jifen 0; } }提速技巧直道段适当增大外环P值弯道段启用动态参数调整使用预判式控制根据赛道前瞻提前调整参数记得留出20%的控制余量应对突发情况我曾用这套方法将三轮车的速度从2m/s提升到3.5m/s而且稳定性反而更好。关键是要耐心测试每个参数的变化效果有时候微调0.5的P值就能带来质的飞跃。最后提醒新手容易忽略的几点电池电压会影响电机响应建议做电压补偿车体重心位置对控制效果影响巨大轮胎磨损程度也会改变控制特性。把这些细节都考虑到你的小车就能在赛道上既快又稳地飞驰了。