STM32纯平衡小车PID闭环控制与串级调参实践-平芜编程栈

简介：这是一套基于STM32微控制器的纯平衡小车嵌入式程序包，面向正在学习嵌入式控制、传感器融合与PID调参的初学者及进阶开发者，可用于搭建自平衡小车的核心控制框架，理解姿态采集、误差计算与电机闭环输出的完整链路。压缩包共234个文件，约8.57MB，以41个C源文件、47个头文件及若干编译中间文件为主，辅以工程配置、链接脚本和烧录文件，内容涉及MPU6050数据读取、DMP驱动、定时器与ADC配置、PID运算和电机控制等模块。已有2215人学习，说明其在STM32平衡小车入门实践中具有一定参考价值。工程可在Keil环境下编译调试，读者能据此梳理传感器数据解析、姿态解算、PID参数整定及外设初始化思路，也可对照源码理解闭环控制的实现细节，适合作为课程设计、毕业设计或嵌入式综合练习的参考工程。

1. 纯平衡小车的价值：为什么只做平衡反而更考验控制链路

STM32 嵌入式 PID 平衡小车程序（纯平衡）这类资源，最容易被误当成“改三个参数就能站”的模板。真正拆开看，纯平衡去掉了循迹、避障、蓝牙遥控这些外围业务，反而把问题集中到一条很窄的链路：MPU6050 的姿态角是否可信、控制周期是否稳定、串级 PID 的符号是否一致、电机输出有没有死区和饱和。任何一个环节翻车，表现都是“站不住”，但原因可能完全不同。这份程序适合已经能让电机正反转、但小车一放就倒的人；也适合想把 PID 从公式落到定时器中断里的人。它给的是可跑的闭环骨架，不是万能参数，机械重心、电池电压、轮胎摩擦不同，参数必须重调。

2. 工程结构与控制节拍：从 MPU6050 采样到 PWM 输出的闭环怎么搭

2.1 资源里能直接复用的三层结构

解压后先别急着编译。纯平衡程序的可复用部分通常不是某个 PID 函数，而是三层职责划分。感知层负责 MPU6050 原始数据、编码器计数、电池电压；控制层在固定节拍里做姿态解算和串级 PID；执行层把 PID 输出翻译成方向 IO 和 PWM 占空比。三层混在一起，调参时根本不知道是角度错了还是电机反了，最后只能靠“玄学”试参数。常见做法是先把执行层单独跑通，再回头校感知层，最后才开闭环。

层级	主要职责	常见实现	调试入口
感知层	读取加速度、角速度、编码器、电压	I2C 轮询、定时器编码器模式、ADC	串口打印原始值和角度
控制层	互补滤波、角度环、速度环、转向环	5 ms 定时器中断置标志	打印角度、目标、左右 PWM
执行层	方向控制、PWM 限幅、死区补偿	GPIO + 定时器 PWM	单电机正反转测试

我一般会先把执行层单独测：给固定 PWM 正转 200 ms、反转 200 ms，确认左右轮方向；再把感知层单独测：手推车体看角度符号和变化趋势；最后才开闭环。这个顺序能省很多“一上电就倒”的无效调参。纯平衡资源里最常见的两个误区，是一上来就改 PID，以及把串口打印、浮点运算全塞进定时器中断。前者跳过了符号检查，后者会让控制周期抖动，表现都是“参数怎么调都不对”。

2.2 定时器节拍与任务划分：5 ms 控制周期怎么定

控制周期决定了角度环和速度环的上限。常见做法是用 5 ms，也就是 200 Hz，对普通 MPU6050 和编码器已经够用；周期再长，角度环的 D 项容易抖，周期太短，编码器量化噪声会被放大。STM32 上用定时器产生固定节拍，中断里只置标志，主循环检测标志后执行控制。这样串口发送、浮点运算不会拉长中断，控制节拍更稳。

// 以 72 MHz 主频为例，定时器预分频 71，计数 4999，得到 5 ms 中断 void ControlTimer_Init(void) { TIM_TimeBaseInitTypeDef tim; NVIC_InitTypeDef nvic; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); tim.TIM_Prescaler = 71; // 1 MHz 计数时钟 tim.TIM_Period = 4999; // 5000 个计数 = 5 ms tim.TIM_CounterMode = TIM_CounterMode_Up; tim.TIM_ClockDivision = TIM_CKD_DIV1; TIM_TimeBaseInit(TIM3, &tim); TIM_ClearFlag(TIM3, TIM_FLAG_Update); TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE); nvic.NVIC_IRQChannel = TIM3_IRQn; nvic.NVIC_IRQChannelPreemptionPriority = 1; nvic.NVIC_IRQChannelSubPriority = 0; nvic.NVIC_IRQChannelCmd = ENABLE; NVIC_Init(&nvic); TIM_Cmd(TIM3, ENABLE); } volatile uint8_t g_control_flag = 0; void TIM3_IRQHandler(void) { if (TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET) { TIM_ClearITPendingBit(TIM3, TIM_IT_Update); g_control_flag = 1; // 只置标志，控制放到主循环 } }

逻辑说明：中断服务函数只做一件事，把g_control_flag置 1；主循环看到标志后调用Balance_Control()，执行姿态解算和串级 PID。这样即使某次串口发送慢了几毫秒，也不会把控制中断拖长。参数说明：PSC=71得到 1 MHz 计数时钟，ARR=4999得到 5 ms 更新周期；如果主控主频不同，按“定时器时钟 / (PSC+1) / (ARR+1)”重算。控制周期dt必须和这个值一致，PID 里的微分项和积分项都依赖它。

中断优先级不要高于编码器捕获，否则高速时可能丢计数。纯平衡任务少，裸机定时器比 RTOS 更确定；RTOS 的任务切换会引入抖动，除非已经有调度经验，否则不建议在调参阶段引入。主循环里可以按“控制标志—串口发送—电压检测”的顺序排，控制标志优先，串口发送用非阻塞方式。

2.3 串口调试通道：先把黑匣子留出来

没有波形，调 PID 就是盲调。串口调试通道要在开闭环之前就留好，至少能同时看到角度、目标角度、左右 PWM 和电池电压。协议不用复杂，帧头加校验和就够；上位机按固定长度解析，丢帧时能自动重新对齐。发送周期我一般用 20 ms，控制周期 5 ms，每四次控制发一帧，既能看到趋势，又不会把串口占满。

// 每 20 ms 发送一帧：帧头 + 角度 + 目标 + 左 PWM + 右 PWM + 电压 + 校验 void Debug_SendFrame(float angle, float target, int16_t pwm_l, int16_t pwm_r, uint16_t vbat) { uint8_t buf[24]; uint8_t idx = 0; uint8_t sum = 0; buf[idx++] = 0xAA; buf[idx++] = 0x55; memcpy(&buf[idx], &angle, 4); idx += 4; memcpy(&buf[idx], &target, 4); idx += 4; memcpy(&buf[idx], &pwm_l, 2); idx += 2; memcpy(&buf[idx], &pwm_r, 2); idx += 2; memcpy(&buf[idx], &vbat, 2); idx += 2; for (uint8_t i = 0; i < idx; i++) sum += buf[i]; buf[idx++] = sum; // 实际工程里用 DMA 或环形缓冲，避免阻塞控制循环 Uart1_SendBytes(buf, idx); }

逻辑说明：帧头0xAA 0x55用于对齐，校验和用于判断丢帧；上位机按小端解析float和int16_t。参数说明：波特率 115200，发送周期 20 ms；角度和目标的单位要统一，我一般全部用度，PWM 用有符号整数，电压用毫伏。不要把这段放在 5 ms 控制中断里阻塞发送，否则控制周期会被串口拖到十几毫秒，角度环 D 项先疯掉。

提示：先把角度、目标、PWM 三条线画出来，再谈调参。看不到波形时，所谓“手感”很容易骗人。

上电顺序也建议固定：初始化时钟和 GPIO，校准 MPU6050 零偏，编码器清零，启动控制定时器，最后进主循环。这个顺序写死在main里，后面排查复位、角度漂移、编码器方向时，能少走很多回头路。

3. 姿态解算与串级 PID：角度环、速度环、转向环的参数怎么落地

3.1 互补滤波与零漂校准：角度可信度决定 PID 上限

平衡车的角度不是读出来就能用。加速度计静态准，但电机振动一大就噪声大；陀螺仪动态好，但积分会漂。互补滤波把两者合在一起：陀螺仪负责短期变化，加速度计负责长期基准。5 ms 周期下，alpha常用 0.96 到 0.99，越大越信陀螺，动态响应好，但零漂修正慢；越小越信加速度计，静态稳，但振动时角度会抖。校准零偏时车必须静止，采样 500 次取平均，大概一秒。

#define PI 3.1415926f float pitch_angle = 0.0f; float gyro_bias = 0.0f; float alpha = 0.98f; // 5 ms 周期下常用 0.96~0.99 void IMU_CalibrateGyro(void) { float sum = 0.0f; for (int i = 0; i < 500; i++) { sum += MPU6050_ReadGyroX(); Delay_ms(2); } gyro_bias = sum / 500.0f; } void IMU_UpdateAngle(float dt) { float acc_angle; float gyro_rate; float ax, ay, az; MPU6050_ReadAccel(&ax, &ay, &az); MPU6050_ReadGyro(&gyro_rate, NULL, NULL); gyro_rate -= gyro_bias; // 车体前后倾角，具体用哪两个轴取决于模块安装方向 acc_angle = atan2f(ay, az) * 180.0f / PI; pitch_angle = alpha * (pitch_angle + gyro_rate * dt) + (1.0f - alpha) * acc_angle; if (pitch_angle > 45.0f) pitch_angle = 45.0f; if (pitch_angle < -45.0f) pitch_angle = -45.0f; }

逻辑说明：先用陀螺仪积分预测角度，再用加速度计算出的倾角做低频修正；alpha越大，修正越慢，动态越跟手。参数说明：dt=0.005对应 5 ms；校准 500 次、每次 2 ms，约 1 秒；atan2f(ay, az)里的轴要按模块安装方向换，不能照抄。角度限幅在 ±45 度，防止倒地后积分爆掉。MPU6050 要减震，电机振动会让加速度计噪声大，滤波再漂亮也救不回来。

3.2 串级 PID 的代码骨架：外环给目标，内环给 PWM

纯平衡常见的是串级结构：角度环是内环，输入角度误差，输出 PWM；速度环是外环，输入编码器速度，输出角度补偿；转向环用左右轮速差，输出差速。速度环不要直接给 PWM，而是给角度目标，这样速度环的积分不会把电机直接顶到饱和。角度环一般用 PD，速度环用 PI，转向环用 P 就够。

typedef struct { float kp, ki, kd; float integral; float last_error; float out_min, out_max; float int_min, int_max; } PID_t; float PID_Calc(PID_t *pid, float target, float feedback, float dt) { float error = target - feedback; float p = pid->kp * error; pid->integral += error * dt; if (pid->integral > pid->int_max) pid->integral = pid->int_max; if (pid->integral < pid->int_min) pid->integral = pid->int_min; float i = pid->ki * pid->integral; float d = pid->kd * (error - pid->last_error) / dt; pid->last_error = error; float out = p + i + d; if (out > pid->out_max) out = pid->out_max; if (out < pid->out_min) out = pid->out_min; return out; } // 控制周期 5 ms 内调用 void Balance_Control(void) { float angle = pitch_angle - angle_offset; // 机械平衡点 float speed_l = Encoder_GetSpeedLeft(); float speed_r = Encoder_GetSpeedRight(); float speed_avg = (speed_l + speed_r) * 0.5f; // 速度环输出角度补偿，叠加到直立环目标 float speed_out = PID_Calc(&pid_speed, 0.0f, speed_avg, 0.005f); float angle_target = speed_out; float angle_out = PID_Calc(&pid_angle, angle_target, angle, 0.005f); float turn_out = PID_Calc(&pid_turn, 0.0f, (speed_l - speed_r), 0.005f); int16_t pwm_l = (int16_t)(angle_out + turn_out); int16_t pwm_r = (int16_t)(angle_out - turn_out); Motor_Set(pwm_l, pwm_r); }

逻辑说明：速度环输出的是“车体应该往前倾多少度”，不是 PWM；角度环再把这个目标角度和当前角度做 PD，输出总 PWM；转向环把左右轮速差拉回 0。参数说明：角度环kd对噪声敏感，微分项最好加低通；速度环输出限幅要小，常见只给几度，积分限幅防止静止时越积越大；dt必须和实际控制周期一致。angle_offset是机械平衡点，不是 0，上电后要慢慢调，直到小车能原地停住。

3.3 参数整定顺序与典型数值区间

整定顺序比参数本身重要。先调角度环 P，让车体有回正趋势；再加 D，压住回弹过冲；然后加速度环 P 和 I，让小车不会慢慢跑；最后调转向环。角度环 P 太小站不住，P 太大高频抖；D 太大低频抖、电机发热。速度环 P 太大会画龙，I 太大会低频摆。常见血泪经验是“先机械后参数”：重心偏高、轮胎打滑、齿轮间隙大，PID 怎么调都像在补偿机械缺陷。