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引脚 - 超声波模块TrigBluno Beetle D11引脚 - 超声波模块EchoBluno 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嵌套来实现避障代码很快就会变得难以维护。我推荐使用“有限状态机”的思想来组织代码。将小车的行为定义为几个明确的状态每个状态下执行固定的动作并根据传感器输入距离判断是否切换到下一个状态。我为这个小车定义了三个核心状态前进探索STATE_EXPLORE默认状态。舵机回正电机前进。持续检测前方距离。障碍反应STATE_AVOID当检测到障碍物距离小于安全阈值如15cm时进入此状态。立即刹车电机停转然后根据策略决定转向方向。转向规避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表示当前距离23cmS:EXPLORE表示当前处于探索状态。手机端发送指令SET SPD 150设置电机速度为150PWM值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或某个超大值不再更新。排查过程初步判断程序死循环还是硬件死锁加入调试信息在getFilteredDistance()函数中和loop()开头增加Serial.println(Step X);语句通过蓝牙观察程序执行流。发现程序流正常但一到pulseIn()函数就卡住。聚焦pulseIn()pulseIn()函数会等待指定引脚出现脉冲信号如果永远等不到就会超时后返回0。我设置了超时参数30000微秒30毫秒。卡死意味着连0都没返回。硬件排查检查超声波模块接线发现Echo引脚与Bluno Beetle的连接用的是杜邦线且没有固定。小车震动时可能接触不良。软件加固pulseIn()在极端情况下可能不稳定。我将其替换为更底层、更可控的轮询方式手动拉高Trig然后循环检测Echo引脚电平变化并用micros()函数计时同时加入超时跳出机制。最终解决更换了更可靠的排线连接并固定同时采用了带严格超时检查的轮询测距代码。问题消失。这个坑告诉我们对于移动平台所有连接必须做机械加固并且关键函数要有“超时逃生”设计。5.2 问题二转向时舵机抖动并伴随系统复位现象每当舵机大角度转动时小车灯光会瞬间暗一下有时甚至整个系统重启。舵机本身动作也不流畅有抖动。排查过程现象关联舵机动作与系统复位强相关。指向电源问题。测量电压在舵机转动时用万用表测量Bluno Beetle的VCC和GND之间的电压。发现电压会从5V瞬间跌落到4V以下触发了MCU的欠压复位。分析原因SG90舵机堵转电流可达700-800mA。我使用的升压模块虽然标称2A但可能动态响应不佳或者锂电池在较大电流输出时电压本身会下降导致升压模块输入电压不足输出电压随之崩溃。解决方案方案A治标在舵机电源引脚就近并联一个大容量电解电容如1000uF和一个0.1uF的陶瓷电容。电解电容提供瞬时大电流陶瓷电容滤除高频噪声。实测有改善但极端情况下仍会复位。方案B治本为舵机提供独立电源。使用另一块电池单独给舵机供电同时将舵机和Bluno Beetle的“地”GND连接在一起确保信号电平基准一致。这是最彻底、最稳定的解决方案。额外发现舵机抖动还与PWM信号有关。Arduino的Servo库在某些引脚上可能会产生抖动。尝试换用其他支持PWM的引脚如D9, D10或者使用analogWrite()配合定时器库进行更精确的控制可以减轻抖动。5.3 问题三避障逻辑在复杂环境下陷入“死循环”现象小车在一个U型死角或密集障碍物区域不断“前进-检测到障碍-转向-前进-又检测到障碍”在原地打转无法脱困。排查过程逻辑分析这是算法策略的缺陷。简单的“检测-转向”逻辑没有记忆和全局观。增加“状态记忆”引入一个“最近转向方向”的变量。如果连续两次避障且转向方向相同则第三次尝试反方向转向或后退。引入“随机性”在STATE_AVOID决策时不总是转向固定方向或最优方向而是加入一个小的随机概率选择次优方向。这能有效避免在对称环境下的振荡。设置“逃脱模式”定义一个计数器当连续进入STATE_AVOID的次数超过阈值如5次则触发一个特殊的“逃脱模式”比如执行一段固定的“后退-大角度转向-前进”组合动作强行离开当前区域。效果验证实现了“随机性逃脱模式”后小车在测试的纸箱迷宫中被困的概率大大降低。这启示我们在简单的反馈控制中引入一点“混沌”或更高阶的策略能显著提升系统的鲁棒性。6. 从项目到产品可能的优化与扩展方向这个基础的避障小车已经能跑了但它就像一个“原型机”。如果你想把它做得更精致、更智能这里有几个明确的优化和扩展方向每一个都可以作为一个新的子项目来深入。6.1 电源管理的精细化目前小车是一直工作的。可以增加一个红外接收头或蓝牙指令实现远程软关机。更进一步可以设计一个硬件开关机电路在待机时仅保持蓝牙芯片低功耗监听主MCU完全断电需要时通过蓝牙信号“唤醒”整个系统这能极大延长续航。6.2 多传感器融合单一超声波传感器存在盲区。可以在小车左前、正前、右前各安装一个超声波或红外传感器实现更广范围的探测。代码上需要处理多路传感器的数据融合比如采用“投票机制”或“最近距离原则”来综合判断障碍物位置。6.3 运动控制的优化目前的舵机后驱模式转弯半径大。可以升级为双电机差速驱动。这需要引入PID控制算法根据期望的转向角度或角速度动态调节左右轮的速度差实现平滑、精准的转向甚至原地旋转。6.4 上位机可视化与数据记录利用Bluno Beetle的蓝牙不仅可以传输文本还可以将实时数据距离、状态、电机PWM值打包发送到电脑上的Python或Processing编写的上位机程序。上位机可以绘制出小车运动轨迹的示意图、传感器数据的实时曲线图并记录日志这对于分析算法行为和调试复杂问题有巨大帮助。6.5 引入更高级的决策算法状态机是基础可以探索更复杂的算法。例如将环境建模为一个简单的栅格地图实现“随机游走”或“沿墙走”算法。或者结合简单的PID控制让小车与侧面的墙壁保持固定距离行进实现走廊巡线。这个基于Bluno Beetle的避障小车项目麻雀虽小五脏俱全。它从硬件选型、电路搭建、传感器调试、控制逻辑编写到无线调试和问题排查完整地走了一遍嵌入式开发的最小闭环。过程中遇到的电源噪声、机械振动、信号干扰、逻辑缺陷等问题在更大的工业项目中同样会遇到只是规模不同。把这些问题在这样一个低成本、低风险的平台上琢磨透其收获远比单纯按照教程复制一个能跑的小车要大得多。最后硬件项目最大的乐趣就在于所有代码和逻辑最终都要接受物理世界的检验那个偶尔犯傻但又努力避开障碍的小车就是对你工作最直接的反馈。
基于Bluno Beetle的避障小车：从硬件搭建、滤波算法到蓝牙调试全解析
发布时间：2026/7/29 3:57:53
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引脚 - 超声波模块TrigBluno Beetle D11引脚 - 超声波模块EchoBluno 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嵌套来实现避障代码很快就会变得难以维护。我推荐使用“有限状态机”的思想来组织代码。将小车的行为定义为几个明确的状态每个状态下执行固定的动作并根据传感器输入距离判断是否切换到下一个状态。我为这个小车定义了三个核心状态前进探索STATE_EXPLORE默认状态。舵机回正电机前进。持续检测前方距离。障碍反应STATE_AVOID当检测到障碍物距离小于安全阈值如15cm时进入此状态。立即刹车电机停转然后根据策略决定转向方向。转向规避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表示当前距离23cmS:EXPLORE表示当前处于探索状态。手机端发送指令SET SPD 150设置电机速度为150PWM值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或某个超大值不再更新。排查过程初步判断程序死循环还是硬件死锁加入调试信息在getFilteredDistance()函数中和loop()开头增加Serial.println(Step X);语句通过蓝牙观察程序执行流。发现程序流正常但一到pulseIn()函数就卡住。聚焦pulseIn()pulseIn()函数会等待指定引脚出现脉冲信号如果永远等不到就会超时后返回0。我设置了超时参数30000微秒30毫秒。卡死意味着连0都没返回。硬件排查检查超声波模块接线发现Echo引脚与Bluno Beetle的连接用的是杜邦线且没有固定。小车震动时可能接触不良。软件加固pulseIn()在极端情况下可能不稳定。我将其替换为更底层、更可控的轮询方式手动拉高Trig然后循环检测Echo引脚电平变化并用micros()函数计时同时加入超时跳出机制。最终解决更换了更可靠的排线连接并固定同时采用了带严格超时检查的轮询测距代码。问题消失。这个坑告诉我们对于移动平台所有连接必须做机械加固并且关键函数要有“超时逃生”设计。5.2 问题二转向时舵机抖动并伴随系统复位现象每当舵机大角度转动时小车灯光会瞬间暗一下有时甚至整个系统重启。舵机本身动作也不流畅有抖动。排查过程现象关联舵机动作与系统复位强相关。指向电源问题。测量电压在舵机转动时用万用表测量Bluno Beetle的VCC和GND之间的电压。发现电压会从5V瞬间跌落到4V以下触发了MCU的欠压复位。分析原因SG90舵机堵转电流可达700-800mA。我使用的升压模块虽然标称2A但可能动态响应不佳或者锂电池在较大电流输出时电压本身会下降导致升压模块输入电压不足输出电压随之崩溃。解决方案方案A治标在舵机电源引脚就近并联一个大容量电解电容如1000uF和一个0.1uF的陶瓷电容。电解电容提供瞬时大电流陶瓷电容滤除高频噪声。实测有改善但极端情况下仍会复位。方案B治本为舵机提供独立电源。使用另一块电池单独给舵机供电同时将舵机和Bluno Beetle的“地”GND连接在一起确保信号电平基准一致。这是最彻底、最稳定的解决方案。额外发现舵机抖动还与PWM信号有关。Arduino的Servo库在某些引脚上可能会产生抖动。尝试换用其他支持PWM的引脚如D9, D10或者使用analogWrite()配合定时器库进行更精确的控制可以减轻抖动。5.3 问题三避障逻辑在复杂环境下陷入“死循环”现象小车在一个U型死角或密集障碍物区域不断“前进-检测到障碍-转向-前进-又检测到障碍”在原地打转无法脱困。排查过程逻辑分析这是算法策略的缺陷。简单的“检测-转向”逻辑没有记忆和全局观。增加“状态记忆”引入一个“最近转向方向”的变量。如果连续两次避障且转向方向相同则第三次尝试反方向转向或后退。引入“随机性”在STATE_AVOID决策时不总是转向固定方向或最优方向而是加入一个小的随机概率选择次优方向。这能有效避免在对称环境下的振荡。设置“逃脱模式”定义一个计数器当连续进入STATE_AVOID的次数超过阈值如5次则触发一个特殊的“逃脱模式”比如执行一段固定的“后退-大角度转向-前进”组合动作强行离开当前区域。效果验证实现了“随机性逃脱模式”后小车在测试的纸箱迷宫中被困的概率大大降低。这启示我们在简单的反馈控制中引入一点“混沌”或更高阶的策略能显著提升系统的鲁棒性。6. 从项目到产品可能的优化与扩展方向这个基础的避障小车已经能跑了但它就像一个“原型机”。如果你想把它做得更精致、更智能这里有几个明确的优化和扩展方向每一个都可以作为一个新的子项目来深入。6.1 电源管理的精细化目前小车是一直工作的。可以增加一个红外接收头或蓝牙指令实现远程软关机。更进一步可以设计一个硬件开关机电路在待机时仅保持蓝牙芯片低功耗监听主MCU完全断电需要时通过蓝牙信号“唤醒”整个系统这能极大延长续航。6.2 多传感器融合单一超声波传感器存在盲区。可以在小车左前、正前、右前各安装一个超声波或红外传感器实现更广范围的探测。代码上需要处理多路传感器的数据融合比如采用“投票机制”或“最近距离原则”来综合判断障碍物位置。6.3 运动控制的优化目前的舵机后驱模式转弯半径大。可以升级为双电机差速驱动。这需要引入PID控制算法根据期望的转向角度或角速度动态调节左右轮的速度差实现平滑、精准的转向甚至原地旋转。6.4 上位机可视化与数据记录利用Bluno Beetle的蓝牙不仅可以传输文本还可以将实时数据距离、状态、电机PWM值打包发送到电脑上的Python或Processing编写的上位机程序。上位机可以绘制出小车运动轨迹的示意图、传感器数据的实时曲线图并记录日志这对于分析算法行为和调试复杂问题有巨大帮助。6.5 引入更高级的决策算法状态机是基础可以探索更复杂的算法。例如将环境建模为一个简单的栅格地图实现“随机游走”或“沿墙走”算法。或者结合简单的PID控制让小车与侧面的墙壁保持固定距离行进实现走廊巡线。这个基于Bluno Beetle的避障小车项目麻雀虽小五脏俱全。它从硬件选型、电路搭建、传感器调试、控制逻辑编写到无线调试和问题排查完整地走了一遍嵌入式开发的最小闭环。过程中遇到的电源噪声、机械振动、信号干扰、逻辑缺陷等问题在更大的工业项目中同样会遇到只是规模不同。把这些问题在这样一个低成本、低风险的平台上琢磨透其收获远比单纯按照教程复制一个能跑的小车要大得多。最后硬件项目最大的乐趣就在于所有代码和逻辑最终都要接受物理世界的检验那个偶尔犯傻但又努力避开障碍的小车就是对你工作最直接的反馈。
