基于Arduino与BNO055陀螺仪的桌面绘图机器人：从传感器融合到G代码解析

1. 项目概述：用陀螺仪“驯服”一台桌面绘图机器人

几年前，当我第一次尝试用两个直流电机和一块Arduino板子做一台简单的绘图小车时，结果令人沮丧——画出来的直线像喝醉了酒，圆圈更是变成了多边形。问题的核心在于转向控制：依赖电机编码器脉冲计数来估算角度，在电机启停、齿轮间隙（回差）和地面摩擦的联合干扰下，误差会迅速累积。直到我遇到了BNO055这款传感器融合模块，它内置的陀螺仪、加速度计和磁力计，通过算法融合输出稳定、绝对的角度信息，才真正解决了这个“转向漂移”的顽疾。

这个项目，就是基于Arduino和BNO055陀螺仪模块，打造一台能够精准执行G代码指令的机器人绘图仪。它本质上是一个两轮差分驱动的移动平台，通过蓝牙接收来自电脑或手机的绘图指令（G代码），利用BNO055提供的精确航向角（Yaw）来控制转向角度，再配合电机编码器来计量行走距离，从而在纸上忠实地还原出数字设计。它的魅力在于，用相对廉价的通用部件（总成本可控制在百元以内），通过精妙的软件校准和补偿算法，实现了接近专业级绘图仪器的绘图精度，并且具备图形缩放功能，能将小图样轻松放大绘制到大尺寸纸张上。

无论你是对机器人控制、嵌入式系统感兴趣的学生，还是喜欢动手制作自动化工具的创客，亦或是想寻找一个综合性实践项目的电子爱好者，这个项目都能带你深入理解传感器融合、电机闭环控制、G代码解析以及系统误差补偿等核心概念。整个过程从硬件焊接、3D打印结构件，到软件调试、参数校准，充满了动手的乐趣和解决问题的成就感。接下来，我将毫无保留地分享整个制作过程中的细节、原理，以及那些只有亲手做过才会知道的“坑”和技巧。

2. 核心硬件选型与电路设计解析

一台稳定的绘图仪，硬件是基石。选型不仅要考虑功能，更要考虑部件之间的匹配性和系统的整体稳定性。

2.1 主控与传感器：大脑与“小脑”

Arduino UNO R3作为主控是经典之选。它拥有足够的I/O口来连接所有外设，社区资源丰富，编程环境友好。对于这个项目，其16MHz的主频和2KB的RAM足以流畅运行我们的控制逻辑和G代码解释器。

核心中的核心是BNO055传感器融合模块。它为何如此关键？普通的MPU6050等陀螺仪模块只提供原始的角速度数据，需要我们在主控芯片上进行复杂的姿态解算（如互补滤波、卡尔曼滤波），这对Arduino UNO的算力是个挑战，且效果不易优化。BNO055内部集成了独立的ARM Cortex-M0微处理器，专门负责运行传感器融合算法，直接通过I2C接口输出稳定、校准后的欧拉角（包括我们最需要的航向角Yaw）、四元数等数据。这相当于为我们的绘图仪配备了一个专司姿态感知的“小脑”，极大减轻了主控负担，并提供了开箱即用的高精度角度参考。

2.2 动力与执行机构：腿与手

驱动部分采用两个6V减速电机，搭配TB6612FNG双路电机驱动模块。选择N20电机是因为其尺寸小巧、扭矩足够，且通常配套有编码器。TB6612FNG相比传统的L298N，效率更高、发热更小，并且支持待机模式，能更好地控制电机。

注意：电机的一致性至关重要。尽量购买同一批次、标明相同转速（如60RPM）的电机。即使如此，由于制造公差，两个电机的空载转速也会有细微差别，这会导致直线行走时发生偏航。我们的软件会通过编码器反馈进行实时速度补偿，但硬件基础越好，软件补偿的压力就越小。

抬笔机构使用常见的SG90舵机。其优点是控制简单（一个PWM信号即可设定角度），扭矩足够抬起一支笔。关键在于如何将舵机的旋转运动转化为笔的垂直升降，并保持稳定的下笔压力，这需要通过一个巧妙的机械结构来实现。

2.3 电源与电路设计：稳定供电是前提

整个系统存在三个电压等级：电机和舵机需要6V，BNO055和蓝牙模块需要3.3V，Arduino自身工作在5V。混乱的供电会导致传感器噪声增大、单片机复位甚至损坏。

我的方案是使用一块6节AA电池盒（9V）作为总输入。电源路径设计如下：

1. 9V输入先经过两个1N4007二极管做反接保护，然后分为两路。
2. 一路直接接入Arduino的VIN引脚，通过其板载稳压芯片得到5V。
3. 另一路接入LM7806线性稳压芯片，得到稳定的6V输出，专门给两个电机和舵机供电。这里在每个电机电源入口附近都并联了47μF的钽电容和0.1μF的瓷片电容，用于滤除电机启停产生的高频噪声和电压毛刺，防止干扰单片机。
4. Arduino的5V输出，经过一个I2C电平转换模块，转换为3.3V给BNO055和HC-05蓝牙模块供电。切记不可将5V直接接到BNO055的VCC，会烧毁芯片。

将所有电路集成在一块Arduino原型扩展板上，直接插在UNO上方，能极大提高系统的可靠性和整洁度。扩展板的布局应遵循“功率路径粗短，信号路径清晰”的原则，电机驱动部分远离模拟传感器区域。

3. 机械结构设计与3D打印部件详解

绘图仪的机械平台不仅要稳固，还要确保笔尖、两个驱动轮以及两个从动滑块的相对位置精确，这是绘图精度的物理基础。

3.1 主体平台与轮系布局

我选用了一块140mm x 95mm的亚克力板作为底盘。布局的核心是“等边三角形”支撑原理：两个驱动轮和笔尖，三点决定一个平面。两个驱动轮轴心之间的连线是基线，笔尖应位于这条基线中垂线上的某一点。经过测试，将笔尖置于两个驱动轮轴心连线中点正前方约30-40mm的位置，机器人在转向时较为稳定。

两个N20电机通过金属支架固定在底盘两侧。轮子我选择了34mm直径的橡胶轮，增大直径可以提高位移分辨率（编码器每转一圈走的距离更长），同时橡胶材质能提供更好的抓地力，减少打滑。电机轴和轮子之间一定要紧固，任何松动都会直接转化为距离误差。

3.2 笔架与抬笔机构设计

这是机械部分最需要巧思的地方。目标是：结构简单、升降行程一致、下笔压力可调且稳定。

1. 笔筒：3D打印一个垂直的圆筒，内径略大于铅笔直径，让铅笔能自由滑动。这个笔筒垂直固定在两个驱动轮之间的前方。
2. 抬笔圆盘：3D打印一个小圆盘，中心开孔套在铅笔上，并可以用螺丝固定其高度。这个圆盘就是舵机摆臂的“作用点”。
3. 舵机支架：设计一个L形支架，一端包围并粘合在笔筒上部，另一端用于固定SG90舵机。舵机的安装位置要使得其摆臂在水平位置时，刚好能托住“抬笔圆盘”。
4. 下笔压力机构：在抬笔圆盘上系一根橡皮筋，另一端挂在舵机支架伸出的一个小钩上。通过调整橡皮筋的拉伸长度或缠绕圈数，可以精确调节笔尖对纸面的压力。压力太轻会画不出线，太重则增加摩擦，影响移动精度。

实操心得：舵机摆臂与抬笔圆盘的接触面最好贴上一点绒布或硅胶垫，减少撞击噪音和磨损。铅笔不要固定死，应能在笔筒中轻微浮动，以自适应略微不平的纸面。

3.3 辅助滑块与电池仓

在底盘前部和后部下方，各安装一个3D打印的“滑翔块”。它的底部是光滑的弧面，作用不是轮子，而是提供两个额外的、摩擦极低的支撑点，与两个驱动轮共同构成一个稳定的四点支撑面，防止平台在移动中前后摇晃。

电池仓同样3D打印，设计成带围栏的托盘，用橡皮筋将9V电池盒束紧在其中，防止其在急停急启时滑动，改变机器人重心。

4. 核心控制理论与软件算法拆解

硬件搭建是骨架，软件算法才是灵魂。这套系统的控制逻辑围绕两个核心：基于陀螺仪的绝对角度闭环转向控制和基于编码器的距离闭环直线控制。

4.1 陀螺仪航向角闭环控制

这是本项目的精髓。BNO055提供了可靠的绝对航向角（0-360°）。当我们需要机器人转动一个角度（例如TURN 90）时，流程如下：

1. 读取BNO055当前的航向角current_yaw。
2. 计算目标航向角target_yaw = current_yaw + 90（处理360°边界）。
3. 同时给两个电机施加大小相等、方向相反的PWM信号，让机器人原地旋转。
4. 在loop()函数中不断读取current_yaw，并计算与target_yaw的误差。
5. 当误差小于一个很小的阈值（如0.5度）时，停止电机。

关键难点：齿轮回差（Backlash）补偿。这是提高转向精度的核心技巧。当电机反向旋转时，齿轮啮合间隙会导致轮子有一个空转区间。表现在行为上就是：发出停止命令后，由于惯性，机器人会冲过目标角度约0.5度；当再次启动直线行走时，反向的轮子需要先“追上”这个间隙，导致机器人又会朝原方向晃一下。一冲一晃，角度误差可能达到1-2度。

我的解决方案是“提前刹车+惯性过冲抵消回差”。在软件中设置一个BACKLASH_CW（顺时针）和BACKLASH_CCW（逆时针）参数。当需要顺时针转90度时，程序会在(90 - BACKLASH_CW)度时就提前发出停止命令，让机器人的惯性过冲刚好“冲过”目标角度，而这次过冲正好弥补了接下来直线启动时因回差产生的反向晃动。这个BACKLASH值需要通过一个校准程序（后文详述）来实测确定。

4.2 编码器距离测量与速度平衡

两个电机都配备了增量式编码器（每转几百个脉冲）。距离控制相对直接：

1. 通过校准得出COUNTS_PER_MM参数，即每毫米距离对应的编码器脉冲数。
2. 执行MOVE 100指令时，计算目标脉冲数target_counts = 100 * COUNTS_PER_MM。
3. 让两个电机同向转动，并不断累加编码器计数。
4. 当任一电机的计数达到target_counts时，同时刹车停止。

核心技巧：动态速度平衡。即使给两个电机相同的PWM值，它们的实际转速也总有微小差异，这会导致画线不直。高级做法是双闭环PID控制，但这里我采用一个更轻量、响应更快的方案：固定左轮PWM，动态调节右轮PWM。

• 在直线行走中断服务中，我计算左轮编码器两个脉冲之间的时间间隔period_left（反映瞬时速度）。
• 同时计算右轮的period_right。
• 如果右轮慢了（period_right > period_left），就微幅增加右轮PWM；反之则减小。调整量根据(period_right - period_left) * PWM_left / period_left计算。
• 这个方法能几乎实时地让两轮速度同步，实测画出的直线非常笔直。

刹车方式的选择：让电机“滑行停止”会产生较大的过冲距离（可能达7-8mm）。TB6612FNG支持“短接刹车”模式，即让电机的两个端子短接，利用电机发电产生的阻力快速制动。启用此功能后，过冲距离可减少到0.5mm以内，极大提升了短距离移动和圆弧绘制的精度。

5. G代码解释器与通信协议实现

要让绘图仪理解复杂的图形，需要一种“语言”，这就是G代码。我实现了一个轻量级的G代码解释器，支持最核心的指令。

5.1 支持的G代码指令集

解释器能解析以下指令：

• G00 Xx Yy：快速移动（抬笔状态）到坐标(x,y)。
• G01 Xx Yy：直线插补（下笔状态）到坐标(x,y)。
• G02/G03 Xx Yy Ii Jj：顺时针/逆时针圆弧插补。这是难点。(x,y)是终点坐标，(i,j)是圆心相对于起点的偏移量。解释器需要将圆弧离散成一系列微小的线段，通过多次TURN和MOVE来逼近。
• TURN angle：相对转动指定角度（+逆时针，-顺时针）。
• MOVE distance：相对移动指定距离（+前进，-后退）。
• SCALE factor：设置全局缩放系数。

圆弧绘制的实现：这是算法上的一个小挑战。由于我们的机器人只能走直线和定点转，画圆弧需要“以直代曲”。算法步骤如下：

1. 根据起点、圆心、终点和方向，计算出圆弧的总角度theta和半径r。
2. 设定一个“步进角”，比如1度。将圆弧分割成n = theta / 步进角段。
3. 对于每一小段，计算其弦长（2 * r * sin(步进角/2)）和需要转动的角度（步进角）。
4. 机器人执行流程变为：TURN(步进角/2)->MOVE(弦长)->TURN(步进角/2)-> ... 循环。这种“转-走-转”的方式比“走-转”更平滑，误差更小。

5.2 蓝牙通信与流控制

通过HC-05蓝牙模块与上位机（手机或电脑）通信。在Arduino端，使用SoftwareSerial库创建一个软串口连接HC-05，避免占用硬件串口用于调试输出。

必须解决的重大问题：数据缓冲区溢出。Arduino的默认串口接收缓冲区只有64字节。而一个G02指令可能就有G02 X50.0 Y30.0 I10.0 J5.0，长度远超64字节。如果上位机连续发送指令，Arduino来不及处理，就会丢失数据，导致图形错乱。

我采用了软件XON/XOFF流控制协议：

1. Arduino初始化后，向上位机发送XON字符（ASCII 17），表示“我可以接收”。
2. 每完整接收并执行完一条指令后，再发送一个XON。
3. 在loop()中，一旦发现串口接收缓冲区数据超过一个安全阈值（如32字节），就立即向上位机发送XOFF字符（ASCII 19），表示“暂停发送”。
4. 当处理完一批数据，缓冲区清空后，再发送XON恢复。
5. 在上位机软件（如Processing编写的发送程序）中，也需要实现对应的逻辑：收到XOFF就暂停发送，收到XON就继续。

这套机制确保了无论G代码文件多大，都能稳定、无误地传输和执行。

6. 系统校准全流程与避坑指南

校准是让这台机器从“能动”到“好用”的关键。校准顺序不能乱，且需要耐心。

6.1 BNO055传感器校准

这是第一步，也是最重要的一步。未校准的BNO055输出数据漂移严重。

1. 将绘图仪静止水平放置。
2. 通过串口发送CALIBRATE指令。
3. 观察串口监视器输出。BNO055会输出四个系统的校准状态（0-3）：系统、陀螺仪、加速度计、磁力计。
4. 你需要缓慢地、以不同姿态在空中“画8字”，直到所有四个状态值都变为3（完全校准）。磁力计校准最容易受环境金属干扰，需要多花点时间。
5. 校准数据会保存在BNO055的片内非易失存储器中，下次上电自动加载。但若模块位置发生剧烈变化，建议重新校准。

6.2 距离校准（COUNTS_PER_MM）

这个参数将编码器脉冲数与实际移动距离关联起来。

1. 在程序开头，找到#define COUNTS_PER_MM一行，先注释掉其值，并取消注释上一行的#define COUNTS调试宏定义。上传程序。
2. 将机器人放在纸上，笔尖对准一个起点。发送PENDOWN和MOVE 100.0指令，让它画一条尽可能长的直线（比如300mm）。
3. 发送PENUP指令。程序会在串口打印出移动这段距离所累计的编码器总脉冲数Total_counts。
4. 用尺子精确测量实际画出的直线长度Actual_mm。
5. 计算：COUNTS_PER_MM = Total_counts / Actual_mm。将这个值填回程序，并注释掉#define COUNTS。重新上传程序。

重要提示：这个校准应在电机完成“热身”（运行几分钟后）且电池电量充足时进行。不同的纸面摩擦力会对结果有微小影响，可以在常用纸张上校准。

6.3 回差（Backlash）校准

这是提升精度的魔法步骤，需要准备纸和笔来记录。

1. 顺时针回差校准：发送CAL_CW指令。机器人会在纸上画5个重叠的、边长约50mm的正方形，每个正方形标有编号（4,3,2,1,0）。每个编号对应一个不同的BACKLASH_CW补偿值（例如4代表补偿0.4度）。
2. 仔细观察这5个正方形。理想情况下，其中一个正方形的首尾相接处几乎完全闭合，四条边笔直且平行。记下这个正方形对应的编号。
3. 将程序头文件中的BACKLASH_CW值改为这个编号（例如，最佳正方形是2，就设为2.0）。该值始终为正数。
4. 逆时针回差校准：发送CAL_CCW指令。同样会画出5个带负编号（-4,-3,-2,-1,0）的正方形。选择最佳的一个，将其编号的绝对值赋给BACKLASH_CCW。该值在程序中以负数形式存储。

常见问题与排查：

• 问题：画出的正方形总是闭合不好，或者边不平行。
• 排查：首先检查BNO055校准是否充分。其次，确保校准地面平整硬实（如桌面），软地毯会引入额外误差。最后，重复几次校准过程，取结果的平均值。
• 问题：校准后画圆仍不圆，有棱角。
• 排查：这可能是圆弧离散的“步进角”设置过大。尝试在代码中减小画弧时的角度步进值（如从1度改为0.5度），但注意这会增加指令数量，对通信和缓冲区管理要求更高。

7. 上位机软件选择与图形生成工作流

有了一个听话的机器人，你还需要一种方式告诉它画什么。这里有几个选择。

7.1 从矢量图到G代码

绘图仪只认识G代码，所以我们需要把常见的图形（SVG, DXF等）或自己设计的图案转化为G代码。

1. 使用专业软件：像Inkscape（免费）这样的矢量绘图软件，配合“G代码工具”插件，可以直接将路径导出为G代码。这是功能最强大的方式，可以处理任意复杂图形。
2. 使用在线转换器：有一些简单网站可以将SVG转换为基本的G00/G01代码。
3. 手动编写：对于简单图形（如测试用的正方形、圆形），可以直接用文本编辑器编写。例如画一个边长100mm的正方形：

   G00 X0 Y0 G01 X100 Y0 G01 X100 Y100 G01 X0 Y100 G01 X0 Y0 PENUP

7.2 终端发送软件的选择

• 手机APP（如Serial Bluetooth Terminal）：适合发送单条指令进行测试和校准，方便快捷。可以将常用指令（TURN 90,MOVE 50等）设为按钮。
• 电脑终端（如CoolTerm, Tera Term）：适合发送整个G代码文件。关键在于配置好串口波特率（通常9600或115200）并启用XON/XOFF流控制。将G代码文件保存为.txt或.gcode，在终端中使用“发送文本文件”功能。
• 自定义Processing程序（如我提供的XON_XOFF_terminal）：这是最可靠的方案。它集成了串口选择、文件选择和严格的XON/XOFF流控，几乎不可能发生数据丢失。用Processing IDE打开提供的.pde文件，根据系统修改串口名称，即可运行。

完整工作流示例：

1. 在Inkscape中设计一个Logo，保存为SVG。
2. 用Inkscape的G代码插件导出，选择“笔式绘图仪”后处理，得到.gcode文件。
3. 用文本编辑器打开.gcode文件，在开头添加SCALE 2.0（如果需要放大），在结尾添加PENUP。
4. 打开Processing发送程序，选择对应的蓝牙串口，加载这个.gcode文件，点击发送。
5. 观察绘图仪开始工作，在纸上绘制出放大后的Logo。

8. 性能优化与扩展可能性

当基础功能实现后，你可以从以下几个方面进一步提升绘图仪的精度、速度和功能。

8.1 软件层面的优化

• 速度曲线规划：目前的移动是匀速的。可以加入简单的梯形速度曲线（加速-匀速-减速），让启动和停止更平稳，减少纸张上的“起笔点”和“停笔点”墨迹，同时提高整体绘图速度。
• 自适应回差补偿：目前的回差补偿是固定值。可以尝试更复杂的模型，例如补偿值与当前电机温度、电池电压关联，但这需要大量实验数据。
• 路径优化：对于复杂的G代码，可以添加一个预处理阶段，对移动路径进行排序，尽量减少空笔移动（G00）的距离，提高绘图效率。

8.2 硬件层面的升级

• 电机升级：如果追求更快的速度和更小的噪音，可以考虑使用带行星齿轮箱的直流电机或步进电机。步进电机控制更精确，无需编码器即可实现开环位置控制，但驱动电路稍复杂。
• 笔具扩展：当前的笔架可以设计成快换结构，以便轻松切换不同颜色的笔、钢笔甚至激光笔（用于投影）。可以增加一个微型舵机来控制笔的旋转，实现类似“笔锋”的效果。
• 增加Z轴：将当前的抬笔舵机升级为一个真正的微型直线滑台（Z轴），可以精确控制下笔深度，适应不同纸张和笔具。

8.3 功能扩展

• 脱离电脑：增加一个SD卡模块，让绘图仪能够读取存储卡内的G代码文件自主运行，变成一个真正的离线数控设备。
• 加入交互：增加一个红外或超声波传感器，让绘图仪具备避障或循迹功能，结合绘图，可以做出“先探索边界，再在区域内绘图”的智能应用。
• 联网与控制：将主控替换为ESP32，接入Wi-Fi，就可以通过网页浏览器远程上传图案并控制绘图，实现物联网绘图仪。

这个项目最吸引我的地方，在于它清晰地展示了如何用简单的模块构建一个闭环控制系统，并通过软件算法克服硬件的物理缺陷。从画出一个歪歪扭扭的方框，到最终能精准复现一个复杂的商标图案，整个调试和优化过程本身就是一次深刻的工程实践。当你第一次看到它完全自主地、一丝不苟地画出你设计的图形时，那种成就感远超购买一台成品设备。希望这份详细的指南能帮助你少走弯路，顺利打造出属于你自己的高精度桌面绘图机器人。