基于立创地阔星STM32F103C8T6开发板的遥控平衡小车：MPU6050姿态控制与TB6612电机驱动实战

基于立创地阔星STM32F103C8T6开发板的遥控平衡小车MPU6050姿态控制与TB6612电机驱动实战最近有不少朋友在问想用STM32做个能自己站起来的平衡小车但网上的教程要么太零散要么代码看不懂。正好我之前用立创的地阔星开发板核心是STM32F103C8T6完整地做过一个从硬件焊接到软件调试踩了不少坑也积累了不少经验。今天我就把这个项目的核心部分——如何用MPU6050获取姿态数据再用PID算法通过TB6612驱动电机保持平衡——手把手地分享出来。这篇文章适合已经对STM32有一定了解会用Keil或STM32CubeIDE写点简单程序并且对PID控制和电机驱动感兴趣的朋友。跟着做下来你不仅能得到一个能跑能站的小车更能彻底搞明白姿态解算和平衡控制的原理。咱们先从整体认识这个项目开始。1. 项目总览我们要做一个什么样的智能小车在动手写代码、焊电路之前咱们得先想清楚目标。我这个平衡小车项目核心目标就一个让两个轮子的小车像“不倒翁”一样自己站稳并且能通过遥控让它前后移动。听起来简单但为了实现它我们需要几个关键部分协同工作“大脑” (主控)立创地阔星STM32F103C8T6开发板。它负责所有计算和决策。“小脑” (姿态感知)MPU6050模块。它集成了陀螺仪和加速度计实时告诉“大脑”小车现在是前倾还是后仰倾斜了多少度。“肌肉” (动力执行)TB6612电机驱动模块。它接收“大脑”的指令精确控制两个直流电机的转速和方向。“眼睛” (环境感知)SR04超声波模块。用于避障防止小车撞上障碍物。“遥控器” (人机交互)摇杆模块和HC-05蓝牙模块。支持手动摇杆控制和手机蓝牙遥控两种方式。“仪表盘” (状态显示)0.96寸OLED屏幕。用来显示角度、速度、电池电压等信息调试的时候特别有用。除了这些还有供电部分比如MP1584EN降压模块负责把电池电压比如7.4V锂电池稳定到5V给开发板和外设供电3V3升5V模块则给需要5V电平的模块供电。这个项目最终实现了几个很酷的功能自动平衡这是基础小车放下后能自己站起来。双模式遥控既可以用摇杆像开遥控车一样控制也可以用手机通过蓝牙连接利用手机内置的陀螺仪来倾斜控制小车就像玩赛车游戏。智能避障超声波模块检测前方障碍物太近了就自动停车。拿起/放下检测当你把小车拿起来把玩时它会自动关闭电机放回地面并轻推一下它又立刻进入平衡模式准备奔跑。接下来咱们就深入核心看看最关键的姿态感知和电机驱动是怎么实现的。2. 核心模块一MPU6050姿态数据获取与处理想让小车平衡首先得知道它“歪”成啥样了。这就是MPU6050的活儿。这个小小的模块能输出三轴加速度和三轴角速度的原始数据但我们需要的是直观的“俯仰角”Pitch和“横滚角”Roll。这个过程叫姿态解算。2.1 MPU6050基础连接与驱动首先把MPU6050模块和地阔星开发板连起来。MPU6050通常通过I2C接口通信接线非常简单MPU6050引脚地阔星STM32引脚说明VCC3.3V供电注意有些模块是5V的要看清GNDGND共地SCLPB6 (或PB8根据你的I2C配置)I2C时钟线SDAPB7 (或PB9根据你的I2C配置)I2C数据线注意一定要确保开发板和所有模块的GND连接在一起这是电路正常工作的基础。接线完成后在STM32上初始化I2C外设。我一般用STM32CubeMX配置生成初始化代码非常方便。初始化成功后就可以通过I2C读写MPU6050内部的寄存器了。首先需要配置MPU6050比如设置陀螺仪和加速度计的量程、采样率等。这里我通常将加速度计量程设为±2g陀螺仪量程设为±250°/s对于平衡小车来说精度和范围都足够了。// MPU6050初始化函数示例基于HAL库 void MPU6050_Init(void) { uint8_t check, data; // 1. 检查设备ID确认MPU6050连接正常 HAL_I2C_Mem_Read(hi2c1, MPU6050_ADDR, WHO_AM_I_REG, 1, check, 1, 1000); if (check 0x68) { // MPU6050的默认设备ID是0x68 // 2. 唤醒MPU6050退出睡眠模式 data 0x00; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, PWR_MGMT_1_REG, 1, data, 1, 1000); // 3. 设置陀螺仪量程为 ±250 °/s data 0x00; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, GYRO_CONFIG_REG, 1, data, 1, 1000); // 4. 设置加速度计量程为 ±2g data 0x00; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, ACCEL_CONFIG_REG, 1, data, 1, 1000); // 5. 设置数字低通滤波器 (DLPF)这里我常用带宽20Hz能滤掉一些高频振动噪声 data 0x04; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, CONFIG_REG, 1, data, 1, 1000); } }2.2 读取原始数据与姿态解算初始化完成后我们就可以在一个定时器中断里比如1ms一次周期性地读取原始数据了。// 读取MPU6050的原始数据加速度和角速度 void MPU6050_Read_RawData(MPU6050_Data *mpu_data) { uint8_t buf[14]; // 一次性读取加速度计和陀螺仪的6个轴数据共14个寄存器 HAL_I2C_Mem_Read(hi2c1, MPU6050_ADDR, ACCEL_XOUT_H_REG, 1, buf, 14, 1000); // 将两个8位数据组合成一个16位有符号整数 mpu_data-Accel_X (int16_t)((buf[0] 8) | buf[1]); mpu_data-Accel_Y (int16_t)((buf[2] 8) | buf[3]); mpu_data-Accel_Z (int16_t)((buf[4] 8) | buf[5]); mpu_data-Gyro_X (int16_t)((buf[8] 8) | buf[9]); mpu_data-Gyro_Y (int16_t)((buf[10] 8) | buf[11]); mpu_data-Gyro_Z (int16_t)((buf[12] 8) | buf[13]); }拿到原始数据后关键的一步是姿态解算。这里我推荐使用互补滤波算法它计算量小效果也不错非常适合STM32F103这种资源有限的单片机。原理简单说就是用加速度计算出的角度长期稳定但动态响应慢、易受振动干扰和用陀螺仪积分算出的角度短期精确动态响应快但会随时间漂移互相“取长补短”。// 互补滤波计算俯仰角(Pitch)和横滚角(Roll) // dt是采样时间间隔单位秒比如0.0011ms // 系数A通常取0.98左右表示信任陀螺仪的程度 float Complementary_Filter(float accel_angle, float gyro_rate, float *angle, float dt, float A) { // 用陀螺仪的角速度积分得到角度变化 *angle A * (*angle gyro_rate * dt) (1 - A) * accel_angle; return *angle; } // 实际调用示例在1ms定时中断中 void TIM_IRQ_Handler(void) { MPU6050_Data raw_data; static float pitch_angle 0.0, roll_angle 0.0; float dt 0.001; // 1ms MPU6050_Read_RawData(raw_data); // 1. 从加速度计数据计算角度单位弧度 // 注意这里假设模块平放Z轴朝上。公式是 atan2(Accel_Y, Accel_Z) float accel_pitch atan2(raw_data.Accel_Y, raw_data.Accel_Z) * 180.0 / PI; // 同理计算横滚角 atan2(-Accel_X, Accel_Z) float accel_roll atan2(-raw_data.Accel_X, raw_data.Accel_Z) * 180.0 / PI; // 2. 将陀螺仪原始数据转换为角速度度/秒 // 量程为±250°/s时转换系数 250 / 32768 ≈ 0.00763 float gyro_pitch_rate raw_data.Gyro_X * GYRO_SCALE_FACTOR; float gyro_roll_rate raw_data.Gyro_Y * GYRO_SCALE_FACTOR; // 3. 应用互补滤波 pitch_angle Complementary_Filter(accel_pitch, gyro_pitch_rate, pitch_angle, dt, 0.98); roll_angle Complementary_Filter(accel_roll, gyro_roll_rate, roll_angle, dt, 0.98); // 现在pitch_angle 就是小车前后倾斜的角度是后续PID控制的核心输入 }提示互补滤波中的系数A需要根据实际情况微调。如果小车抖动厉害可以适当增大A更信任陀螺仪如果角度漂移严重可以适当减小A更信任加速度计。调试时可以在OLED上实时显示角度值用手转动模块看响应和稳定性。3. 核心模块二TB6612电机驱动与控制知道了小车倾斜的角度接下来就要控制电机做出反应把小车“拉”回来。TB6612是一个性能比L298N更好的双路直流电机驱动芯片发热小效率高。3.1 TB6612接线与基本控制一个TB6612可以驱动两个电机。它的控制逻辑非常清晰主要通过几个输入引脚来控制电机的转向和速度。TB6612引脚/功能连接地阔星引脚作用VM电池正极 (7.4V)电机电源接锂电池VCC5V逻辑电源接开发板5VGNDGND共地电机A控制AIN1PC0 (GPIO)控制电机A转向AIN2PC1 (GPIO)控制电机A转向PWMAPA0 (TIM2_CH1)电机A速度(PWM)电机B控制BIN1PC2 (GPIO)控制电机B转向BIN2PC3 (GPIO)控制电机B转向PWMBPA1 (TIM2_CH2)电机B速度(PWM)STBYPC4 (GPIO)待机控制高电平有效控制逻辑如下表所示以电机A为例AIN1AIN2PWMA (PWM占空比)电机A状态00X停止刹车100-100%正转速度由PWM决定010-100%反转速度由PWM决定11X停止刹车所以在代码里我们只需要设置好GPIO和PWM定时器然后通过改变AIN1/AIN2的电平和PWM占空比就能精确控制电机了。// TB6612电机控制函数示例 // 定义控制引脚 #define MOTOR_A_IN1_PIN GPIO_PIN_0 #define MOTOR_A_IN1_PORT GPIOC #define MOTOR_A_IN2_PIN GPIO_PIN_1 #define MOTOR_A_IN2_PORT GPIOC // 假设PWM已经配置在TIM2的通道1和2上 // 电机控制结构体 typedef struct { int16_t speed; // 目标速度-1000 ~ 1000 GPIO_PinState in1; GPIO_PinState in2; } Motor_t; Motor_t motorA, motorB; // 设置单个电机的速度和方向 void Motor_Set(Motor_t *motor, int16_t speed) { motor-speed speed; if (speed 0) { // 正转 motor-in1 GPIO_PIN_SET; motor-in2 GPIO_PIN_RESET; __HAL_TIM_SET_COMPARE(htim2, TIM_CHANNEL_1, speed); // 设置PWM占空比 } else if (speed 0) { // 反转 motor-in1 GPIO_PIN_RESET; motor-in2 GPIO_PIN_SET; __HAL_TIM_SET_COMPARE(htim2, TIM_CHANNEL_1, -speed); // 取绝对值 } else { // 停止刹车 motor-in1 GPIO_PIN_SET; motor-in2 GPIO_PIN_SET; __HAL_TIM_SET_COMPARE(htim2, TIM_CHANNEL_1, 0); } // 更新GPIO引脚状态 HAL_GPIO_WritePin(MOTOR_A_IN1_PORT, MOTOR_A_IN1_PIN, motor-in1); HAL_GPIO_WritePin(MOTOR_A_IN2_PORT, MOTOR_A_IN2_PIN, motor-in2); }3.2 平衡的灵魂PID控制算法现在我们有了角度来自MPU6050也有了执行器TB6612控制的电机。如何根据角度误差来计算出合适的电机速度呢这就需要PID控制器。它是整个平衡小车的大脑。PID是比例(Proportional)、积分(Integral)、微分(Derivative)的缩写。你可以把它想象成一个经验丰富的司机P (比例)小车往后倒得越厉害角度误差越大司机就踩油门让车往前跑得越快试图把它拉回来。这是最直接的反应。I (积分)如果小车因为地面有点斜坡光靠P项总是差一点站不稳存在静态误差I项就会慢慢累积这个误差给出一个持续的修正力直到误差为零。D (微分)小车倒下的速度角速度越快D项就给出一个更强的“刹车”或“助推”力防止小车冲过头而剧烈振荡。它预测未来的趋势增加系统稳定性。对于平衡小车我们主要用角度偏差来控制电机的速度这被称为“直立环”PD控制I项在这里作用不大有时甚至会引起振荡可以先不用。// 一个简单的直立环PD控制器实现 typedef struct { float target; // 目标值平衡小车就是0度 float kp; // 比例系数 float kd; // 微分系数 float last_error; // 上一次误差用于计算微分 } PID_t; PID_t balance_pid; // PID计算函数 float PID_Calculate(PID_t *pid, float measure) { float error, output; float differential; // 1. 计算当前误差 error pid-target - measure; // 2. 计算微分项本次误差 - 上次误差这近似代表了误差的变化速度 differential error - pid-last_error; // 更新上次误差 pid-last_error error; // 3. PD输出 Kp * 误差 Kd * 误差变化率 output pid-kp * error pid-kd * differential; // 4. 对输出进行限幅防止给电机的值过大 if (output 1000.0) output 1000.0; if (output -1000.0) output -1000.0; return output; } // 在主循环或定时中断中调用 void Balance_Control(void) { float pitch_angle; // 从MPU6050解算得到的俯仰角 float motor_output; // 获取当前角度假设已通过互补滤波更新 pitch_angle Get_Current_PitchAngle(); // 初始化PID参数这些值需要实际调试确定这里只是示例 balance_pid.target 0.0; // 目标是0度直立 balance_pid.kp 25.0; // P参数需要调试 balance_pid.kd 0.8; // D参数需要调试 // 计算PD输出 motor_output PID_Calculate(balance_pid, pitch_angle); // 将输出同时赋给两个电机同向用于平衡 Motor_Set(motorA, (int16_t)motor_output); Motor_Set(motorB, (int16_t)motor_output); }调试心得PID调试是平衡小车成功的关键。我的经验是“先P后DI最后”。先调P将D和I设为0。慢慢增大P直到小车能对倾斜做出反应但会来回振荡像在平衡点附近“发抖”。再调D逐渐加入D参数。D能抑制振荡让小车稳定下来。D太大会导致反应迟钝太小则抑制不了振荡。最后考虑I如果小车在平衡点有固定方向的偏移比如总是慢慢往一个方向跑可以加入很小的I值来消除这个静态误差。 调试时一定要有耐心每次只改一个参数并记录下现象。4. 系统整合与功能实现把MPU6050数据读取、姿态解算、PID控制和电机驱动这几个模块在定时中断里有机结合起来平衡的核心功能就实现了。但一个完整的遥控小车还需要其他功能。4.1 遥控指令处理遥控指令来自摇杆或手机蓝牙主要用于给小车一个前进/后退的速度目标。这个目标速度会与上面平衡控制计算出的电机速度进行叠加。// 速度环PID外环 PID_t speed_pid; int16_t target_speed 0; // 来自遥控器的目标速度 // 在平衡控制的基础上加入速度控制 void Balance_And_Speed_Control(void) { float pitch_angle Get_Current_PitchAngle(); float balance_output, speed_output, final_output; static float actual_speed 0; // 需要通过编码器测量实际速度 // 1. 直立环PD控制保持不倒 balance_output PID_Calculate(balance_pid, pitch_angle); // 2. 速度环PI控制实现遥控调速 // 假设我们通过电机编码器获取了实际速度 actual_speed // speed_pid.target 就是 target_speed (遥控设定) speed_output PID_Calculate(speed_pid, actual_speed); // 3. 融合速度环的输出是角度目标的变化量 // 也就是说想让车跑起来就故意让它“前倾”一点平衡环就会驱动车轮去追这个角度车就动了 balance_pid.target speed_output; // 动态修改直立环的目标角度 // 4. 最终输出这里简化了实际融合方式可能更复杂 final_output balance_output; Motor_Set(motorA, (int16_t)final_output); Motor_Set(motorB, (int16_t)final_output); }4.2 超声波避障与状态检测超声波模块SR04的触发和回声检测需要精确的定时。我通常用一个定时器产生10us的触发脉冲然后用输入捕获功能测量高电平持续时间来计算距离。// 简单的避障逻辑 void Obstacle_Avoidance(void) { float distance_cm Get_Ultrasonic_Distance(); if (distance_cm 15.0) { // 如果前方15厘米内有障碍物 if (target_speed 0) { // 且当前遥控指令是向前 target_speed 0; // 屏蔽向前的速度指令小车停止 // 也可以让小车短暂后退或转向 } } }拿起/放下检测则可以通过MPU6050的加速度计数据来实现。当小车被拿起时加速度计Z轴的数据会接近重力加速度g且各轴数据变化平缓当被放下时会有一个轻微的冲击信号。通过检测这些特征可以切换小车的平衡使能标志。把这些功能模块都整合到一个清晰的主程序框架里平衡小车就能既稳定站立又听从指挥还能智能避障了。整个项目的代码结构会围绕一个高精度的定时中断展开在中断里读取传感器、进行PID计算、更新电机PWM而在主循环里处理遥控指令、避障逻辑和状态显示OLED。