企业官网建设流程全解析

1. 项目概述：一个会“思考”的平衡球

如果你对机器人、无人机或者平衡车背后的“不倒”原理感到好奇，但又觉得那些复杂的数学和控制理论让人望而却步，那么这个项目可能就是为你准备的。今天，我们来动手制作一个基于Arduino和MPU-6050传感器的自平衡球体机器人。它不像平衡车那样有两个轮子，也不像无人机有四个旋翼，它的目标更纯粹：在一个光滑的球壳内部，通过一个可移动的配重块，让整个球体在平面上保持直立，甚至抵抗轻微的推力。这听起来有点像科幻电影里的场景，但实现它的核心原理，正是现代机器人技术中无处不在的“传感器-控制器-执行器”闭环反馈系统。

简单来说，这个自平衡球就是一个微缩版的动态稳定系统。它的“大脑”是Arduino Uno开发板，“前庭器官”（负责感知平衡）是MPU-6050惯性测量单元（IMU），而“肌肉”则是两个大扭矩的伺服电机。当球体因外力开始倾斜时，MPU-6050会立刻感知到角度变化，Arduino根据这个变化计算出需要如何移动内部的配重块（由伺服电机驱动）来产生一个反向力矩，从而将球体“推”回直立状态。整个过程在毫秒级别内循环发生，形成动态平衡。这个项目不仅是一个酷炫的桌面玩具，更是一个绝佳的实践平台，能让你亲手触摸到传感器融合、实时控制、机械结构设计等多个工程领域的核心概念。无论你是电子爱好者、机器人专业的学生，还是想找个硬核周末项目的创客，只要你有基本的焊接和3D打印条件，都能跟着这篇指南，一步步把它做出来。

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

在开始拧螺丝和写代码之前，我们必须先搞清楚这个球到底是怎么“想”和“动”的。这能帮助你在后续调试时，明白每一个参数调整的意义，而不是盲目地试错。

2.1 自平衡的物理与控制逻辑

想象一下，你试图用手指竖直立起一支铅笔。铅笔开始向一侧倾倒，你必须快速地向相反方向移动手指来支撑它。这个自平衡球的工作原理与此类似，只不过它的“手指”是球壳内部的一个可移动质量块。

核心物理模型：整个系统可以简化为一个倒立摆模型。球壳是摆的支点（可自由滚动），内部的配重机构是摆锤。当球体直立时，配重位于球心正下方，系统势能最低，最稳定。一旦球体倾斜，重力会产生一个使倾斜加剧的力矩。此时，我们需要驱动配重块向倾斜的相反方向移动，利用配重块自身的重力产生一个反向的恢复力矩，来抵消倾斜力矩，从而使球体回归平衡位置。

控制闭环流程：

1. 感知：MPU-6050以极高的频率（通常几百赫兹）测量球体在X轴和Y轴上的倾斜角（俯仰和横滚）。
2. 决策：Arduino读取这些角度数据。在初始平衡位置，我们设定目标角度为0度。当前角度与目标角度（0度）的差值，就是“误差”。
3. 计算：控制器（这里我们先用最简单的比例控制）根据这个误差的大小，计算出一个“纠正量”。误差越大，需要的纠正动作就越大。这个纠正量被映射为伺服电机需要转动的角度。
4. 执行：Arduino将计算出的角度指令发送给对应的伺服电机。电机转动，通过齿轮机构带动内部的配重块移动，产生恢复力矩。
5. 反馈：配重块的移动改变了球体的姿态，MPU-6050立刻感知到这一新姿态，产生新的角度数据，循环回到第1步。

这个“感知-决策-执行-再感知”的循环，必须在极短的时间内完成（通常要求小于20毫秒），否则系统反应迟钝，就会像你反应太慢而接不住倒下的铅笔一样，球体最终会倒下。

2.2 关键组件选型与考量

为什么是这些部件？每个选择背后都有其工程上的考量。

1. 控制器：Arduino Uno

• 为什么选它：对于这个项目，Arduino Uno是性能和复杂度之间的完美平衡点。它拥有足够的数字I/O引脚来控制两个伺服和连接I2C传感器，16MHz的主频足以处理互补滤波算法和伺服控制。其庞大的社区和丰富的库资源（如Wire,Servo,MPU6050）能极大降低开发门槛。更复杂的控制器（如STM32）虽然性能更强，但会引入不必要的开发复杂度。
• 备选方案：如果追求更小的体积，可以考虑Arduino Nano或Pro Mini，但需要注意其引脚布局和供电能力。

2. 姿态传感器：MPU-6050

• 为什么是它：MPU-6050集成了三轴陀螺仪和三轴加速度计，是消费级IMU的标杆。陀螺仪测量角速度，积分后可得角度，但存在漂移误差；加速度计通过测量重力加速度分量来解算角度，在静态或低速时很准，但对振动敏感。单一传感器都不完美，而MPU-6050让我们能同时获取这两类数据，为后续的传感器融合算法提供了基础。
• 关键参数：我们主要关心其I2C通信速率（默认400kHz足够）、陀螺仪量程（±250°/s或±500°/s较合适）和加速度计量程（±2g或±4g）。量程越小，分辨率越高，但对剧烈运动的容忍度越低。

3. 执行器：20kg数字伺服电机

• 为什么需要这么大扭矩：这不是驱动遥控车转向的小舵机。它需要快速、有力地移动一个有一定质量的配重块（通常包含电机自身、齿轮、电池等），以产生足够大的恢复力矩来对抗球体倾斜。扭矩不足会导致响应迟缓，平衡失败。“数字”伺服意味着其内部有微处理器，能更精确地控制位置，脉冲解析度更高，响应更快，这对需要快速、精准定位的自平衡系统至关重要。
• 选型注意：务必确认是“标准舵机”（转动范围约180度）而非连续旋转舵机。同时检查其工作电压（通常4.8V-6.8V）和电流需求，确保电源能带动两个同时工作。

4. 机械结构：3D打印

• 材料选择-PLA：PLA（聚乳酸）是最常见、最容易打印的材料，强度对于这个项目绰绰有余。其较低的收缩率和良好的尺寸稳定性，能保证打印出的齿轮和结构件精度足够，减少装配摩擦和间隙，这对控制精度影响很大。
• 设计要点：模型设计必须考虑重心位置。整个内部机构（控制器、电池、电机、配重）的重心应尽可能低，且位于球心下方，这能提供天然的稳定性。齿轮传动需要设计适当的减速比，将伺服电机的高速、小扭矩输出，转换为配重块所需的低速、大扭矩移动。同时，所有运动部件必须留有微小间隙，防止卡死，但间隙又不能太大，否则会产生“死区”，导致控制响应不线性。

3. 硬件搭建与电路连接详解

理论清晰后，我们开始动手。硬件搭建是项目的地基，务必仔细。

3.1 元器件清单与准备

除了项目正文中列出的核心部件，根据我的经验，你还需要准备以下工具和耗材，会让整个过程顺利很多：

• 焊接工具：电烙铁、焊锡丝、松香/助焊剂。虽然可以用面包板和杜邦线，但为了长期运行的可靠性，强烈建议最终将MPU-6050和伺服电机的电源线进行焊接。
• 万用表：用于检查电源电压、线路通断，是排查问题的利器。
• 螺丝刀套装：尤其是适合M3螺丝的小型十字螺丝刀。
• 剥线钳与压线钳：如果你需要自制或修理连接线。
• 扎带或热熔胶枪：用于内部走线固定，防止线缆缠绕运动部件。
• 数字角度尺或手机水平仪App：用于校准传感器初始零位，非常有用。

注意：在采购伺服电机时，务必确认附带“舵盘”（Servo Horn）。项目文中提到的“R-O Servo Horns”可能指一种圆形的舵盘。你需要根据最终齿轮的固定方式（粘合或螺丝）来选择合适的舵盘类型。

3.2 电路连接步骤与原理剖析

按照以下步骤连接，并理解每一步的目的：

第一步：搭建电源系统

1. 将9V电池扣连接到9V电池上。注意极性，通常电池扣的红线为正极，黑线为负极。
2. 将电池扣的DC桶形插头插入Arduino Uno的电源插座。此时，Arduino板上的电源指示灯（ON）应点亮。
   • 原理：9V电池为整个系统供电。Arduino Uno板载稳压芯片，会将9V电压降压为5V和3.3V，供给板载芯片及扩展接口。

第二步：建立面包板供电总线

1. 将面包板放置于Arduino旁。面包板内部金属条是纵向连接的。
2. 用一根跳线，将Arduino的任一GND引脚连接到面包板一侧的“-”标识排孔（负极总线）。
3. 用另一根跳线，将Arduino的5V引脚连接到面包板同一侧的“+”标识排孔（正极总线）。
   • 原理：这相当于在面包板上建立了两个公共的电源轨道，所有需要5V和GND的器件都可以就近接入，避免了从Arduino上引出多根混乱的电源线。

第三步：连接MPU-6050传感器

1. VCC-> 面包板5V总线。
2. GND-> 面包板GND总线。
3. SDA-> Arduino Uno的A4引脚。（关键点）：在Arduino Uno上，A4和A5引脚除了模拟输入功能，还被内部硬件定义为I2C通信的SDA（数据线）和SCL（时钟线）。这是固定搭配，不能更改。
4. SCL-> Arduino Uno的A5引脚。
   • 原理：MPU-6050通过I2C协议与Arduino通信。I2C只需两根线（SDA, SCL）即可连接多个设备，通过地址寻址。我们为它提供5V电源和地，数据交互就通过这两根线完成。

第四步：连接伺服电机

1. 将两个伺服电机的插头线（通常是三根线：红-电源，棕/黑-地，黄/白-信号）准备好。
2. 将两个伺服的红线分别接入面包板的5V总线。
3. 将两个伺服的黑/棕线分别接入面包板的GND总线。
   • 电源考量：两个20kg伺服在运动时，瞬时电流可能很大（单个可达1-2A）。仅靠Arduino板载的5V稳压输出可能不足，会导致Arduino重启或传感器工作异常。更可靠的方案是使用一个独立的5V稳压模块（如LM2596降压模块）为伺服供电，而Arduino和MPU-6050仍由Arduino的5V输出供电，两者共地即可。这是从“能工作”到“稳定工作”的关键一步。
4. 将控制X轴（例如前后倾斜）的伺服信号线（黄/白）连接到Arduino的9号数字引脚。
5. 将控制Y轴（例如左右倾斜）的伺服信号线连接到Arduino的10号数字引脚。
   • 原理：伺服电机通过接收来自Arduino数字引脚的PWM（脉冲宽度调制）信号来控制位置。脉冲的高电平持续时间（通常1-2ms）对应着舵机转动的角度（0-180度）。9和10引脚是Arduino Uno上支持硬件PWM输出的引脚之一，能产生更稳定平滑的控制信号。

连接完成后，你的系统架构应该是：9V电池为Arduino供电，Arduino为MPU-6050供电并提供I2C通信，同时，Arduino（或外接电源）为两个伺服电机供电，并通过PWM信号控制它们。

4. 软件编程：从数据读取到平衡控制

硬件是躯体，软件是灵魂。这部分代码让一堆零件“活”过来。

4.1 开发环境与库配置

首先，确保你已安装Arduino IDE。然后，我们需要安装两个至关重要的库：

1. Wire库：这是Arduino自带的I2C通信库，无需额外安装。
2. MPU6050库与I2Cdev库：为了便捷地读取MPU-6050数据，我们使用社区维护良好的MPU6050库，它通常依赖于I2Cdev库。
   • 打开Arduino IDE，点击“工具” -> “管理库...”。
   • 在搜索框中输入“MPU6050”，找到由Electronic Cats或Jeff Rowberg维护的库进行安装。安装时，通常会自动安装其依赖的I2Cdev库。

4.2 核心代码解析与编写

下面，我将逐块解析代码，并补充原文中未详述的关键逻辑。你可以将这些代码块组合成一个完整的.ino文件。

// 1. 引入必要的库 #include <Wire.h> // I2C通信库 #include <MPU6050.h> // MPU6050传感器库 #include <Servo.h> // 伺服电机控制库 // 2. 创建对象实例 MPU6050 mpu; // 创建一个MPU6050对象，命名为mpu Servo servoX, servoY; // 创建两个Servo对象，分别控制X轴和Y轴 // 3. 定义变量 // 用于存储传感器原始数据 int16_t ax, ay, az; // 加速度计原始值 (X, Y, Z) int16_t gx, gy, gz; // 陀螺仪原始值 (X, Y, Z) // 用于存储计算后的角度（单位：度） float angleX, angleY; // 通过互补滤波融合后的最终角度 float accAngleX, accAngleY; // 仅由加速度计计算出的角度 float gyroAngleX = 0, gyroAngleY = 0; // 由陀螺仪积分得到的角度 // 时间相关变量，用于积分计算 unsigned long prevTime = 0; float dt; // 两次循环的时间差（秒） // 互补滤波系数 (通常取0.96-0.98) const float alpha = 0.96; // 伺服电机引脚定义 const int servoXPin = 9; const int servoYPin = 10; // 伺服电机角度偏移量（用于机械校准） int offsetX = 0, offsetY = 0; void setup() { Serial.begin(115200); // 初始化串口，用于调试输出 Wire.begin(); // 初始化I2C通信 mpu.initialize(); // 初始化MPU6050传感器 // 验证MPU6050连接 if (!mpu.testConnection()) { Serial.println("MPU6050连接失败！请检查接线。"); while (1); // 停止程序 } Serial.println("MPU6050连接成功！"); // 校准MPU6050（关键步骤！） // 将设备静止水平放置数秒，此期间读取陀螺仪零偏 Serial.println("正在进行陀螺仪校准，请保持设备绝对静止..."); delay(1000); long gxOffset = 0, gyOffset = 0, gzOffset = 0; for (int i = 0; i < 1000; i++) { // 采样1000次取平均 mpu.getRotation(&gx, &gy, &gz); gxOffset += gx; gyOffset += gy; gzOffset += gz; delay(1); } mpu.setXGyroOffset(gxOffset / 1000); mpu.setYGyroOffset(gyOffset / 1000); mpu.setZGyroOffset(gzOffset / 1000); Serial.println("校准完成！"); // 初始化伺服电机 servoX.attach(servoXPin); servoY.attach(servoYPin); // 将伺服置于中心位置（90度） servoX.write(90 + offsetX); servoY.write(90 + offsetY); delay(1000); // 给伺服时间运动到初始位置 prevTime = micros(); // 记录初始时间 }

setup()函数详解：

• 连接测试：mpu.testConnection()通过读取MPU-6050的“WHO_AM_I”寄存器来验证物理连接是否正确，这是排查硬件问题的第一步。
• 传感器校准：这是至关重要且原文未强调的一步。陀螺仪存在“零偏”，即静止时输出的角速度不为零。如果不校准，积分误差会迅速累积，导致角度数据漂移到天上去。我们通过让设备静止一段时间，计算这段时间内陀螺仪读数的平均值作为零偏，然后通过setXGyroOffset等函数写入传感器内部寄存器进行补偿。加速度计校准（水平放置求平均值）同样重要，但为了简化，本例先做陀螺仪校准。

void loop() { // 1. 获取传感器原始数据 mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz); // 2. 计算时间间隔dt (单位：秒) unsigned long currentTime = micros(); dt = (currentTime - prevTime) / 1000000.0; // 微秒转秒 prevTime = currentTime; // 3. 从加速度计数据计算倾斜角（单位：度） // 公式：angle = atan2(accY, accZ) * 180 / PI， 具体轴需根据安装方向调整 // 假设MPU6050平放，Z轴向上。则绕X轴旋转（前后俯仰）由Y和Z轴加速度决定 accAngleX = atan2(ay, az) * 180 / PI; // 绕Y轴旋转（左右横滚）由X和Z轴加速度决定 accAngleY = atan2(ax, az) * 180 / PI; // 4. 从陀螺仪数据积分得到角度变化（单位：度） // 陀螺仪读取的是角速度（度/秒），乘以时间dt得到角度增量 // 注意：需要根据MPU6050的量程设置转换系数。假设量程为±500°/s，则系数 = 500 / 32768 float gyroScale = 500.0 / 32768.0; gyroAngleX = gyroAngleX + (gx * gyroScale) * dt; gyroAngleY = gyroAngleY + (gy * gyroScale) * dt; // 5. 应用互补滤波器融合数据 // 公式：融合角度 = α * (上一刻融合角度 + 陀螺仪增量) + (1-α) * 加速度计角度 angleX = alpha * (angleX + (gx * gyroScale) * dt) + (1 - alpha) * accAngleX; angleY = alpha * (angleY + (gy * gyroScale) * dt) + (1 - alpha) * accAngleY; // 6. 将角度映射到伺服电机位置（核心控制逻辑） // 目标：当角度为0（平衡）时，伺服在90度（中心）。 // 当角度为正（例如前倾），伺服应向反方向（后）运动，即小于90度。 int servoXPos = 90 - angleX * 2.0; // 系数“2.0”是比例增益Kp，需要调试 int servoYPos = 90 - angleY * 2.0; // 限制伺服输出范围，防止超出物理限位（通常0-180） servoXPos = constrain(servoXPos, 0, 180); servoYPos = constrain(servoYPos, 0, 180); // 7. 驱动伺服电机 servoX.write(servoXPos); servoY.write(servoYPos); // 8. 串口打印调试信息（调试完毕后可注释掉以提高速度） Serial.print("AngleX: "); Serial.print(angleX); Serial.print(" | AngleY: "); Serial.print(angleY); Serial.print(" | ServoX: "); Serial.print(servoXPos); Serial.print(" | ServoY: "); Serial.println(servoYPos); // 微小延迟，控制循环频率 delay(5); // 约200Hz循环 }

loop()函数核心逻辑剖析：

• 加速度计求角：atan2(y, z)是一个强大的函数，它根据Y和Z轴的加速度分量，计算出设备绕X轴旋转的角度。它考虑了所有象限，结果在-180°到180°之间。这个角度在静态或慢速运动时非常准确。
• 陀螺仪积分：陀螺仪输出的是瞬时角速度。对角速度进行时间积分，就能得到角度变化量。但积分会累积所有微小的误差（零偏），导致角度输出随时间“漂移”。
• 互补滤波：这是本项目的算法核心。它巧妙结合了加速度计和陀螺仪的优点，摒弃了缺点。加速度计在低频（静态）时准，但高频（振动、快速运动）噪声大；陀螺仪在高频时响应好，但低频有漂移。互补滤波器用一个系数alpha（通常接近1，如0.96）进行加权融合。alpha越大，信任陀螺仪的程度越高，系统响应快但可能漂移；alpha越小，信任加速度计的程度越高，长期稳定但响应可能迟钝。angleX = alpha * (旧角度 + 陀螺仪增量) + (1-alpha) * 加速度计角度。这个公式可以理解为：用陀螺仪进行快速的角度预测，再用加速度计的数据对这个预测进行缓慢的修正。
• 比例控制：servoPos = 90 - angle * Kp是最简单的比例控制器。Kp是比例系数。误差（angle）越大，控制输出（servoPos偏离90度的量）越大。这是实现平衡的最基本控制律。后续调试主要就是调这个Kp值，以及可能引入的微分项Kd来抑制振荡。

实操心得：在代码中，我强烈建议将Kp系数（代码中的2.0）定义为一个变量，例如float Kp = 2.0;，这样在后续串口调试时，你可以通过发送指令动态调整它，而无需反复修改代码、上传，能极大提高调试效率。

5. 机械结构组装与调试实录

软件准备就绪后，我们来赋予它物理形态。3D打印和组装是项目中最需要耐心和细心的环节。

5.1 3D打印参数优化与后处理

原文给出了基本的打印参数，但根据我的经验，针对这种带有运动部件的功能件，需要更精细的设置：

• 层高：使用0.2mm层高在打印速度和表面质量间取得平衡。对于齿轮啮合面，如果打印机精度允许，尝试0.16mm层高可以提升传动平滑度。
• 填充密度：结构件（如底盘、外壳）建议15%-20%的填充即可，以节省时间和材料。但齿轮和承受应力的连接件（如伺服支架）填充率应提高到40%-50%，甚至使用100%实心填充，以确保强度。
• 打印速度：外轮廓和顶层/底层速度建议降至40-50mm/s，以提高打印质量。内壁和填充可以稍快（60mm/s）。齿轮的打印速度一定要慢（30-40mm/s），确保齿形精确。
• 支撑：对于有悬空结构的模型（如齿轮的齿、支架的悬臂），必须生成支撑。使用“树状支撑”通常更容易拆除且更节省材料。
• 后处理：打印完成后，务必仔细清除所有支撑料和“拉丝”。对于齿轮的轴孔和轴承座，可以使用合适尺寸的钻头或锉刀进行扩孔和去毛刺，这是保证转动顺滑的关键一步，很多人在这里翻车。

5.2 分步组装流程与技巧

遵循从内到外、从核心运动部件到外围固定的顺序进行组装：

第一阶段：核心传动机构组装

1. 粘合齿轮与舵盘：将“Servo Gear 1”和“Servo_Gear_X2”齿轮分别粘合到两个舵盘上。关键技巧：使用快干胶（如401胶水）而非环氧树脂进行初步定位，因为环氧树脂固化慢，容易在固化前滑动导致偏心。先点少量快干胶固定，确认同心无误后，再用环氧树脂在背面加强。偏心是导致振动和噪音的主要元凶。
2. 安装伺服到支架：将两个伺服电机用M3x10螺丝固定在“Servo Brackets”上。螺丝不要一次性拧死，先带上螺母，确保伺服壳体与支架贴合平整后再逐步对角拧紧。
3. 组装中层框架：将带有伺服电机的支架安装到“Middle Wall Mount”上。此时先不要完全锁紧所有螺丝，留出微调空间。
4. 安装大齿轮：将“Gear 1”用M3x20螺丝固定到“Back Ring Holder”上。同样，确保齿轮与固定面垂直。
5. 组合中层与后环：将上一步的组件通过2颗M3x30螺丝安装到“Middle Wall Mount”上。此时，两个伺服齿轮应该分别与“Gear 1”和“Gear 2”初步啮合。
   • 核心调试点：手动转动伺服齿轮，检查与大齿轮的啮合情况。理想状态是齿轮间有轻微、均匀的阻力，既不能太紧（卡死），也不能太松（有间隙导致回差）。可以通过稍微松开支架的固定螺丝，微调伺服电机的位置来达到最佳啮合状态，然后再拧紧。

第二阶段：集成内部球体

1. 将上述组装好的整个传动机构，通过2颗M3x30螺丝安装到“Inner Moving Sphere”内部。注意对齐孔位。
2. 将“Gear 2”与“Inner Moving Sphere”侧面的两个孔对齐，并用最后1颗M3x20螺丝固定。确保“Gear 2”能自由转动。

第三阶段：布线、封裝与总装

1. 预布线：将两个伺服电机的延长线、MPU-6050的杜邦线，从“Inner Moving Sphere”顶部的矩形开口小心引出。用扎带或胶带将线束固定在内部非运动区域，绝对避免线缆缠绕齿轮或阻碍配重块运动。
2. 连接球壳与底盘：将“Outer Moving Sphere”（完整的球壳）与已经安装了Arduino和面包板的底盘（Chassis）对齐。此时，从球体内部引出的线束应穿过底盘中心的孔洞。
3. 最终固定：通过“Back Ring Holder”和底盘上的对应孔位，用最后2颗M3x30螺丝将整个球体内部机构与底盘紧固在一起。拧紧前，再次手动旋转球壳，确保内部机构不与球壳内壁发生摩擦或碰撞。
4. 内部设备固定：将Arduino和面包板放入底盘的卡槽内。用尼龙扎带或电工胶带将其牢固固定，防止在球体滚动时松动。将9V电池也妥善固定。
5. 电路连接：参照第3章的电路图，将所有线缆连接到Arduino和面包板。建议在连接电源前，最后连接伺服电机信号线，以防误触发。
6. 封盖：用胶带临时固定底盘的盖板，方便后续调试时打开。如果调试无误，可以用螺丝或更牢固的方式永久固定。

6. 系统联调、参数整定与问题排查

组装完成，通电！但很可能它不会立刻完美平衡，而是疯狂振荡或者无力地倒下。别担心，这才是真正的开始。

6.1 上电初调与安全确认

1. 安全第一：首次上电前，用手握住球体，或者将其放在一个柔软的围挡内，防止它因程序错误而突然剧烈运动伤人或损坏自身。
2. 观察现象：上电后，打开Arduino IDE的串口监视器（波特率设为115200）。你应该能看到角度和伺服位置数据在滚动。用手缓慢倾斜球体，观察：
   • 串口数据是否随倾斜变化？如果不变，检查MPU-6050连接和代码。
   • 伺服电机是否向正确的方向运动？例如，向前倾斜球体（X轴角度为正），控制X轴的伺服是否向后运动（试图将配重前移以恢复平衡）？如果方向反了，在代码中修改servoXPos = 90 + angleX * Kp（将减号改为加号）。

6.2 PID参数整定实战

我们的代码目前只用了比例控制（P）。要获得稳定、快速的平衡，通常需要引入微分控制（D）来抑制振荡。

1. 修改代码，引入PD控制：

   // 在变量定义区增加 float lastAngleX = 0, lastAngleY = 0; float Kp = 2.0; // 比例系数，需调试 float Kd = 0.5; // 微分系数，需调试 // 在loop()循环中，计算角度后，替换原来的映射部分 float errorX = angleX; // 目标角度为0，所以误差就是当前角度 float errorY = angleY; // 计算微分项（角度变化率） float derivativeX = (angleX - lastAngleX) / dt; float derivativeY = (angleY - lastAngleY) / dt; // 更新上次角度 lastAngleX = angleX; lastAngleY = angleY; // PD控制输出 int servoXPos = 90 - (Kp * errorX + Kd * derivativeX); int servoYPos = 90 - (Kp * errorY + Kd * derivativeY);

2. 调试步骤（黄金法则：先P后D，从小到大）：

   • 第一步：调P（比例）：将Kd设为0。逐渐增大Kp（例如从1.0开始）。Kp太小，球体反应慢，会缓慢倒下；Kp增大，反应变快，能抵抗更大幅度的倾斜。继续增大Kp，直到球体在平衡点附近开始出现持续、小幅度的来回振荡。此时Kp略大于临界值。
   • 第二步：调D（微分）：保持Kp在略引起振荡的值，开始引入Kd。从一个小值（如0.1）开始增加Kd。微分项的作用是“预见”未来的变化趋势（通过当前变化率），并施加一个反向的阻尼力。随着Kd增加，你会观察到振荡幅度逐渐减小，直至消失，系统变得稳定。注意：Kd过大，会引入高频噪声（因为微分对噪声敏感），可能导致系统抖动或反应迟钝。
   • 第三步：微调：在Kp和Kd之间做细微调整，找到一组能让球体快速响应轻微推力，又能迅速稳定下来的值。这个过程需要耐心，可以借助串口监视器实时观察角度和输出值的变化趋势。

6.3 常见问题排查速查表

调试是一个迭代的过程。不要期望一次成功。记录下每次参数更改后的现象，结合串口数据（角度、输出值）进行分析，你会对闭环控制有更深刻的理解。当你的球体最终能稳稳地立在桌上，甚至轻轻推它一下，它也能晃动着找回平衡时，那种成就感是无与伦比的。这个项目带给你的，远不止一个会动的球，而是一整套关于嵌入式系统、实时控制、机械设计和问题解决的实战经验。