基于Bluno Beetle的避障小车：从硬件搭建、滤波算法到蓝牙调试全解析

1. 项目缘起：从“玩具”到“学习平台”的转变

最近在整理工作室的物料，翻出来几个之前玩智能硬件剩下的Bluno Beetle主控板。这玩意儿个头小得像个硬币，但集成了蓝牙4.0和Arduino兼容的核心，当年买来是想做点穿戴式小玩意儿，后来项目搁置就吃灰了。正好手边还有几个闲置的舵机、超声波模块和一堆乐高积木零件，一个念头就冒出来了：能不能用这些“边角料”，快速搭一个能自动避障的小车？这听起来像是给小朋友的玩具，但对于我们这些搞嵌入式开发的人来说，它其实是一个绝佳的“微缩验证平台”。一个完整的避障小车项目，几乎涵盖了嵌入式开发中传感器数据采集、控制逻辑决策、执行器驱动、无线通信调试等核心环节。用最少的硬件成本，在桌面上就能跑通一个完整的感知-决策-控制闭环，这对于验证算法思路、调试底层驱动、甚至是给新人做入门教学，都再合适不过了。于是，这次“试用作业”的目标就很明确了：不追求复杂的结构和性能，而是聚焦于如何用Bluno Beetle这块小板子，高效、稳定地实现避障的核心逻辑，并在这个过程中，把那些容易踩坑的细节和调试心得记录下来。

2. 核心硬件选型与“最小系统”搭建思路

手头的物料决定了项目的起点。我们的核心是DFRobot出品的Bluno Beetle，它本质上是一块基于ATmega328P（与Arduino Uno同款主控）并集成了TI CC2540蓝牙4.0芯片的微型开发板。它的优势在于极度紧凑（直径仅3.5厘米）和即插即用的无线能力，但代价是IO口非常有限，只有寥寥数个数字和模拟口，且没有标准的电源接口。这就意味着我们的硬件架构必须遵循“极简主义”。

2.1 主控与电源方案的权衡

Bluno Beetle的工作电压是5V，可以通过Micro USB口供电，但在小车上这显然不现实。因此，移动电源是必须的。我选择了一块常见的3.7V锂电池（型号14500），搭配一个微型升压模块，将电压稳定到5V后给Beetle供电。这里第一个坑就出现了：升压模块的电流输出能力。舵机在堵转或启动瞬间的电流峰值可能超过1A，如果升压模块最大输出电流只有500mA，就会导致系统电压被拉低，主控板不断重启，现象就是小车抽搐一下就不动了。我换用了一个标称输出2A的升压模块后问题解决。所以，电源的峰值电流余量一定要留足，至少是舵机堵转电流的1.5倍以上。

2.2 感知层：为什么是超声波，而不是红外？

避障需要“眼睛”。常见的选择有红外测距和超声波测距。红外传感器便宜，但受环境光干扰大，对深色物体或透明物体（如玻璃）的检测极不可靠。超声波传感器（我用的HC-SR04）原理是发射声波并接收回波，通过时间差计算距离，基本不受光线和颜色影响，在室内环境下更为稳定。虽然它的探测有一定角度，且对柔软吸音材料效果差，但对于桌面小车探测硬质障碍物来说，是完全够用的。HC-SR04需要两个IO口（Trig触发和Echo回波），测量距离在2cm到400cm之间，精度对于避障来说也足够了。

2.3 执行层：舵机转向与电机驱动的取舍

小车的移动方案有两种主流选择：一是两个直流电机分别驱动左右轮，配合万向轮，通过差速实现转向；二是用一个舵机控制前轮转向，后轮用一个直流电机驱动。前者控制更灵活，可以实现原地旋转，但需要两个电机驱动通道，电路和代码稍复杂。后者结构简单，更像真车，但转向半径受限于舵机角度。

由于手头资源有限（只有一个现成的直流电机驱动模块），我选择了方案二：舵机转向+单后轮驱动。舵机我选用的是SG90微型舵机，控制信号是标准的PWM（脉冲宽度调制）。这里的关键是供电隔离：舵机最好单独供电，或者与主控共用电源但加上大容量电容滤波。因为舵机在转动时会产生较大的电流波动和电气噪声，如果直接与主控板、超声波传感器共享一条脆弱的5V线路，噪声很容易窜入主控的ADC或数字电路，导致系统运行不稳定，甚至出现超声波测距值跳变异常。我的做法是，锂电池升压后，先接一个470uF的电解电容进行一级滤波，然后分两路，一路直接给舵机，另一路再经过一个100uF的胆电容后给Bluno Beetle和超声波模块。这个小技巧能显著提升系统稳定性。

2.4 整体电路连接与布线心得

最终的“最小系统”连接如下：

• 电池 -> 升压模块 -> （电源分支点）
  • 分支一：直接至舵机（红正、棕负、黄信号）
  • 分支二：经滤波电容至Bluno Beetle的VCC/GND，同时接超声波模块VCC/GND。
• Bluno Beetle D9引脚 -> 舵机信号线（黄）
• Bluno Beetle D10引脚 -> 超声波模块Trig
• Bluno Beetle D11引脚 -> 超声波模块Echo
• Bluno Beetle D5, D6引脚 -> 直流电机驱动模块控制端（用于控制后轮电机正反转和PWM调速）

布线时，一个核心原则是**“信号线远离电源线”**，尤其是PWM信号线和超声波的Echo回波线（它本身就是一个高敏感度的输入信号）。尽量将这些信号线绞合在一起，或者贴着车体框架走线，避免与电机、舵机的电源线长距离平行，可以有效减少耦合干扰。所有连接点，我都使用了热熔胶进行固定，防止在运动过程中因振动导致接触不良，这种故障现象时有时无，排查起来非常头疼。

3. 核心避障逻辑设计与代码实现详解

硬件搭好了，接下来就是赋予小车“大脑”。避障逻辑看似简单——“前面有东西就转弯”，但实际写起来，要考虑的边界情况非常多，直接决定了小车的行为是否智能和流畅。

3.1 超声波测距的稳定化处理

HC-SR04的测距值并非绝对稳定，偶尔会出现极大的 outlier（例如从正常的20cm突然跳到300cm）。如果直接用单次测量值做决策，小车会“抽风”。因此，必须进行软件滤波。我采用了最简单但非常有效的“滑动窗口中值滤波法”。

具体做法是：创建一个数组，持续保存最近N次（比如5次）的有效测距结果。每次获取新数据后，先进行合理性判断（比如是否在2cm-200cm的有效范围内），合理则存入数组。然后对数组进行排序，取中间值（中位数）作为本次使用的距离值。中位数滤波能有效滤除偶然出现的尖峰脉冲干扰。

const int numReadings = 5; int readings[numReadings]; // 保存距离值的数组 int readIndex = 0; long total = 0; int averageDistance = 0; long getFilteredDistance() { long duration, distance; // 触发测距 digitalWrite(TRIG_PIN, LOW); delayMicroseconds(2); digitalWrite(TRIG_PIN, HIGH); delayMicroseconds(10); digitalWrite(TRIG_PIN, LOW); duration = pulseIn(ECHO_PIN, HIGH, 30000); // 设置超时防止死等 distance = duration * 0.034 / 2; // 声速取340m/s // 有效性检查 if(distance >= 2 && distance <= 200) { readings[readIndex] = distance; readIndex = (readIndex + 1) % numReadings; // 复制数组进行排序，避免破坏原数组 int sortedReadings[numReadings]; for (int i = 0; i < numReadings; i++) { sortedReadings[i] = readings[i]; } // 简单冒泡排序求中值 for (int i = 0; i < numReadings - 1; i++) { for (int j = i + 1; j < numReadings; j++) { if (sortedReadings[i] > sortedReadings[j]) { int temp = sortedReadings[i]; sortedReadings[i] = sortedReadings[j]; sortedReadings[j] = temp; } } } return sortedReadings[numReadings / 2]; // 返回中位数 } else { // 无效数据，返回上一次的有效中值或一个安全值 return lastValidDistance; } }

3.2 状态机：让决策逻辑清晰可控

很多初学者喜欢用一堆if-else嵌套来实现避障，代码很快就会变得难以维护。我推荐使用“有限状态机”的思想来组织代码。将小车的行为定义为几个明确的状态，每个状态下执行固定的动作，并根据传感器输入（距离）判断是否切换到下一个状态。

我为这个小车定义了三个核心状态：

1. 前进探索（STATE_EXPLORE）：默认状态。舵机回正，电机前进。持续检测前方距离。
2. 障碍反应（STATE_AVOID）：当检测到障碍物距离小于安全阈值（如15cm）时，进入此状态。立即刹车（电机停转），然后根据策略决定转向方向。
3. 转向规避（STATE_TURN）：执行具体的转向动作。比如让舵机向左打满，同时电机可能稍微后退或原地不动，持续一个短暂时间，然后回正舵机。

状态机的优势在于逻辑清晰，易于调试和扩展。比如，未来你想增加“原地旋转扫描”的功能，只需要增加一个STATE_SCAN状态，并在适当的条件下进行切换即可。

enum CarState { STATE_EXPLORE, STATE_AVOID, STATE_TURN_LEFT, STATE_TURN_RIGHT }; CarState currentState = STATE_EXPLORE; int safeDistance = 15; int obstacleDistance = 0; void loop() { obstacleDistance = getFilteredDistance(); // 获取滤波后的距离 switch(currentState) { case STATE_EXPLORE: goForward(); if (obstacleDistance < safeDistance && obstacleDistance > 0) { currentState = STATE_AVOID; } break; case STATE_AVOID: stopCar(); // 简单策略：总是向左转 currentState = STATE_TURN_LEFT; turnStartTime = millis(); // 记录开始转向的时间 break; case STATE_TURN_LEFT: turnLeft(); // 转向持续300毫秒后，切换回探索状态 if (millis() - turnStartTime > 300) { currentState = STATE_EXPLORE; } break; // ... 其他状态处理 } }

3.3 策略优化：从“无脑左转”到“智能选择”

上面的例子是“无脑左转”。一个明显的缺陷是，如果左边也有障碍物（比如在墙角），小车就会卡死。更优的策略是加入“随机转向”或“探测择优”。

一个简单的改进是“左顾右盼”：当检测到正面障碍后，小车先停下，然后控制舵机分别向左、右各偏转一定角度（如30度），测量左右两侧的距离，然后选择距离较远的一侧进行转向。这需要舵机具备快速、精确的角度控制能力。

int checkSideDistance(int angle) { setServoAngle(angle); // 控制舵机转到指定角度 delay(150); // 等待舵机稳定和超声波回波稳定 int d = getFilteredDistance(); setServoAngle(90); // 回正 delay(100); return d; } // 在 STATE_AVOID 状态中 int leftDist = checkSideDistance(60); // 左转30度（假设90度为正前） int rightDist = checkSideDistance(120); // 右转30度 if (leftDist > rightDist && leftDist > safeDistance) { currentState = STATE_TURN_LEFT; } else if (rightDist > safeDistance) { currentState = STATE_TURN_RIGHT; } else { // 两边都不行，执行倒车+大角度转向 currentState = STATE_BACK_AND_TURN; }

这个策略大大提升了小车在复杂环境下的通过性。这里的关键延时delay(150)需要根据你的舵机速度和超声波模块响应时间微调，太短测量不准，太长则反应迟钝。

4. 蓝牙无线调试与参数实时调优

Bluno Beetle的蓝牙功能在这个项目中不仅仅是“炫技”，它是一个极其强大的无线调试终端。通过蓝牙，我们可以在手机或电脑上实时查看小车的传感器数据、状态信息，并且能动态修改运行参数（如安全距离、电机速度、转向角度等），而无需反复插拔USB线烧录程序。

4.1 蓝牙通信协议设计

Arduino IDE的串口监视器可以通过USB使用，但蓝牙连接后，同样可以通过串口进行通信。我们需要设计一个简单的文本协议。例如：

• 小车主动上报：D:23表示当前距离23cm；S:EXPLORE表示当前处于探索状态。
• 手机端发送指令：SET SPD 150设置电机速度为150（PWM值）；SET SAFE 20设置安全距离为20cm。

在Arduino代码中，我们需要在loop()函数里加入检查串口（蓝牙）输入的代码。

void checkBluetoothCommand() { if (Serial.available() > 0) { String command = Serial.readStringUntil('\n'); // 读取一行命令 command.trim(); // 去除首尾空格 if (command.startsWith("SET SAFE ")) { int newDist = command.substring(9).toInt(); if (newDist >= 5 && newDist <= 50) { safeDistance = newDist; Serial.print("OK. Safe distance set to: "); Serial.println(safeDistance); } } else if (command.startsWith("GET DATA")) { Serial.print("D:"); Serial.print(obstacleDistance); Serial.print(",S:"); Serial.println(stateToString(currentState)); } // ... 解析其他命令 } }

4.2 手机端调试工具的选择

你不需要专门开发一个APP。在手机上安装一个通用的“蓝牙串口”应用即可，这类应用在应用商店很多。它们的功能就是连接蓝牙设备，并提供一个可以发送和接收文本的界面。你将Bluno Beetle与之配对连接后，就能实现上述的指令发送和数据接收。

4.3 实时调参的价值

这个功能彻底改变了调试体验。比如，小车总是离障碍物太近才转弯，显得很“莽”。传统方式你需要：修改代码中的safeDistance变量 -> 编译 -> 上传 -> 观察。一来一回几分钟就过去了。现在，你只需要在手机App里输入SET SAFE 25并发送，小车下一秒就开始执行新的25cm安全距离策略。你可以立刻看到行为变化，并快速迭代找到最优值。对于电机速度、转向持续时间等参数，同样如此。这就像给小车装了一个“遥控参数面板”，开发效率提升巨大。

5. 实测中的典型问题与深度排查

理论很美好，但小车一跑起来，各种稀奇古怪的问题就来了。下面是我在调试过程中遇到的几个典型问题及其排查链路，这比最终的代码更有价值。

5.1 问题一：小车行进中偶尔“僵住”，超声波读数卡死

• 现象：小车正常跑着，突然停下不动，通过蓝牙打印数据发现obstacleDistance卡在一个固定值（比如0或某个超大值）不再更新。
• 排查过程：
  1. 初步判断：程序死循环？还是硬件死锁？
  2. 加入调试信息：在getFilteredDistance()函数中和loop()开头增加Serial.println("Step X");语句，通过蓝牙观察程序执行流。发现程序流正常，但一到pulseIn()函数就卡住。
  3. 聚焦pulseIn()：pulseIn()函数会等待指定引脚出现脉冲信号，如果永远等不到，就会超时后返回0。我设置了超时参数30000微秒（30毫秒）。卡死意味着连0都没返回。
  4. 硬件排查：检查超声波模块接线，发现Echo引脚与Bluno Beetle的连接用的是杜邦线，且没有固定。小车震动时，可能接触不良。
  5. 软件加固：pulseIn()在极端情况下可能不稳定。我将其替换为更底层、更可控的轮询方式：手动拉高Trig，然后循环检测Echo引脚电平变化，并用micros()函数计时，同时加入超时跳出机制。
  6. 最终解决：更换了更可靠的排线连接并固定，同时采用了带严格超时检查的轮询测距代码。问题消失。这个坑告诉我们，对于移动平台，所有连接必须做机械加固，并且关键函数要有“超时逃生”设计。

5.2 问题二：转向时舵机抖动，并伴随系统复位

• 现象：每当舵机大角度转动时，小车灯光会瞬间暗一下，有时甚至整个系统重启。舵机本身动作也不流畅，有抖动。
• 排查过程：
  1. 现象关联：舵机动作与系统复位强相关。指向电源问题。
  2. 测量电压：在舵机转动时，用万用表测量Bluno Beetle的VCC和GND之间的电压。发现电压会从5V瞬间跌落到4V以下，触发了MCU的欠压复位。
  3. 分析原因：SG90舵机堵转电流可达700-800mA。我使用的升压模块虽然标称2A，但可能动态响应不佳，或者锂电池在较大电流输出时电压本身会下降，导致升压模块输入电压不足，输出电压随之崩溃。
  4. 解决方案：
     • 方案A（治标）：在舵机电源引脚就近并联一个大容量电解电容（如1000uF）和一个0.1uF的陶瓷电容。电解电容提供瞬时大电流，陶瓷电容滤除高频噪声。实测有改善，但极端情况下仍会复位。
     • 方案B（治本）：为舵机提供独立电源。使用另一块电池单独给舵机供电，同时将舵机和Bluno Beetle的“地”（GND）连接在一起，确保信号电平基准一致。这是最彻底、最稳定的解决方案。
  5. 额外发现：舵机抖动还与PWM信号有关。Arduino的Servo库在某些引脚上可能会产生抖动。尝试换用其他支持PWM的引脚（如D9, D10），或者使用analogWrite()配合定时器库进行更精确的控制，可以减轻抖动。

5.3 问题三：避障逻辑在复杂环境下陷入“死循环”

• 现象：小车在一个U型死角或密集障碍物区域，不断“前进->检测到障碍->转向->前进->又检测到障碍”，在原地打转，无法脱困。
• 排查过程：
  1. 逻辑分析：这是算法策略的缺陷。简单的“检测-转向”逻辑没有记忆和全局观。
  2. 增加“状态记忆”：引入一个“最近转向方向”的变量。如果连续两次避障，且转向方向相同，则第三次尝试反方向转向或后退。
  3. 引入“随机性”：在STATE_AVOID决策时，不总是转向固定方向或最优方向，而是加入一个小的随机概率选择次优方向。这能有效避免在对称环境下的振荡。
  4. 设置“逃脱模式”：定义一个计数器，当连续进入STATE_AVOID的次数超过阈值（如5次），则触发一个特殊的“逃脱模式”，比如执行一段固定的“后退->大角度转向->前进”组合动作，强行离开当前区域。
  5. 效果验证：实现了“随机性+逃脱模式”后，小车在测试的纸箱迷宫中被困的概率大大降低。这启示我们，在简单的反馈控制中引入一点“混沌”或更高阶的策略，能显著提升系统的鲁棒性。

6. 从项目到产品：可能的优化与扩展方向

这个基础的避障小车已经能跑了，但它就像一个“原型机”。如果你想把它做得更精致、更智能，这里有几个明确的优化和扩展方向，每一个都可以作为一个新的子项目来深入。

6.1 电源管理的精细化

目前小车是一直工作的。可以增加一个红外接收头或蓝牙指令，实现远程软关机。更进一步，可以设计一个硬件开关机电路，在待机时仅保持蓝牙芯片低功耗监听，主MCU完全断电，需要时通过蓝牙信号“唤醒”整个系统，这能极大延长续航。

6.2 多传感器融合

单一超声波传感器存在盲区。可以在小车左前、正前、右前各安装一个超声波或红外传感器，实现更广范围的探测。代码上需要处理多路传感器的数据融合，比如采用“投票机制”或“最近距离原则”来综合判断障碍物位置。

6.3 运动控制的优化

目前的舵机+后驱模式转弯半径大。可以升级为双电机差速驱动。这需要引入PID控制算法，根据期望的转向角度或角速度，动态调节左右轮的速度差，实现平滑、精准的转向，甚至原地旋转。

6.4 上位机可视化与数据记录

利用Bluno Beetle的蓝牙，不仅可以传输文本，还可以将实时数据（距离、状态、电机PWM值）打包发送到电脑上的Python或Processing编写的上位机程序。上位机可以绘制出小车运动轨迹的示意图、传感器数据的实时曲线图，并记录日志，这对于分析算法行为和调试复杂问题有巨大帮助。

6.5 引入更高级的决策算法

状态机是基础，可以探索更复杂的算法。例如，将环境建模为一个简单的栅格地图，实现“随机游走”或“沿墙走”算法。或者，结合简单的PID控制，让小车与侧面的墙壁保持固定距离行进，实现走廊巡线。

这个基于Bluno Beetle的避障小车项目，麻雀虽小，五脏俱全。它从硬件选型、电路搭建、传感器调试、控制逻辑编写，到无线调试和问题排查，完整地走了一遍嵌入式开发的最小闭环。过程中遇到的电源噪声、机械振动、信号干扰、逻辑缺陷等问题，在更大的工业项目中同样会遇到，只是规模不同。把这些问题在这样一个低成本、低风险的平台上琢磨透，其收获远比单纯按照教程复制一个能跑的小车要大得多。最后，硬件项目最大的乐趣就在于，所有代码和逻辑最终都要接受物理世界的检验，那个偶尔犯傻但又努力避开障碍的小车，就是对你工作最直接的反馈。