STM32两轮自平衡小车：从姿态解算到三环PID的完整实战指南

简介这份资料包面向嵌入式初学者与DIY爱好者围绕基于STM32微控制器的两轮自平衡小车展开解决从硬件搭建到软件调试缺乏系统参考的问题。包内包含原理图、源码、使用说明与开发笔记四大模块原理图讲解STM32选型、陀螺仪与加速度计连接及电机驱动电路源码涵盖数据采集、PID算法实现与电机控制逻辑使用说明指导装配、固件烧录与运行调试开发笔记记录故障排查与性能优化经验。资源共1430个文件以c与h源码、d与o编译中间文件、crf与uvproj工程配置、pdf文档及hex固件为主压缩包约53.19MB工程结构完整。已有4138人学习下载适合希望深入理解STM32应用、PID闭环控制与自平衡系统实现的中级开发者参考实践。1. 从一块总往一边倒的车模说起这套 STM32 自平衡小车资料到底能干什么很多人第一次碰两轮自平衡小车都是被同一个画面劝退的上电、松手、车体往一边栽轮子疯转PID 参数怎么调都像玄学。这套基于 STM32 的两轮自平衡小车制作教程资料解决的正是这个从零到能站住的过程。它不是一份只讲原理的 PPT而是把硬件选型、姿态解算、串级 PID、电机驱动、蓝牙调参这些环节串成一条能落地的链路适合三类人刚学完 STM32 外设想找个综合项目练手的学生、要做课程设计或毕业设计的开发者、以及想把平衡车当移动底盘做二次开发的人。资料围绕 STM32 主控展开核心是 MPU6050 姿态采集加互补滤波或卡尔曼滤波做角度融合再用直立环、速度环、转向环三环串级控制输出 PWM 给电机。你拿到手最该先看的不是代码而是它把「车为什么倒、怎么让它不倒」这件事拆成了哪几个可测量的量。2. 系统架构拆解从 MPU6050 到电机 PWM 的一条完整控制链这套资料的技术骨架其实很清晰主控是 STM32 系列常见是 F103 这类资源够用、资料多的型号姿态传感器用 MPU6050电机是带编码器的直流减速电机驱动常见是 TB6612 或 L298N 这类双路 H 桥电源用锂电池加降压模块。整条链路是MPU6050 通过 I2C 读出加速度和角速度主控做姿态融合得到车体倾角倾角误差进直立环 PID 算出期望速度速度环再根据编码器反馈修正最后叠加转向环输出两路 PWM。理解这条链比死记某个参数重要得多。2.1 硬件拓扑与主控资源分配先把硬件关系理清楚后面看代码才不会迷路。典型接法是这样模块接口占用资源作用MPU6050I2C1PB6/PB7输出三轴加速度、三轴角速度编码器左TIM 编码器模式TIM3 CH1/CH2左轮转速与方向反馈编码器右TIM 编码器模式TIM4 CH1/CH2右轮转速与方向反馈电机驱动GPIO TIM PWMTIM2 CH1~CH4输出占空比控制转速蓝牙模块USARTUSART1上位机调参、看波形按键/OLEDGPIO / I2C若干本地显示与模式切换这里有个容易被忽略的点编码器一定要用定时器的编码器模式去读而不是普通外部中断计数。编码器模式下硬件自动做四倍频和方向判断CPU 几乎不占资源中断计数在高速时容易丢脉冲车会莫名其妙地抖。我一般会把两个编码器定时器都配成编码器模式然后在固定周期里读计数器差值这个差值就是这一周期的脉冲数除以线数和减速比就得到轮速。2.2 姿态解算互补滤波为什么比纯加速度靠谱MPU6050 直接读出来的加速度能算倾角但电机一转、车体一抖加速度里全是振动噪声陀螺仪积分出来的角度短期准、长期漂。所以必须融合。资料里常见两种做法互补滤波和卡尔曼滤波新手建议先吃透互补滤波因为它参数少、现象直观。// 互补滤波陀螺仪积分给短期加速度给长期修正 // dt 为采样周期(秒)alpha 为陀螺仪信任权重常见 0.96~0.98 float ComplementaryFilter(float accAngle, float gyroRate, float dt) { static float angle 0.0f; // 陀螺仪积分预测当前角度 float gyroAngle angle gyroRate * dt; // 用加速度角度做低频修正alpha 越大越信任陀螺仪 angle alpha * gyroAngle (1.0f - alpha) * accAngle; return angle; }这段代码的逻辑是先用陀螺仪角速度乘采样周期做积分得到这一拍的角度预测再用加速度算出的绝对角度按权重去拉一把防止积分漂移。alpha是关键参数取 0.98 时车体响应快但容易受陀螺零漂影响取 0.96 更稳但跟随稍慢。dt必须和实际采样周期一致如果你在 5ms 定时中断里调用dt就写 0.005写错了滤波效果直接崩。加速度算角度用atan2(ax, az)转成角度制即可注意安装方向传感器装反了角度符号会整体反掉这是新手最常见的翻车点之一。2.3 三环串级 PID直立、速度、转向各管什么平衡车的控制不是单个 PID 能搞定的资料里普遍采用串级结构。直立环是内环输入是目标角度通常就是机械中值比如 0 度附近微调和当前融合角度之差输出是 PWM 基础量速度环是外环输入是目标速度通常为 0即原地平衡和编码器测得的实际速度之差输出叠加到直立环的目标角度上转向环则根据遥控或蓝牙给的转向量直接给左右轮一个差速。// 直立环角度误差 - PWM 基础输出 float balance_pwm Balance_PID(0.0f, current_angle); // 速度环速度误差 - 角度补偿量注意限幅 float speed_angle Speed_PID(0.0f, current_speed); // 把速度环输出叠加到直立环目标角度上 balance_pwm Balance_PID(speed_angle, current_angle); // 转向环差速 float turn_pwm Turn_PID(target_turn, gyro_z); // 左右轮最终输出 motor_left balance_pwm turn_pwm; motor_right balance_pwm - turn_pwm;逻辑上要抓住一点速度环的输出不是直接给电机而是去「骗」直立环的目标角度。车往前溜了速度环就让目标角度往前倾一点直立环为了追这个角度自然往前加速形成负反馈。所以速度环的输出必须限幅常见限制在正负 10 度以内不限幅的话速度环一饱和车会直接冲出去。转向环用陀螺仪 Z 轴角速度做反馈比用编码器差速更跟手这是资料里比较实用的一个细节。三个环的采样周期也不同直立环最快5ms 左右速度环可以慢一些20~50ms转向环居中别全塞一个中断里。3. 把车跑起来工程目录、编译烧录与首次上电调试架构看懂了接下来是真正让它动。这套资料的工程一般是标准 Keil MDK 工程或者 CubeMX 生成的 HAL 工程目录结构大同小异。先认清每个文件夹管什么改代码时才不会在几百个文件里迷路。3.1 工程目录与关键文件定位典型目录长这样BalanceCar/ ├── Core/ │ ├── Inc/ // 头文件pid.h、mpu6050.h、motor.h、encoder.h │ └── Src/ │ ├── main.c // 初始化与外层循环 │ ├── pid.c // 三环 PID 实现 │ ├── mpu6050.c // I2C 读写与数据换算 │ ├── motor.c // PWM 输出与方向控制 │ └── encoder.c // 编码器读数与速度换算 ├── Drivers/ // HAL 库或标准外设库 ├── MDK-ARM/ // Keil 工程文件 .uvprojx └── Hardware/ // 原理图、接线说明资料里通常附带拿到工程先别急着编译先打开main.c看初始化顺序时钟、GPIO、I2C、定时器 PWM、编码器定时器、串口顺序错了外设可能不工作。然后看定时中断里调了哪些函数那才是控制核心。pid.c里通常有三个结构体分别存直立、速度、转向的 Kp、Ki、Kd 和积分限幅改参数就改这里或者通过蓝牙在线改。3.2 编译烧录与上电前的机械检查编译用 Keil 打开MDK-ARM下的工程选对芯片型号确认下载器配置ST-Link 或 J-Link编译无报错后烧录。但烧录前有几件事必须做否则上电就是一场灾难。第一车体机械中值要调好也就是车在没有任何动力时能大致竖直悬停的那个角度这个值要写进代码作为直立环目标角度的基准常见做法是上电后让车静止几秒读当前角度存下来当中值。第二电机线序和编码器线序要对应左轮正转时编码器计数应该增加反了的话速度环会变成正反馈车瞬间失控。第三PWM 限幅一定要设常见限制在 60%~80%满占空比起步太猛容易烧驱动。// 上电自检静止采样若干次求平均作为机械中值 float GetMechanicalZero(void) { float sum 0.0f; for (int i 0; i 200; i) { MPU6050_Read(); sum current_angle; HAL_Delay(5); } return sum / 200.0f; // 返回平均角度作为中值基准 }这段自检逻辑很实用200 次采样、5ms 间隔大约 1 秒取平均能滤掉手放车时的轻微晃动。返回值直接赋给直立环的目标角度基准后面所有角度误差都相对它计算。注意采样期间车必须真的静止且竖直手扶着别动否则中值就偏了表现为车总是往一个方向慢慢走。3.3 首次上电的调试顺序先站住再走稳第一次上电千万别直接放手。正确顺序是先只开直立环速度和转向环参数置零用手扶着车感受它是否有对抗倾倒的趋势如果越扶越倒说明极性反了把直立环 Kp 取负或者电机方向取反能对抗之后逐步加 Kp 直到车有明显抖动再回退一点然后加 Kd 抑制抖动D 太大会引入高频噪声表现为电机啸叫直立环稳了再加速度环先给很小的 Kp观察车是否能抑制缓慢漂移最后加转向环。整个过程建议接蓝牙用上位机实时看角度和 PWM 波形比盲调快十倍。资料里如果带了调参上位机一定要用起来这是省时间的后悔药。4. 避坑与排查那些让车原地打转或直接冲出去的真实原因调试平衡车踩的坑八成集中在几个固定位置。下面这几条是我和身边人反复遇到的按「现象 → 原因 → 解决」记下来能省不少时间。现象一上电后车往一个方向持续加速直到撞墙。原因通常是直立环极性反了角度误差为正时输出却让车往同方向倒形成正反馈。解决把直立环输出取反或者把电机方向宏定义翻转二者只改一个改两个等于没改。现象二车能站但一直低频左右晃像喝醉。多半是 Kp 偏小或 Kd 偏大也可能是姿态融合的alpha太大导致角度滞后。解决先微调 Kp 增大到临界抖动再回退 10%然后适当减小 Kd同时把alpha从 0.98 降到 0.96 试试。现象三静止时电机嗡嗡响、车轻微高频抖。这是 D 项放大了传感器噪声或者 PWM 频率太低。解决给陀螺仪数据加一阶低通滤波PWM 频率提到 10kHz 以上人耳听不到啸叫电机也更顺。现象四车能平衡但一给速度指令就冲出去收不回。速度环输出没限幅或者速度环积分饱和。解决给速度环输出加正负 10 度限幅积分项加抗饱和处理误差大时停止积分累加。现象五蓝牙调参时车突然失控。串口中断优先级高于控制中断或者调参时改了参数没做范围保护。解决控制定时中断优先级设为最高串口解析里对 Kp、Ki、Kd 做上下限钳位超范围直接丢弃。提示每次只改一个参数改完记录现象。平衡车调参最怕一次动三个数出了问题根本不知道是谁的锅。5. 二次开发改造从能站住到能干活我一般这么下手车能稳稳站住之后这套资料真正的价值才显现出来——它是一个现成的移动底盘。二次开发我一般分三步走先加感知再改控制最后做任务层。第一步加感知。最常见的是加编码器里程计和陀螺仪航向做成简易的位姿估计。编码器已经有现成读数把左右轮脉冲分别累加按轮距做差速运动学解算就能得到粗略的 x、y 和航向。代码上新增一个odometry.c在速度环同周期里更新// 差速运动学由左右轮位移推算位姿增量 // dL、dR 为本周期左右轮位移(米)L 为轮距(米) void UpdateOdometry(float dL, float dR, float L, float *x, float *y, float *theta) { float d (dL dR) / 2.0f; // 中心位移 float dtheta (dR - dL) / L; // 航向增量 *theta dtheta; *x d * cosf(*theta); *y d * sinf(*theta); }这段的关键是L要量准轮距差几毫米转几圈后航向误差就明显了。dL、dR由编码器脉冲数除以「线数 × 减速比 × 每米脉冲」得到单位统一成米别混用脉冲和米。第二步改控制。如果要做定点或循迹就在速度环外面再套一层位置环把目标位置误差转成目标速度喂给原来的速度环。这里要注意采样率位置环 50ms 一次足够太快反而震荡。转向环可以从「角速度反馈」改成「航向角反馈」用陀螺仪积分或里程计航向做外环车就能走直线而不是画龙。第三步做任务层。把蓝牙协议扩展成简单指令集比如MOVE x y、STOP、SET kp ki kd主循环里解析执行。我习惯把控制参数和任务指令分开两个缓冲区控制中断只读参数快照避免解析到一半参数被改。验证方法很直接先架空车轮看里程计输出是否随手动转动合理变化再落地低速跑方形轨迹看闭合误差误差大就回头查轮距和编码器线数。有个血泪教训改控制环的时候千万别把原来的直立环参数一起动了。我见过有人为了加位置环把直立环 Kp 调小结果车连站都站不住还以为是位置环写错了。从那以后我每次做二次开发都强制先把原始平衡功能跑一遍确认基线没坏再动新代码。希望这套资料的拆解能帮你少走几圈弯路把车从「能站」推到「能干活」。本文还有配套的精品资源点击获取