ESP32绘图机械臂DIY：从运动学算法到嵌入式开发实践

1. 项目概述：从“画个圆”到“画出世界”

几年前，我在一个创客展上看到一个用舵机驱动的机械臂，颤颤巍巍地在白纸上画出一个歪歪扭扭的圆形，周围却围满了惊叹的人群。那一刻我意识到，将数字世界的精确指令转化为物理世界的优雅轨迹，这种“造物”的乐趣，远比单纯在屏幕上渲染一个图形要迷人得多。这也是我动手打造这个ESP32绘图机械臂项目的初衷：它不仅仅是一个玩具或实验，而是一个融合了嵌入式开发、运动控制、几何算法和硬件集成的微型工程实践。通过它，你可以让一段代码真正地“留下痕迹”。

这个项目的核心，是让一个由舵机驱动的多关节机械臂，能够根据我们发送的指令（比如一个G代码文件、一张位图，或者一段手绘轨迹），在平面上精确地绘制出图形。ESP32作为主控大脑，负责协调所有关节的运动、与上位机通信、并执行路径规划算法。听起来复杂，但拆解开来，无非是“大脑”（ESP32）、“肌肉”（舵机）和“骨架”（机械结构）的协同工作。无论你是想学习机器人运动学基础，还是想做一个独特的桌面艺术品生成器，亦或是为孩子的科技启蒙找一个硬核项目，这个DIY绘图臂都能提供一个绝佳的切入点。它不要求你事先是机电专家，但完成之后，你一定会对如何让机器“听话”地运动有更深的理解。

2. 核心设计思路：在精度、成本与复杂度间寻找平衡

设计一个绘图机械臂，首要任务是确定方案架构。市面上有基于步进电机的CoreXY结构或三角洲结构，精度高、速度快，但成本和控制复杂度也相应提升。对于入门和创意实现而言，舵机驱动的关节式机械臂是一个更友好、更具教学意义的选择。它的运动模型更直观，更接近人的手臂，虽然绝对精度和速度有上限，但在A4纸幅面内完成素描、绘画、签名等任务绰绰有余。

我的设计思路围绕几个关键权衡展开：

2.1 机械结构选型：二连杆 vs 三连杆

最常见的关节臂是二连杆（两个旋转关节）结构，它结构简单，正逆运动学计算方便。但它的工作空间是一个环形区域，靠近底座中心的位置会有盲区，且笔尖姿态固定（始终垂直向下）。三连杆结构（三个旋转关节）则灵活得多，相当于增加了“手腕”，可以让笔尖在一定范围内改变姿态，从而绘制更复杂的线条或实现“提笔”、“压笔”效果，但逆运动学求解会变得复杂。

考虑到首次实现和控制的简便性，我选择了二连杆结构作为基础。它的运动完全在一个平面内，我们只需要控制两个舵机的角度，就能唯一确定笔尖在平面上的位置。这是一个完美的、将二维坐标（X, Y）映射到两个舵机角度（θ1, θ2）的数学问题。

2.2 主控选择：为什么是ESP32？

Arduino UNO是创客入门经典，但引脚和计算能力有限。STM32功能强大，但开发环境对新手稍显复杂。ESP32几乎是这个项目的“天选之子”：

• 双核与计算能力：路径规划、逆运动学解算、通信处理等任务可以分配到不同核心，保证运动流畅不卡顿。
• 丰富的通信接口：内置Wi-Fi和蓝牙，这意味着我们可以摆脱USB线的束缚，通过网页、手机App甚至语音来控制机械臂画画，可玩性大大增加。
• 足够的GPIO与PWM：驱动多个舵机需要独立的PWM通道，ESP32的LEDC PWM控制器可以轻松生成多达16路独立的PWM信号，精度也足够。
• 社区与生态：庞大的社区意味着遇到任何问题，几乎都能找到解决方案或参考库。

2.3 驱动与供电：稳定大于一切

舵机，尤其是MG996R这类金属齿舵机，在运动瞬间的电流冲击可能高达2A。如果多个舵机同时动作，对电源的要求很高。一个常见的坑是使用劣质USB线或手机充电器供电，导致电压骤降，ESP32重启或舵机抖动无力。

注意：务必为舵机准备独立的、足功率的电源（如5V/3A以上的开关电源），并与ESP32的供电（可通过USB或另一路5V）在“地”上共接。最好在电源输入端并联一个大电容（如1000μF 16V）来缓冲电流冲击。

2.4 软件架构分层整个系统的软件我将其分为四层：

1. 通信层：负责通过Wi-Fi（WebSocket/HTTP）、蓝牙或串口接收绘图指令（原始坐标、G代码或图像）。
2. 解释与规划层：将接收到的指令转换为一系列连续的笔尖目标点坐标，并进行插补和速度规划，生成平滑的运动轨迹。
3. 运动控制层：核心层。通过逆运动学，将笔尖坐标转换为每个舵机的目标角度，然后通过PID或更简单的比例控制算法，生成PWM信号驱动舵机。
4. 硬件抽象层：封装对舵机、提笔舵机（如果有）、限位开关等硬件的操作。

3. 机械结构与硬件搭建详解

“工欲善其事，必先利其器”。再精妙的算法，也需要一个稳固的机械平台来执行。

3.1 材料清单与选型建议

• 主控板：ESP32开发板（如NodeMCU-32S或WROOM模组）。
• 舵机：至少2个（用于臂关节），推荐MG996R（扭矩约10kg·cm）或DS3218（扭矩更大）。如果实现提笔功能，需增加1个微型舵机（如SG90）。
• 机械结构：
  • 方案A（推荐）：购买现成的铝制或亚克力激光切割套件。优点是精度有保证，组装快捷。关键词可搜“绘图机械臂套件”、“激光切割机械臂”。
  • 方案B（硬核DIY）：自己设计并用3D打印或手工加工。臂长是关键参数，建议大臂和小臂长度在10-15cm之间。长度越长，工作范围越大，但对舵机扭矩要求越高，末端抖动也可能更明显。
• 电源：5V/3A以上开关电源（给舵机），Micro USB线（给ESP32供电）。
• 其他：PCA9685舵机驱动板（可选，可扩展更多舵机并减轻ESP32负担），杜邦线，螺丝包，笔夹（可用夹子或3D打印）。
• 工具：螺丝刀，热熔胶枪，万用表。

3.2 机械组装核心要点组装不是简单的拧螺丝，几个细节决定了最终绘图的稳定性：

1. 重心与底座：底座必须足够重且稳固。可以在底座下方粘贴配重块（如金属块）。整个臂在伸展时，重心变化很大，稳固的底座是精度的第一道保障。
2. 舵机安装与固定：舵机输出轴和臂之间必须紧固，任何松动都会在末端被放大成厘米级的误差。使用合适的舵盘和螺丝，必要时点一滴螺丝胶（不可拆卸的那种慎用）。
3. 减少背隙：齿轮传动的舵机存在齿隙，这是误差的主要来源。在软件上可以通过“单向逼近”策略缓解：永远从同一个方向运动到目标点，避免在目标点附近来回微调。
4. 笔夹设计：笔夹应能牢固夹持不同粗细的笔，并且笔的安装点应尽量与最后一个舵机的旋转中心重合，或在设计时就被考虑进运动学模型中，否则需要进行工具坐标系偏移补偿。

3.3 电路连接示意图一个基础的连接方式如下（假设使用两个关节舵机SG90和一个提笔舵机）：

ESP32 GPIO引脚 -> 舵机信号线（橙/黄） ESP32 Vin/GND -> 舵机电源正负（红/棕）**（注意：大功率舵机请接外部电源！）** 外部5V电源正极 -> 所有舵机VCC（红） 外部5V电源负极 -> 所有舵机GND（棕）及ESP32 GND（共地）

重要提示：切勿将所有舵机的VCC都接到ESP32的5V引脚上！ESP32板载的5V输出能力非常有限，这样接很可能烧毁USB芯片或导致板子重启。务必使用外部电源为舵机供电。

如果舵机数量多于3个，强烈建议使用PCA9685这类I2C舵机驱动板。它由外部供电，通过I2C与ESP32通信，可以同时驱动16个舵机，并且提供更稳定的PWM信号。

4. 核心算法：运动学与路径规划

这是项目的“灵魂”所在。让笔尖从点A移动到点B，中间涉及一系列坐标变换。

4.1 正运动学：从舵机角度到笔尖位置正运动学是已知的：已知两个舵机的角度（θ1, θ2），求笔尖位置（X, Y）。这利用简单的三角函数即可解决。 设大臂长度为L1，小臂长度为L2。

X = L1 * cos(θ1) + L2 * cos(θ1 + θ2) Y = L1 * sin(θ1) + L2 * sin(θ1 + θ2)

这里角度θ1和θ2需要根据你的机械零位来定义。通常，当臂完全伸直指向右侧时，定义θ1=0°， θ2=0°。

4.2 逆运动学：从笔尖位置到舵机角度逆运动学是控制的关键：给定一个目标点（X, Y），我们需要解算出需要转动到的角度（θ1, θ2）。对于二连杆平面臂，存在解析解： 首先计算笔尖到原点（肩关节）的距离d = sqrt(X*X + Y*Y)。 检查是否可达：如果d > (L1 + L2)或d < |L1 - L2|，则该点不可达，需要做容错处理。 然后计算：

cos_theta2 = (d*d - L1*L1 - L2*L2) / (2 * L1 * L2); // 由于机械结构限制，θ2通常取负值（肘关节向上弯），所以： theta2 = -acos(cos_theta2); // 结果单位为弧度 // 接着计算θ1 k1 = L1 + L2 * cos(theta2); k2 = L2 * sin(theta2); theta1 = atan2(Y, X) - atan2(k2, k1);

最后将theta1和theta2从弧度转换为舵机对应的脉宽值（例如，0.5ms对应0°，2.5ms对应180°）。

实操心得：atan2(y, x)函数比atan(y/x)更好用，它能正确处理所有象限的角度。计算出的角度可能需要根据你舵机的实际安装方向进行偏移补偿（比如加/减90度），这需要通过实际测量来校准。

4.3 轨迹插补：让运动变得平滑我们不可能让笔尖从一个点“跳”到另一个点。轨迹插补就是在两点之间生成一系列中间点。最常用的是直线插补和圆弧插补。

• 直线插补：给定起点（Xs, Ys）和终点（Xe, Ye），按照固定的步长或时间间隔，线性地计算中间点坐标。

  for t from 0 to 1.0 step delta_t: X = Xs + (Xe - Xs) * t Y = Ys + (Ye - Ys) * t // 对每个(X, Y)调用逆运动学，得到舵机角度，并驱动

  delta_t决定了插补的精细度和运动速度。值越小，路径越平滑，但计算量越大。
• 速度规划：更高级的做法是进行S型速度规划（梯形或S曲线），让舵机在启动和停止时缓慢加速/减速，中间匀速运动。这能显著减少机械冲击和绘图抖动。可以在关节空间（直接规划舵机角度变化速度）或笛卡尔空间（规划笔尖速度）进行。

4.4 从图像到坐标：栅格化处理如何画一幅位图？核心步骤是图像栅格化：

1. 预处理：将彩色图像转为灰度图，再通过阈值处理转为二值图（黑白）。
2. 定义工作区域：将图像的宽度和高度映射到机械臂可达的物理绘图区域（例如 150mm x 150mm）。
3. 扫描路径生成：有两种主流方式：
   • 逐行扫描：像喷墨打印机一样，从左到右画线，步进一行，再从右到左画线。效率高，但笔划方向单一。
   • 轮廓跟踪：提取图像的边缘轮廓，然后让机械臂沿着轮廓线画。这更适合画简笔画、logo等。可以使用像OpenCV这样的库（在PC端处理）来提取轮廓，生成一系列点坐标，再发送给ESP32。
4. 提笔/落笔：在移动到新的笔画起点前，先提笔；到达起点后，落笔；画完该笔画后，再提笔。这需要一个额外的舵机来控制笔的升降。

5. ESP32固件开发与核心代码解析

让我们深入到代码层面，看看如何将上述理论落地。这里以PlatformIO + Arduino框架为例。

5.1 项目结构与依赖库

esp32_drawing_arm/ ├── include/ │ ├── kinematics.h // 正逆运动学计算 │ ├── interpolator.h // 插补算法 │ └── config.h // 机械参数、引脚定义 ├── src/ │ ├── main.cpp │ ├── kinematics.cpp │ ├── interpolator.cpp │ ├── server.cpp // WiFi网络服务器 │ └── gcode_parser.cpp // 可选：G代码解析 ├── data/ │ └── index.html // 网页控制界面 └── platformio.ini

关键库依赖：ESPAsyncWebServer(用于WiFi控制)、AsyncTCP、ArduinoJson(处理JSON指令)。

5.2 核心类与函数实现

kinematics.cpp逆运动学核心函数：

#include "kinematics.h" #include <math.h> bool inverseKinematics(float x, float y, float& theta1, float& theta2) { const float L1 = 120.0; // 大臂长度，单位mm const float L2 = 100.0; // 小臂长度，单位mm float d = sqrt(x*x + y*y); // 可达性检查 if (d > (L1 + L2) || d < fabs(L1 - L2)) { return false; // 点不可达 } float cosTheta2 = (d*d - L1*L1 - L2*L2) / (2.0 * L1 * L2); // 防止浮点数误差导致acos域错误 cosTheta2 = constrain(cosTheta2, -1.0, 1.0); theta2 = -acos(cosTheta2); // 取负值，对应肘部向上弯曲的构型 float k1 = L1 + L2 * cos(theta2); float k2 = L2 * sin(theta2); theta1 = atan2(y, x) - atan2(k2, k1); // 转换为角度制，方便调试 theta1 = degrees(theta1); theta2 = degrees(theta2); return true; }

interpolator.cpp直线插补示例：

void lineInterpolate(Point start, Point end, float feedRate, std::vector<Point>& path) { path.clear(); float distance = sqrt(pow(end.x-start.x, 2) + pow(end.y-start.y, 2)); if (distance < 0.001) return; // 起点终点重合 float stepTime = 0.02; // 插补周期，20ms int steps = ceil(distance / (feedRate * stepTime / 60.0)); // 计算总步数 steps = max(steps, 1); // 至少一步 for (int i = 0; i <= steps; ++i) { float t = (float)i / steps; Point p; p.x = start.x + (end.x - start.x) * t; p.y = start.y + (end.y - start.y) * t; path.push_back(p); } }

5.3 主循环与控制逻辑 (main.cpp关键部分)

#include <Arduino.h> #include "kinematics.h" #include "interpolator.h" #include "server.h" Servo servoShoulder; // 肩部舵机 Servo servoElbow; // 肘部舵机 Servo servoLift; // 提笔舵机 float currentX = 0, currentY = 0; // 当前笔尖坐标 bool isDrawing = false; void setup() { Serial.begin(115200); servoShoulder.attach(SHOULDER_PIN); servoElbow.attach(ELBOW_PIN); servoLift.attach(LIFT_PIN); liftPen(); // 初始化提笔 initWiFi(); // 连接WiFi initWebServer(); // 启动Web服务器，提供上传图片、发送指令的接口 // 机械臂回零位（安全位置） goToPoint(0, 150); // 移动到工作区右上角附近作为初始位 } void loop() { // 1. 检查是否有新的绘图指令队列 if (!drawingQueue.isEmpty()) { DrawingCommand cmd = drawingQueue.pop(); executeDrawingCommand(cmd); // 执行单条指令（如移动到某点、画线、提笔等） } // 2. 网络服务器处理客户端请求（异步，在回调函数中处理） // 3. 可以添加其他任务，如通过蓝牙接收指令 } void executeDrawingCommand(const DrawingCommand& cmd) { switch (cmd.type) { case CMD_MOVE: moveToPoint(cmd.x, cmd.y, cmd.feedRate, false); // 空移 break; case CMD_LINE: moveToPoint(cmd.x, cmd.y, cmd.feedRate, true); // 画线 break; case CMD_PEN_UP: liftPen(); break; case CMD_PEN_DOWN: lowerPen(); break; } } void moveToPoint(float targetX, float targetY, float feedRate, bool draw) { if (!draw) liftPen(); // 如果是移动，先提笔 std::vector<Point> path; lineInterpolate({currentX, currentY}, {targetX, targetY}, feedRate, path); for (const auto& p : path) { float theta1, theta2; if (inverseKinematics(p.x, p.y, theta1, theta2)) { servoShoulder.write(theta1 + SHOULDER_OFFSET); // 加上校准偏移 servoElbow.write(theta2 + ELBOW_OFFSET); delay(INTERPOLATION_DELAY); // 等待舵机运动到指定位置 } } if (draw) { delay(50); // 画线结束时稍作停顿，使线条更清晰 } else { lowerPen(); // 如果是移动，到达后落笔（为后续画线准备） } currentX = targetX; currentY = targetY; }

5.4 WiFi网络服务器与前端交互利用ESPAsyncWebServer库，我们可以轻松创建一个Web界面。

// server.cpp 片段 #include <ESPAsyncWebServer.h> #include <SPIFFS.h> AsyncWebServer server(80); void initWebServer() { if(!SPIFFS.begin(true)){ Serial.println("SPIFFS Mount Failed"); return; } // 提供前端页面 server.on("/", HTTP_GET, [](AsyncWebServerRequest *request){ request->send(SPIFFS, "/index.html", "text/html"); }); // 接收来自前端的坐标指令 server.on("/draw", HTTP_POST, [](AsyncWebServerRequest *request){ if(request->hasParam("x", true) && request->hasParam("y", true)){ String xStr = request->getParam("x", true)->value(); String yStr = request->getParam("y", true)->value(); float x = xStr.toFloat(); float y = yStr.toFloat(); // 将指令加入队列 drawingQueue.push({CMD_LINE, x, y, 500.0}); // 500 mm/min 速度 request->send(200, "text/plain", "OK"); } }); // 接收上传的图片文件 server.on("/upload", HTTP_POST, [](AsyncWebServerRequest *request){ request->send(200); }, handleImageUpload); // handleImageUpload函数负责处理图片，将其转换为路径 server.begin(); }

前端index.html可以包含一个Canvas画布，让用户手绘，然后将笔划坐标通过Ajax发送到/draw接口；也可以包含一个文件上传控件，将图片上传到/upload接口。

6. 校准、调试与性能优化实战

硬件组装和代码烧录只是第一步，让机械臂精确作画，校准和调试至关重要。

6.1 机械臂“归零”与参数校准

1. 确定机械零点：给舵机上电，但不发送任何角度信号（或发送90度）。手动将大臂和小臂摆放到你定义的“零位”（例如完全伸直水平向右）。记录下此时两个舵机输出轴的角度位置。
2. 测量真实臂长：用卡尺精确测量从肩关节轴心到肘关节轴心的距离（L1），以及从肘关节轴心到笔尖的距离（L2）。这个值要精确到毫米，并输入到config.h中。
3. 软件偏移校准：
   • 在代码中，命令机械臂移动到几个已知的、容易测量的物理位置（例如(150, 0),(0, 150)）。
   • 用尺子测量笔尖实际到达的位置。
   • 计算实际位置与理论位置的偏差，这个偏差主要是由于舵机零位不准和安装误差造成的。我们可以通过修改SHOULDER_OFFSET和ELBOW_OFFSET这两个全局偏移量来补偿。这是一个迭代过程，可能需要多次调整。

6.2 运动平滑性调试

• 现象：画圆时出现棱角或抖动。
• 排查：
  1. 插补步长：检查lineInterpolate函数中的steps或delta_t。步长太大（steps太少）会导致点与点之间距离过远，舵机运动像“跳步”。适当增加插补点数。
  2. 舵机响应速度：舵机从A角度转到B角度需要时间。如果我们的插补点发送速度太快，舵机来不及反应，就会产生拥堵，运动不平滑。在moveToPoint函数的循环中，delay(INTERPOLATION_DELAY)这个值很关键。通常MG996R这类舵机，从一个极限位置转到另一个需要0.2秒左右。对于小角度移动，可以设置INTERPOLATION_DELAY为20-50ms，给舵机足够的运动时间。
  3. 电源干扰：用示波器或万用表监测舵机电源电压。在多个舵机同时启动时，如果电压被拉低，会导致ESP32重启或舵机失能。确保电源功率充足，线路阻抗小。

6.3 精度提升技巧

• 温度补偿：舵机的性能会随温度变化。长时间运行后，可能发现原点漂移。对于高精度要求，可以每隔一段时间（如画完一幅图）让机械臂回到一个固定的物理校准点，重新校正软件偏移。
• 使用反馈舵机：普通舵机是开环控制，我们不知道它是否真的转到了指定位置。可以升级为带有电位器或编码器反馈的“智能舵机”或使用步进电机+编码器闭环系统，通过PID控制实时纠正位置误差，精度会大幅提升，但成本和复杂度也更高。
• 软件滤波：对逆运动学计算出的目标角度进行低通滤波，可以平滑掉指令中的高频抖动，让运动更柔和。但会引入一定的延迟。

6.4 通信优化

• 指令队列：如示例代码所示，务必使用一个队列（drawingQueue）来缓存接收到的绘图指令。网络或串口接收指令的速度可能快于机械臂执行的速度。队列可以解耦接收和执行过程，防止数据丢失或堵塞。
• 数据压缩：传输大量坐标点时，可以使用相对坐标而非绝对坐标，或者使用更高效的数据格式（如二进制协议），减少传输数据量，提高响应速度。

7. 常见问题排查与解决实录

在项目开发中，我踩过不少坑，这里把典型问题和解决方案整理出来，希望能帮你节省时间。

7.1 问题：机械臂运动时ESP32不断重启

• 可能原因1：电源不足。这是最常见的问题。舵机动作时，特别是两个舵机同时启动或遇到阻力时，电流峰值很大。
  • 解决：使用万用表测量舵机VCC和GND之间的电压，在动作时是否低于4.5V。务必为舵机配备独立的5V/3A以上开关电源，并与ESP32共地。在电源输入端并联一个470-1000μF的电解电容。
• 可能原因2：代码阻塞。如果在loop()中使用了delay()函数，并且舵机控制也在其中，可能导致看门狗定时器（WDT）超时，引发复位。
  • 解决：避免长时间delay()。使用非阻塞的定时方式，如millis()。确保loop()函数每次执行时间不会过长。

7.2 问题：画出的图形严重变形或缩小

• 可能原因1：运动学参数错误。臂长（L1, L2）输入错误，或者正/逆运动学公式有误。
  • 解决：仔细检查代码中的长度值（单位是mm吗？）。用正运动学函数验证：给定一组角度，计算出的坐标是否与手动测量值吻合。
• 可能原因2：舵机脉宽范围不对。你的舵机可能是270度的，但代码里按180度标准（500-2500μs）控制。
  • 解决：查阅舵机规格书，使用servo.attach(pin, minMicroseconds, maxMicroseconds)来设置正确的脉宽范围。
• 可能原因3：未考虑笔夹偏移。如果笔尖安装点不在小臂的末端关节轴心上，你需要进行工具坐标系补偿。假设笔尖在轴心正下方tool_z毫米处，那么在计算逆运动学时，目标点(x, y)实际上对应关节末端的点(x, y + tool_z)。你需要先做这个补偿，再进行逆运动学计算。

7.3 问题：画直线时出现波浪线或锯齿

• 可能原因1：机械背隙。齿轮间隙导致运动不精确。
  • 解决：软件上采用“单向逼近”策略。对于目标点，总是让舵机从同一个方向（例如，从小到大）旋转到位，避免在目标点附近来回震荡。也可以在机械上尝试预紧齿轮（如果结构允许）。
• 可能原因2：插补周期与舵机速度不匹配。发送角度指令的速度快于舵机能物理响应的速度。
  • 解决：增加INTERPOLATION_DELAY的值，让舵机有更多时间到达指定位置。可以尝试从50ms开始调整。
• 可能原因3：工作平面不水平。底座不平或纸张不平，导致笔尖受力不均。
  • 解决：使用水平仪调整底座，并用胶带或夹子将画纸牢牢固定。

7.4 问题：WiFi控制时响应慢或断连

• 可能原因1：网络干扰或信号弱。
  • 解决：让ESP32尽量靠近路由器。在代码中增加WiFi重连逻辑。如果可能，使用静态IP减少连接时间。
• 可能原因2：网页前端频繁发送大量微小指令。
  • 解决：在前端进行路径优化和点数简化（如道格拉斯-普克算法），将一系列密集的点合并为更少的特征点再发送。或者，改为上传整个路径数据后，由ESP32一次性解析并排队执行。

7.5 问题：提笔/落笔不准确

• 可能原因：提笔舵机行程或安装位置不合适。
  • 解决：精确调整提笔舵机的安装位置，使得“提笔”状态时，笔尖能完全离开纸面约2-3mm；“落笔”状态时，笔尖能以适当压力接触纸面。压力可以通过弹簧或橡皮筋来调节，避免用力过猛戳破纸。在代码中，通过servoLift.write(upAngle)和servoLift.write(downAngle)来精确控制，这两个角度值需要实际测试确定。

这个项目就像一座连接数字与物理世界的桥梁，每一个环节的调试成功，都会带来巨大的成就感。从最初颤颤巍巍的线条，到后来能画出复杂的曼陀罗图案，整个过程充满了探索和学习的乐趣。我个人最大的体会是，在嵌入式项目中，软件和硬件的调试必须紧密结合，有时软件的一个微小参数调整，需要硬件状态的精确测量来验证。不要害怕反复迭代，每一次失败都让你对系统行为的理解加深一层。最后一个小建议：给你的绘图臂拍个延时摄影，记录下它从无到有“创造”一幅画的过程，这会是项目最好的纪念品。