用Arduino UNO R3和MPU6050搞定平衡小车：从硬件接线到PID参数调试全记录
从零打造Arduino平衡小车：硬件搭建与PID调参实战指南
1. 项目准备与硬件选型
平衡小车作为入门机器人的经典项目，融合了传感器技术、控制算法和机电一体化设计。在开始动手前，我们需要准备以下核心组件：
核心硬件清单：
- 主控板：Arduino UNO R3（性价比高，社区支持完善）
- 姿态传感器：MPU6050（集成三轴加速度计+三轴陀螺仪）
- 电机驱动：TB6612FNG（支持双路PWM控制，最大1.2A持续电流）
- 执行机构：带编码器的直流减速电机（建议减速比1:48以上）
- 电源系统：18650锂电池两节串联（配专用充电保护板）
注意：选购MPU6050时建议选择带电平转换的模块版本，避免5V/3.3V电平不匹配问题
硬件连接示意图如下表所示：
| 模块 | Arduino引脚 | 连接说明 |
|---|---|---|
| MPU6050 SDA | A4 | I²C数据线 |
| MPU6050 SCL | A5 | I²C时钟线 |
| TB6612 PWMA | D9 | 左电机PWM控制 |
| TB6612 AIN1 | D7 | 左电机方向控制线1 |
| TB6612 AIN2 | D6 | 左电机方向控制线2 |
| TB6612 PWMB | D10 | 右电机PWM控制 |
| TB6612 BIN1 | D13 | 右电机方向控制线1 |
| TB6612 BIN2 | D12 | 右电机方向控制线2 |
2. 传感器数据采集与处理
2.1 MPU6050初始配置
MPU6050需要正确初始化才能输出可靠的姿态数据。以下是关键配置步骤：
#include <Wire.h> const int MPU_ADDR = 0x68; void setup() { Wire.begin(); Wire.beginTransmission(MPU_ADDR); Wire.write(0x6B); // PWR_MGMT_1寄存器 Wire.write(0); // 解除休眠状态 Wire.endTransmission(true); // 设置陀螺仪量程为±500°/s Wire.beginTransmission(MPU_ADDR); Wire.write(0x1B); // GYRO_CONFIG寄存器 Wire.write(0x08); Wire.endTransmission(true); // 设置加速度计量程为±4g Wire.beginTransmission(MPU_ADDR); Wire.write(0x1C); // ACCEL_CONFIG寄存器 Wire.write(0x08); Wire.endTransmission(true); }2.2 卡尔曼滤波实现
原始传感器数据存在噪声，需要通过滤波算法提高数据质量。以下是简化版的卡尔曼滤波实现：
class SimpleKalman { private: float Q_angle = 0.001; float Q_bias = 0.003; float R_measure = 0.03; float angle = 0; float bias = 0; float P[2][2] = {{0}}; public: float update(float newAngle, float newRate, float dt) { // 预测阶段 angle += dt * (newRate - bias); P[0][0] += dt * (dt*P[1][1] - P[0][1] - P[1][0] + Q_angle); P[0][1] -= dt * P[1][1]; P[1][0] -= dt * P[1][1]; P[1][1] += Q_bias * dt; // 更新阶段 float y = newAngle - angle; float S = P[0][0] + R_measure; float K[2] = {P[0][0]/S, P[1][0]/S}; angle += K[0] * y; bias += K[1] * y; P[0][0] -= K[0] * P[0][0]; P[0][1] -= K[0] * P[0][1]; P[1][0] -= K[1] * P[0][0]; P[1][1] -= K[1] * P[0][1]; return angle; } };3. 电机控制与编码器处理
3.1 TB6612FNG驱动配置
这款电机驱动芯片需要特别注意引脚逻辑组合：
| 控制模式 | AIN1 | AIN2 | PWM | 电机状态 |
|---|---|---|---|---|
| 正转 | HIGH | LOW | PWM | 顺时针 |
| 反转 | LOW | HIGH | PWM | 逆时针 |
| 刹车 | HIGH | HIGH | HIGH | 快速停止 |
| 停止 | LOW | LOW | - | 自由停止 |
典型控制代码示例：
#define AIN1 7 #define AIN2 6 #define PWMA 9 void setMotor(int speed) { if(speed >= 0) { digitalWrite(AIN1, HIGH); digitalWrite(AIN2, LOW); } else { digitalWrite(AIN1, LOW); digitalWrite(AIN2, HIGH); } analogWrite(PWMA, abs(speed)); }3.2 编码器速度测量
使用中断方式捕获编码器脉冲，实现速度反馈：
volatile long encoderCount = 0; void setup() { attachInterrupt(digitalPinToInterrupt(2), countEncoder, CHANGE); } void countEncoder() { if(digitalRead(2) == digitalRead(3)) { encoderCount++; } else { encoderCount--; } } float getSpeed(unsigned long interval) { static long lastCount = 0; long currentCount = encoderCount; float speed = (currentCount - lastCount) * 60.0 / (20.0 * interval) * 1000; // RPM lastCount = currentCount; return speed; }4. PID控制算法实现
4.1 直立环控制
直立环采用PD控制，核心公式：
输出 = Kp×角度偏差 + Kd×角速度调试步骤：
- 先将Kd设为0，逐步增大Kp直到小车出现小幅振荡
- 保持Kp不变，逐步增加Kd直到振荡消失
- 典型参数范围：Kp=15-30，Kd=0.3-0.8
4.2 速度环控制
速度环采用PI控制，解决直立环的静态误差：
输出 = Kp×速度偏差 + Ki×速度偏差积分调试技巧：
- 先调Kp使小车能抵抗轻微推力
- 再调Ki消除稳态误差
- 典型参数比例：Ki ≈ Kp/200
4.3 转向环控制
转向环通过陀螺仪Z轴数据实现差速控制：
float turnControl(float gyroZ) { static float integral = 0; integral += gyroZ * dt; return Kp_turn * gyroZ + Ki_turn * integral; }5. 系统集成与调试技巧
5.1 多任务时序安排
使用定时中断确保控制周期稳定：
#include <MsTimer2.h> void controlLoop() { static unsigned long lastTime = 0; float dt = (millis() - lastTime) / 1000.0; lastTime = millis(); // 传感器数据读取 // 控制算法计算 // 电机输出 } void setup() { MsTimer2::set(5, controlLoop); // 5ms控制周期 MsTimer2::start(); }5.2 常见问题排查
问题1：小车剧烈振荡
- 检查Kp是否过大
- 确认MPU6050安装牢固
- 验证电机转向是否正确
问题2：向一侧倾斜
- 校准机械中值角
- 检查电池电量是否平衡
- 调整重心位置
问题3：响应迟钝
- 适当增大Kp
- 检查控制周期是否过长
- 确认电机扭矩足够
6. 进阶优化方向
参数自整定：实现PID参数的自动调整
void autoTune() { // 通过施加阶跃响应分析系统特性 // 根据响应曲线计算PID参数 }无线调试接口：通过蓝牙传输实时数据
void sendData() { Serial.print("Angle:"); Serial.print(currentAngle); Serial.print(",Output:"); Serial.println(motorOutput); }运动轨迹规划：实现预设路径行驶
# 上位机路径生成示例 import numpy as np t = np.linspace(0, 10, 100) path = np.sin(t) # 正弦路径
在完成基础版本后，可以尝试添加超声波避障、手机蓝牙遥控或Wi-Fi视频传输等功能扩展。实际调试中发现，电机齿轮间隙对控制效果影响显著，建议使用金属齿轮电机并定期润滑维护。