从PID控制到反应轮：自制自平衡立方体的完整工程实践

1. 项目概述与核心思路

自平衡系统听起来像是机器人学里的高级课题，但它的核心思想其实很直观：想象一下你试图用手指顶住一根长杆让它保持直立。当杆子开始向一侧倾斜时，你的手指会迅速向同一方向移动，以支撑杆子底部，防止它倒下。自平衡设备做的事情本质上与此相同，只不过它用传感器代替了你的眼睛，用电机代替了你的手指，用算法代替了你的大脑反应。

这次我们要做的，是一个更具几何美感的挑战——让一个立方体在它的棱或角上保持平衡。这比平衡一个两轮小车或一个球体要复杂，因为它需要在三维空间里对抗重力。项目原作者ReM-RC的设计非常巧妙：他将整个系统封装在一个3D打印的立方体壳内，通过内部三个正交安装的反应轮来产生稳定力矩。整个系统的“大脑”是一块Arduino Nano，而“前庭器官”则是一枚MPU6050传感器，它集成了三轴陀螺仪和三轴加速度计，能实时感知立方体在空间中的姿态变化。

这个项目吸引我的地方在于它的完整性。它不是一个简单的演示，而是一个融合了机械设计、电子电路、嵌入式编程和控制系统理论的综合性实践。你需要动手3D打印外壳、焊接电路、编写并调试PID控制算法，最终亲眼见证一个看似不可能稳定的立方体，在你的代码指挥下颤颤巍巍地立起来，那种成就感是无与伦比的。无论你是想深入学习PID调参，还是想搞明白IMU传感器数据如何融合成可靠的姿态角，或是单纯想做一个炫酷的桌面玩具，这个项目都能给你带来满满的干货。

2. 系统核心原理与设计拆解

2.1 自平衡的物理与控制基础

要让一个物体稳定在一个点或一条棱上，核心是控制其重心投影。对于这个立方体，当其静止放置时，重心在地面的投影位于支撑面内，是稳定的。一旦我们试图让它立在棱或角上，重心投影极易跑出微小的支撑点，导致倾倒。自平衡系统的任务，就是通过主动产生力矩，不断将重心“拉回”支撑点上方。

这个项目采用的反应轮方案，是航天器姿态控制的经典思路在地面玩具上的应用。三个直流电机分别驱动一个较重的飞轮（3D打印轮子加配重螺母），它们被安装在立方体内部，且三个转轴相互垂直，分别对应立方体翻滚（Roll）、俯仰（Pitch）和偏航（Yaw）三个自由度。当立方体向某个方向倾斜时，控制系统会命令对应轴上的电机加速旋转。根据角动量守恒定律，飞轮加速会产生一个反作用力矩，这个力矩会作用在立方体壳体上，抵抗其倾斜的趋势。简单来说，就像你坐在一个转椅上，如果你快速转动一个自行车轮，你的身体会向反方向转动。

整个控制回路是一个典型的反馈控制系统：

1. 感知：MPU6050持续测量立方体在各个轴上的角速度（陀螺仪）和线性加速度（加速度计）。
2. 融合与估计：通过传感器融合算法（如互补滤波或卡尔曼滤波），将陀螺仪的短期高精度和加速度计的长期稳定性结合起来，计算出当前立方体相对于重力方向的倾斜角（姿态角）。
3. 决策：将计算出的倾斜角与期望的平衡角度（如0度）进行比较，得到角度误差。这个误差经过PID控制器计算，输出一个控制量。PID控制器中的比例（P）项负责快速响应，积分（I）项消除静态误差，微分（D）项抑制振荡和过冲。
4. 执行：PID输出的控制量被转换为PWM信号，驱动对应的电机加速或减速，产生纠正力矩。

2.2 硬件架构选型解析

为什么选择这些硬件组件？每一个选择背后都有其考量。

• 主控：Arduino Nano选择Arduino Nano而非更强大的ESP32或STM32，首要原因是生态和简化。这个项目的核心挑战在于控制算法和机械调试，而非网络功能或超高计算性能。Nano基于ATmega328P，有足够的性能运行传感器融合和三个PID控制回路。其丰富的库支持和庞大的社区意味着MPU6050、PID、EEPROM等都有现成可靠的库，能极大降低开发门槛。对于初次接触自平衡系统的开发者，减少底层驱动困扰，聚焦于核心逻辑，是快速成功的关键。当然，正如原文提到的，ESP32是绝佳的升级选择，它内置蓝牙，性能更强，但在项目初期，Nano的简单可靠更具优势。

• 传感器：MPU6050MPU6050是开源硬件领域的“常青树”，它价格低廉、集成度高（六轴IMU）、I2C接口简单，且有非常成熟的库（如MPU6050_tockn、I2Cdevlib）支持，能直接输出校准后的传感器数据和融合后的姿态角。对于这个项目，其精度和响应速度完全足够。它的缺点是对振动比较敏感，但在立方体这种相对低速的应用中影响不大。

• 执行器：Nidec 24H电机这是整个系统的“肌肉”。选择这类空心杯电机是因为它们体积小、重量轻、启停和反转响应迅速。自平衡需要电机能快速产生变化的力矩，大惯量的电机响应慢，会导致系统不稳定。在轮子上增加配重螺母是关键一步，这增加了飞轮的转动惯量。根据角动量公式L = Iω（角动量=转动惯量×角速度），在电机转速变化相同的情况下，转动惯量I越大，产生的角动量变化ΔL越大，进而产生的反作用力矩也越大，平衡效果越强。

• 通信与调试：HC-05蓝牙模块在调试阶段，这个模块价值连城。自平衡系统的PID参数需要反复调试，如果每次修改参数都要插拔USB线，会非常繁琐。通过蓝牙连接，你可以在手机或电脑上使用串口工具，实时发送调参命令、查看传感器数据和系统状态，实现“无线调试”，效率倍增。

• 供电：3节锂离子电池采用3节电池串联，提供约11.1V的电压，足以驱动电机获得足够的转速和扭矩。独立的电池供电也避免了电机工作时对控制电路造成的电压波动干扰，提高了系统稳定性。

3. 机械结构设计与3D打印要点

3.1 3D模型分析与打印准备

项目的所有结构件都是开源的STL文件。你需要打印的部件主要分为三类：

1. 立方体壳体：包括三个带电机座的“反应轮侧面”和三个普通的“侧面”。它们通过卡扣或螺丝组合成一个中空的立方体。
2. 内部结构：电池和控制器安装板、MPU6050传感器支架、电池仓、控制器支架及其固定件。这些部件确保了所有电子元件牢固地安装在立方体内部，且传感器方向与立方体几何轴对齐至关重要。
3. 反应轮：三个飞轮。这是需要后期配重的核心部件。

注意：打印方向与强度。对于承受应力的部件，如电机座和安装板，打印时应确保层积方向与受力方向垂直，以最大化强度。例如，电机座的固定臂，最好让其侧面接触打印平台，这样层纹是沿着臂的长度方向，而不是垂直于它，后者容易在受力时从层间开裂。

打印这类工程部件，我强烈建议使用PLA+或者PETG材料，而不是普通的PLA。PLA+强度和韧性更好，PETG则兼具强度、韧性和一定的耐温性。打印参数上，层高可以选择0.2mm以获得较好的表面质量和强度平衡。填充率建议在25%-40%之间，太高会增加重量和打印时间，太低可能影响结构刚性。外壳和安装板建议使用3-4个 perimeter（壁厚），以增强其坚固性。

3.2 关键组装技巧与校准

组装顺序很重要。我的经验是：

1. 先组装内部核心：将电机安装到各自的座子上，并临时固定。将Arduino、MPU6050、电机驱动电路焊接在万用板或按照提供的PCB设计制作电路板，然后安装到控制器安装板上。务必确保MPU6050模块的X、Y、Z轴与立方体的几何轴严格对齐。你可以用模块上的标注或借助手机水平仪App进行粗调，细微的偏差可以在软件里通过坐标系旋转矩阵来补偿，但硬件上尽量对齐能省去很多麻烦。
2. 配重与动平衡：这是影响平衡性能的隐形关键。按照说明，在反应轮上对称地安装螺母作为配重。“对称”二字至关重要。你需要用天平确保每个轮子加上螺母后的总重量一致。更进一步，可以做一个简单的动平衡测试：将电机轴水平放置，轻轻转动轮子，观察它是否会在任意位置停下。如果它总是停在某个特定位置，说明该位置偏重，需要微调配重螺母的位置或增加少量配重（如小块胶泥）在对称点。一个动平衡差的轮子高速旋转时会产生振动，这会严重干扰MPU6050的读数。
3. 总装与走线：将装好电机的侧面与内部核心组装起来，连接电机线。电机线建议用扎带或热熔胶固定，防止在立方体内部晃动或缠绕。最后盖上剩余的侧面，完成密封。确保所有螺丝紧固，但也不要过度拧紧导致塑料件开裂。

4. 电路设计与焊接实操

4.1 电路原理详解

虽然原文提到了可以设计PCB，但理解电路原理对于调试和排错必不可少。系统的核心电路并不复杂，可以在一块洞洞板上完成。

• 电机驱动：这里使用了一个简单的NPN三极管（如8050）驱动方案。Arduino的PWM引脚通过一个限流电阻（例如220Ω）连接到三极管的基极。三极管的集电极接电机一端，发射极接地。电机另一端接电池正极（Vbat）。当PWM输出高电平时，三极管导通，电机两端获得电压（Vbat - Vce_sat）而转动；PWM低电平时，三极管截止，电机停止。电机两端需要并联一个续流二极管（如1N4148），阴极接Vbat，阳极接三极管集电极，用于吸收电机线圈在断电时产生的反向电动势，保护三极管不被击穿。

  • 为什么不用专用驱动芯片？对于这种小型空心杯电机，电流不大（通常小于500mA），简单的三极管开关电路足以胜任，成本极低。如果电机需要正反转，则需要使用H桥芯片（如L298N、DRV8833），但本项目通过控制单方向加速/减速来产生力矩，无需反转，因此单路驱动即可。

• MPU6050连接：标准的I2C接法。VCC接5V（注意有些模块是3.3V逻辑），GND接地，SDA接Arduino Nano的A4引脚，SCL接A5引脚。有些模块带有AD0引脚，用于改变I2C地址，如果只用一个传感器，通常接地即可。

• HC-05蓝牙模块：VCC接5V，GND接地，TXD接Nano的RX（D0），RXD接Nano的TX（D1）。重要提示：在烧录程序时，必须断开蓝牙模块的TXD/RXD与Arduino的连接，否则串口冲突会导致上传失败。烧录完成后再接上。

• 供电：3节锂电池串联后，正负极直接给三个电机供电。同时，通过一个降压模块（如AMS1117-5.0）将电池电压降至5V，为Arduino Nano、MPU6050、蓝牙模块等供电。务必确保你的降压模块能提供足够的电流。

4.2 焊接与布局心得

在洞洞板上焊接时，遵循“先矮后高，先里后外”的原则。先焊接电阻、二极管等小元件，再焊接排针、插座，最后连接较粗的电源线和电机线。

• 电源走线要粗：电机启动瞬间电流较大，给电机供电的走线尽可能短而粗，可以用焊锡堆叠或者直接使用导线。
• 模拟与数字分离：尽量让电机驱动部分（大电流）和传感器、MCU部分（小信号）在板子上有一定的距离，避免噪声耦合。如果条件允许，可以单独用一块小板子做电机驱动。
• 预留测试点：在关键位置，如5V电源、每个电机的驱动输入端（PWM信号），可以引出排针作为测试点，方便用万用表或示波器测量。

5. 软件实现与核心算法剖析

5.1 开发环境与库配置

在Arduino IDE中，你需要安装以下库（通过库管理器搜索安装）：

1. MPU6050_tockn或I2Cdevlibby Jeff Rowberg：用于与MPU6050通信并获取数据。MPU6050_tockn更简单易用，自带互补滤波。
2. PID_v1by Brett Beauregard：这是Arduino社区经典的PID控制库，大大简化了PID控制器的实现。

代码结构主要包含以下几个部分：

• 初始化：初始化串口（用于调试和蓝牙）、I2C总线、MPU6050传感器，并对其进行校准（计算零偏）。同时初始化三个PID控制器实例，分别对应Roll、Pitch和Yaw轴。
• 主循环：
  1. 读取MPU6050的原始数据。
  2. 调用传感器融合函数（如互补滤波），计算出当前姿态角（roll,pitch,yaw）。互补滤波的核心思想是：角度 = 0.98 * (上一角度 + 陀螺仪角速度 * dt) + 0.02 * 加速度计计算的角度。其中dt是两次循环的时间间隔，系数0.98和0.02可以根据实际情况调整。
  3. 将计算出的roll和pitch角度作为PID控制器的输入（过程变量Input），设定点（Setpoint）设为0（平衡状态）。PID控制器进行计算，输出控制量（Output）。
  4. 将PID输出值映射为PWM占空比，通过analogWrite()函数输出到对应的电机驱动引脚。注意，输出值有正负，代表电机需要加速或减速。我们需要将其转换为绝对值，并确保不超出PWM范围（0-255）。
  5. 处理串口命令，用于校准和调参。

5.2 PID参数整定实战经验

PID调参是让立方体“活”起来的关键，也是一个需要耐心的试错过程。我建议遵循以下步骤：

1. 先调P（比例）：将I和D设为0。逐渐增大P值。你会发现立方体开始对倾斜有反应，但可能会在平衡点附近来回振荡。目标是找到一个P值，使得立方体能对倾斜做出快速响应，但又不至于剧烈振荡。此时立方体可能无法稳定，会缓慢地倒向一边，这是因为没有积分项来消除静态误差。
2. 再调I（积分）：加入一个很小的I值。I项的作用是累积误差，消除静态误差（比如立方体因为轻微的不对称总是偏向一边）。如果I值太大，会导致系统反应迟钝，甚至出现积分饱和，引起剧烈的超调和不稳定。观察立方体是否能更长时间地维持在平衡点附近。
3. 最后调D（微分）：D项预测未来的误差趋势，起到阻尼作用，抑制振荡。在P和I调好的基础上，加入D值。你会发现立方体的振荡幅度减小，变得“更沉稳”。但D值对噪声非常敏感，如果MPU6050数据噪声大，高D值反而会引入高频抖动。可以适当对角度数据进行软件滤波。
4. 分轴调试：由于三个轴可能存在微小的机械不对称性（如重量分布、电机性能差异），三个PID控制器的参数可能不需要完全一致。可以分别微调Roll、Pitch轴的参数。

实操心得：蓝牙调参法。在代码中实现一个简单的串口指令解析器。例如，发送p10将P值设为10，发送i0.5将I值设为0.5。这样，你可以在立方体运行的同时，通过手机蓝牙串口APP实时调整参数，并立即观察效果，效率比反复修改代码、编译、上传高出十倍不止。

5.3 校准流程详解

原文提到的校准流程至关重要，它建立了传感器读数与立方体物理平衡姿态之间的映射。

1. 连接蓝牙：给立方体上电，用手机蓝牙串口工具连接HC-05（默认密码常为1234或0000）。
2. 进入校准模式：在串口工具中发送字符c+。此时，Arduino会进入校准等待状态。
3. 采集平衡点数据：小心地将立方体放置在一个平衡位置（例如，让它稳定地立在一条棱上）。保持绝对静止数秒钟。这个过程中，代码会持续读取MPU6050的数据。由于立方体静止，加速度计测得的重力分量在X、Y轴上的投影，就对应了这个特定姿态下的“平衡角度”。实际上，程序是在计算这个姿态下，加速度计输出的零点偏移。
4. 保存数据：发送字符c-。程序会将刚才采集到的传感器平均值（即该平衡点的“零偏”）写入Arduino的EEPROM中。EEPROM是一种断电不丢失的存储器，这样校准数据就不需要每次上电都重新设置。
5. 重复：对立方体其他的平衡棱和平衡角重复步骤2-4。理论上，一个立方体有12条棱和8个角可以平衡，但通常只需校准几个主要的即可。

这个校准过程，实质上是告诉系统：“当传感器读数为这些值时，我认为立方体是平衡的。” 系统在运行时，会将当前读数与这些校准值进行比较，计算出实际的倾斜角度。

6. 系统调试与性能优化

6.1 上电调试与问题排查

组装焊接完毕，上传代码后，第一次上电要格外小心。建议按以下顺序进行：

1. 静态测试：先不装电池，通过USB供电。打开串口监视器，检查MPU6050数据是否正常输出，角度值是否随立方体转动而变化。发送测试命令，看电机是否有轻微震动（PWM输出）。
2. 低功率动态测试：装上电池，但用手轻轻扶着立方体，让它尝试平衡。观察电机反应方向是否正确。如果方向反了，立方体会加速倒下。这时需要检查：一是电机接线是否反了；二是PID输出到电机驱动的逻辑（是正输出加速还是减速）；三是MPU6050的坐标系定义是否与代码中的期望一致。通常可以通过在代码中乘以一个负号来反转控制方向。
3. 安全释放：在确认反应方向正确后，尝试松手。准备好随时接住它。最初的参数很可能不理想，立方体可能会剧烈振荡后倒下。

6.2 常见问题与解决方案速查表

6.3 进阶优化思路

当你的立方体能够稳定平衡后，还可以尝试以下优化，提升其性能或增加趣味性：

• 姿态估计算法升级：将简单的互补滤波升级为卡尔曼滤波。卡尔曼滤波能更优地融合传感器数据，并提供对噪声和误差的更好估计。虽然有更复杂的数学，但Arduino社区已有针对MPU6050的卡尔曼滤波库可供使用。
• 控制算法改进：尝试串级PID。外环是角度环，内环是角速度环。内环使用陀螺仪测量的角速度作为反馈，可以更快地响应扰动，理论上能获得更好的动态性能。
• 增加交互功能：利用蓝牙，开发一个手机APP，不仅可以调参，还能通过手机的重力感应或触摸屏来控制立方体缓慢地“行走”或旋转。
• 更换主控：如原文所说，迁移到ESP32。利用其更强的处理能力和内置蓝牙/Wi-Fi，可以实现更复杂的滤波算法、Web配参界面甚至OTA无线更新。
• 减重与优化：使用轻量化的螺丝、更细的导线，对3D打印模型进行拓扑优化，在保证强度的前提下挖空非承重部分，减轻整体重量。重量越轻，电机需要产生的平衡力矩就越小，响应可以更快。

这个项目从一堆零件到一个能自主平衡的智能立方体，整个过程充满了挑战与乐趣。它像是一个微缩的工程世界，涵盖了从概念到落地的全流程。最让我着迷的时刻，不是它完美立住的时候，而是调试时，通过一个小小的参数改变，亲眼看到它的行为从“颓然倒下”到“挣扎晃动”再到“稳稳站立”的转变。那一刻，你能真切地感受到那些抽象的数学公式和控制理论，化为了实实在在的物理力量。希望你在复现和改造这个项目的过程中，也能体验到这种创造的快乐。