基于STM32的两轮自平衡小车：串级PID与姿态融合实战

简介这份资料包面向嵌入式初学者与DIY爱好者围绕基于STM32微控制器的两轮自平衡小车展开提供从硬件设计到软件实现的完整制作参考。包内共1430个文件以C源码与头文件、Keil工程配置、编译中间产物及固件烧录文件为主另含原理图、PDF文档、使用说明与开发笔记压缩包约53.19MB目录按原理图、源码、使用说明、开发笔记等模块组织便于按需检索。资料重点讲解陀螺仪与加速度计的姿态采集、PID控制算法实现及电机驱动逻辑并记录作者开发中遇到的故障排查与性能优化思路读者可据此完成硬件搭建、固件烧录与调试运行。目前已有4138人学习下载适合希望深入理解STM32应用、传感器融合与实时控制策略的开发者参考实践。1. 从“站不住”到“稳得住”两轮自平衡小车的需求与选型判断做两轮自平衡小车最反直觉的一点是它难的不是让轮子转起来而是让车身在“快要倒”和“还没倒”之间反复找平衡。很多同学第一次上电车要么原地抽搐要么直接扑倒PID 参数怎么调都像玄学。这套基于 STM32 的两轮自平衡小车制作教程解决的正是从零搭出一台能直立、能走、能转向的小车这条完整链路适合正在做毕设、课设或者想拿一套可复现方案直接改的读者。它把硬件选型、姿态解算、串级控制、电机驱动和调试方法串成一条线而不是丢一堆代码让人自己猜。下面按“需求怎么立、系统怎么设计、模块怎么落地、坑怎么避、最后怎么验收”的顺序展开你可以照着这套结构交作业也可以把它当成自己方案的骨架。2. 需求拆解与技术选型为什么是 STM32 加串级 PID2.1 先把功能需求翻译成可测指标自平衡小车的需求如果只写“能平衡、能前进、能转向”验收时根本没法判断做没做完。我一般会把需求拆成可测的指标静止直立时车身倾角波动控制在正负 2 度以内受到轻推后能在 2 秒内回到平衡位置且不持续振荡直行 3 米内横向偏移不超过 20 厘米通过串口或蓝牙能下发前进、后退、转向指令并被执行。这些指标对应到系统里就是姿态采样频率、控制周期、电机响应速度和机械重心位置四个变量。需求立不住后面调参就是无底洞所以第 2 章先把这件事说清楚。从资源角度看这套教程覆盖的是“最小可用系统”主控、姿态传感器、电机与驱动、电源、调试接口五部分。它不追求视觉循迹、避障这些扩展功能而是把平衡这一件事做扎实。对毕设来说这个范围刚好够写出一套完整的设计与实现对课设来说工作量也不会失控。2.2 主控与传感器的选型逻辑主控选 STM32核心原因是它同时具备足够的定时器资源、硬件 I2C/SPI 和中断响应能力。平衡车控制周期通常在 5 到 10 毫秒主循环里要完成姿态读取、滤波、串级 PID 计算和 PWM 输出8 位单片机跑起来会明显吃力而 STM32 的 Cortex-M3/M4 内核留有余量。教程里用的是常见的 STM32F103 系列外设够用、资料多、成本低属于“不容易翻车”的选择。姿态传感器一般用 MPU6050 这类六轴模块输出三轴加速度和三轴角速度。加速度计静态准但动态噪声大陀螺仪动态响应好但会积分漂移两者必须融合。选型时要注意模块的安装方向和小车坐标系对齐否则后面调参时正负号能把人逼疯。电机侧通常选带编码器的直流减速电机编码器用来测速形成速度环没有编码器就只能做单环平衡走起来会飘。电源部分建议电池、电机驱动、主控分开供电或至少加足滤波电机启动瞬间的电流跌落是很多“莫名其妙复位”的根源。2.3 控制结构串级 PID 的分工这套方案的控制核心是串级 PID外环是角度环输入是融合后的车身倾角输出作为内环速度环的目标值内环是速度环输入是编码器测得的轮速输出叠加到电机 PWM 上。角度环负责“别倒”速度环负责“别跑飞”。如果只做角度环车能站住但会缓慢漂移只做速度环车根本站不起来。两环的周期也不同角度环通常 5 毫秒一次速度环可以放到 10 到 20 毫秒避免内环被噪声带偏。转向则单独一路遥控或串口给出的转向量直接差速叠加到左右轮 PWM 上不参与平衡环。这样转向和平衡解耦调参时互不干扰。下面这张表是这套方案里几个关键参数的典型取值范围实际值要按车重和电机特性微调。参数典型范围作用调大后的现象角度环 Kp8 到 25回正力度车身抖动、高频振荡角度环 Kd0.5 到 3抑制过冲反应迟钝、回正慢速度环 Kp0.5 到 3跟随目标速度前后窜动速度环 Ki0.05 到 0.5消除稳态误差低频摆动控制周期5 到 10 ms采样与输出节奏周期不稳会引入抖动提示参数表只是起点不是标准答案。同一套代码换一块电池、换一组轮子参数就得重调别指望抄一组数就一劳永逸。3. 总体架构与模块划分五个模块如何各司其职3.1 系统分层感知、决策、执行、交互把整台车拆开看它是四层结构。感知层负责 MPU6050 读数和编码器计数决策层跑姿态融合和串级 PID执行层把 PID 输出转成 TIM 的 PWM 占空比驱动电机交互层负责串口指令、蓝牙遥控和调试信息回传。四层之间用全局状态结构体传递数据主循环按固定节拍调度中断只做最轻的计数和标志位设置。这种分法的好处是调姿态时不用碰电机代码换遥控方式时不用动控制环出问题时能快速定位是哪一层。教程里的工程一般按这个思路组织文件主函数和调度放主文件姿态解算单独一个模块PID 单独一个模块电机和编码器各自成对串口交互再单独一块。初学者常把所有代码塞进 main.c结果改一处牵动全身这是血泪经验里最常见的一条。3.2 主循环调度与中断分工主循环不写死延时而是用定时器中断置标志位主循环轮询标志位执行对应任务。下面是一段调度骨架展示控制节拍怎么组织/* 5ms 控制节拍姿态读取 - 融合 - 串级PID - PWM输出 */ void Control_Task(void) { if (flag_5ms) { flag_5ms 0; MPU6050_Read(raw); // 读原始加速度与角速度 Angle_Update(raw, attitude); // 互补滤波或卡尔曼融合 speed_target Angle_PID(attitude);// 角度环输出作为速度环目标 pwm_out Speed_PID(speed_target, encoder_speed); // 速度环输出 Motor_SetPWM(pwm_out turn_offset, pwm_out - turn_offset); } }这段代码的关键不在语法而在节拍。flag_5ms由定时器中断置位保证控制周期稳定turn_offset是转向差速单独叠加不进入平衡环。如果把姿态读取放在主循环里用delay控制节奏周期会随代码执行时间漂移PID 输出就会抖。中断里只做计数和置标志重活全部放主循环这是保证实时性的基本纪律。3.3 数据流与状态管理整台车运行时需要维护的状态不多当前倾角、角速度、左右轮速、目标速度、转向量、电池电压。建议用一个结构体统一管理模块之间只读写这个结构体避免到处传参。状态更新要有明确的“生产者—消费者”关系姿态模块是倾角和角速度的生产者控制模块是消费者编码器是轮速的生产者速度环是消费者。理清这条数据流调试时就能判断“是传感器没给对还是控制没算对”。4. 关键模块实现姿态融合、串级 PID 与电机驱动4.1 姿态解算互补滤波为什么够用MPU6050 的加速度计能算出倾角但电机振动会让它跳陀螺仪积分平滑但会漂。互补滤波的做法是高频信陀螺仪低频信加速度计用一个系数把两者加权。公式很朴素angle 0.98 * (angle gyro * dt) 0.02 * acc_angle。系数 0.98 表示更信任陀螺仪的短期变化0.02 用来慢慢修正漂移。对平衡车这种控制周期短、动态不极端的场景互补滤波完全够用卡尔曼滤波属于“可以上但没必要”调参复杂度反而更高。/* 互补滤波dt 为控制周期(秒)gyro 为角速度acc_angle 为加速度算出的倾角 */ float Complementary_Filter(float gyro, float acc_angle, float dt) { static float angle 0.0f; angle 0.98f * (angle gyro * dt) 0.02f * acc_angle; return angle; }这里有两个容易忽略的点dt必须用实际控制周期不能用名义值陀螺仪读数要先减去零偏否则积分项会一路漂。零偏在上电静止时采样几百次取平均这一步省不得。4.2 串级 PID 的代码落地PID 实现本身不复杂难的是抗积分饱和和输出限幅。角度环输出要限幅因为它作为速度环的目标速度环输出也要限幅因为它直接决定 PWM。积分项在输出饱和时要停止累加否则车一旦被挡住积分会越积越大松手瞬间猛冲这就是典型的“积分 windup”。/* 位置式 PID带积分限幅与输出限幅 */ float PID_Calc(PID_t *pid, float target, float actual) { float err target - actual; pid-integral err; if (pid-integral pid-integral_max) pid-integral pid-integral_max; if (pid-integral -pid-integral_max) pid-integral -pid-integral_max; float out pid-kp * err pid-ki * pid-integral pid-kd * (err - pid-last_err); pid-last_err err; if (out pid-out_max) out pid-out_max; if (out -pid-out_max) out -pid-out_max; return out; }kp决定回正力度ki消除稳态误差kd抑制过冲。调参顺序建议先只开角度环的kp和kd让车能站住但允许缓慢漂移再加速度环的kp和ki把漂移收住。一上来三个参数一起调基本等于蒙。4.3 电机驱动与编码器测速电机驱动常用 TB6612 或 L298N 这类双路驱动模块前者效率高、发热小后者皮实但压降大。STM32 侧用两个定时器通道输出 PWM另两个 GPIO 控制方向。编码器接定时器的编码器模式直接读计数寄存器固定周期清零并换算成轮速。测速周期建议和速度环周期一致太短噪声大太长响应慢。/* 每 20ms 调用一次读取编码器计数并换算为轮速 */ void Encoder_Update(void) { int16_t left_cnt TIM_GetCounter(TIM3); // 左轮编码器 int16_t right_cnt TIM_GetCounter(TIM4); // 右轮编码器 TIM_SetCounter(TIM3, 0); TIM_SetCounter(TIM4, 0); speed_left left_cnt * ENCODER_SCALE; // 计数换算为速度 speed_right right_cnt * ENCODER_SCALE; }ENCODER_SCALE由编码器线数、减速比和轮径共同决定算错这个系数速度环的目标值就全错表现为“车能站但一走就冲”。这个系数建议实测手动转轮一圈看计数增量再换算。5. 避坑与排查调参调不动时先看这五条5.1 现象上电车就抖越调 Kp 抖得越厉害原因通常是姿态数据本身在跳或者控制周期不稳。先看串口回传的倾角曲线如果静止时曲线毛刺很大问题在传感器或滤波不在 PID。解决方法是检查 MPU6050 安装是否紧固、电源是否干净再确认dt用的是实测周期。Kp 调大只是把已有的噪声放大治标不治本。5.2 现象车能站住但一直往一个方向漂这是速度环没起作用或编码器方向接反的典型表现。先确认编码器计数在轮子正转时是正还是负方向反了速度环会变成正反馈车越漂越快。再检查速度环的ki是否太小稳态误差收不住。还有一种可能是机械重心偏了软件补偿只能缓解装车时尽量让电池和主控居中。5.3 现象电机一转主控就复位电源问题几乎每次都是。电机启动瞬间电流大电池内阻或走线压降把主控电压拉低触发欠压复位。解决方法是电机电源和主控电源分开走线主控侧加足够容量的电容电池选放电能力够的。这个坑很隐蔽因为复位是偶发的容易误判成代码 bug。5.4 现象串口指令发了但车不动先确认指令解析有没有进到控制分支再看目标速度有没有被限幅吃掉。常见原因是串口中断里做了太多事或者指令格式对不上比如少了结束符。调试时把解析后的目标值打印出来一眼就能看出是没收到还是没执行。5.5 现象原地能平衡一走就倒速度环和角度环的耦合没调好。走起来时速度环输出会改变车身姿态角度环必须跟得上。解决方法是降低速度环的响应速度减小kp让角度环有 time 反应同时确认速度环输出限幅不要太大。这个现象在只调过静态平衡的人身上特别常见。6. 验收与答辩用一张测试表把方案讲清楚验收这件事我一般建议在答辩前自己先跑一遍完整测试把数据记下来而不是到现场凭感觉说“能平衡”。具体做法是设计一张测试表覆盖静态、动态、指令响应和异常恢复四类场景每类给出通过标准。静态测试上电后静置 30 秒记录倾角最大波动和是否倒车动态测试轻推后回稳时间、直行 3 米横向偏移指令测试前进、后退、左转、右转各执行三次记录成功率异常测试电量偏低时是否还能稳定、被挡住后松手是否猛冲。把这些数据填进表里答辩时直接展示比口头描述有说服力得多。测试项方法通过标准记录项静态直立上电静置 30 秒倾角波动小于正负 2 度不倒最大波动值抗扰回稳轻推后松手2 秒内回稳不持续振荡回稳时间直行偏移直行 3 米横向偏移小于 20 厘米实测偏移指令响应四方向各三次成功率不低于 90%成功次数堵转恢复挡住 2 秒后松手不猛冲能重新平衡是否异常答辩时还有一个技巧主动讲清楚你调参的顺序和遇到的翻车点。评委更愿意听“我先只开角度环让它站住再加速度环收漂移中间因为编码器方向接反导致越漂越快后来用串口曲线定位到问题”而不是背一遍 PID 公式。这套方案的价值不在于代码多复杂而在于每个模块都有明确的职责和可验证的结果你能把这条链路讲顺方案就立住了。从那以后我每次带人做这类项目都要求先填完这张测试表再谈优化因为调参调到最后拼的不是参数多精妙而是你有没有一套能复现的验收习惯。希望帮到你。本文还有配套的精品资源点击获取