1. 无人车避障这件事为什么值得单独拿出来讲做无人车和无人船的朋友都有一个共识让车跑起来容易让它遇到障碍物能自己停下来或者绕过去才是真正头疼的开始。我自己从最早用超声波模块搭第一台避障小车到后来折腾激光雷达、毫米波雷达踩过的坑可以说能写一本小册子。这次要聊的是用 ArduPilot 固件给无人车/无人船配置避障功能核心传感器选型是 MR72 毫米波雷达和 TFmini Plus 激光测距模块。这两个传感器在圈子里口碑都不错价格也相对友好适合中小型无人平台。ArduPilot 本身对避障的支持已经相当成熟尤其是 Rover 固件无人车/船都跑这个内置了基于接近传感器Proximity Sensor的避障逻辑。你不需要自己写一套避障算法只要把传感器接对、参数配好固件就能帮你处理大部分场景。但问题恰恰出在“接对”和“配好”这两个环节——官方文档写得比较散社区里的教程又经常跳步骤新手很容易卡在某个参数上半天找不到北。这篇文章面向的是有一定 ArduPilot 基础、但还没深入搞过避障配置的朋友。我会从传感器选型逻辑讲起把 MR72 和 TFmini Plus 的接线、参数配置、避障行为调试一步步拆开最后再分享几个我在实际测试中踩过的坑和排查技巧。读完你至少能做到拿到这两个传感器知道怎么接到飞控上参数怎么填避障逻辑怎么验证出了问题从哪里查。2. 避障方案的整体设计思路2.1 为什么选接近传感器方案而不是视觉方案ArduPilot 支持的避障方案有好几种视觉避障比如用光流相机或者深度相机、雷达避障、超声波阵列都有人做。我选接近传感器方案主要基于三个考虑。第一是算力需求。视觉方案对飞控的计算能力有要求虽然现在有些飞控能跑轻量级的视觉算法但调试复杂度高光照条件一变效果就打折。接近传感器方案把感知和决策分离了——传感器负责测距飞控只负责根据距离做避障决策飞控的负担小很多。第二是实时性。MR72 毫米波雷达的刷新率可以到 20Hz 以上TFmini Plus 也有 100Hz 的更新率对于无人车这种速度不快的平台来说完全够用。视觉方案的处理延迟往往更大而且容易受帧率波动影响。第三是环境适应性。毫米波雷达在雨雾、灰尘环境下比视觉和激光都稳TFmini Plus 虽然怕强光直射但在室内或者光线可控的室外场景表现很好。两者搭配使用一个负责中远距离探测一个负责近距离精确测距互补性很强。2.2 MR72 和 TFmini Plus 的角色分工MR72 是北醒Benewake出的 77GHz 毫米波雷达探测距离远最远能到 40 米取决于目标 RCS水平视场角大概 100 度左右。它的优势是能同时输出多个目标的距离和角度信息适合做前方扇区的障碍物检测。缺点是近距离盲区比较大大概在 0.5 米以内测不准。TFmini Plus 是北醒的激光测距模块基于 ToF 原理测量范围 0.1 米到 12 米更新率最高 100Hz精度在厘米级。它的优势是近距离准、体积小、功耗低缺点是视场角很窄大概 3 度左右只能测一个点。所以我的方案是MR72 装在车头正前方负责扫描前方扇形区域探测中远距离的障碍物TFmini Plus 装在车头偏低的位置朝正前方负责近距离的精确测距弥补 MR72 的盲区。两个传感器都接到飞控的串口上通过 MAVLink 或者自定义协议把数据传给 ArduPilot。2.3 ArduPilot 避障逻辑的核心机制ArduPilot Rover 固件的避障逻辑主要围绕几个参数展开。固件会持续读取接近传感器的数据当检测到障碍物距离小于设定的阈值时触发避障行为。避障行为可以是简单的停止Brake也可以是绕行Loiter 或者 RTL 的变体具体取决于你的配置。核心参数包括PRX_TYPE接近传感器的类型MR72 和 TFmini Plus 都需要选对应的驱动AVOID_ENABLE避障功能的总开关AVOID_MARGIN避障时保持的安全距离AVOID_BEHAVE避障行为模式0 是停止1 是绕行PRX_MIN、PRX_MAX传感器的最小和最大有效距离这些参数的具体数值需要根据你的车体尺寸、速度和传感器安装位置来调。后面我会给出具体的计算方法和推荐值。3. 硬件接线与传感器配置实操3.1 MR72 的接线与飞控串口分配MR72 通过串口UART输出数据默认波特率是 115200。接线的时候注意几点MR72 的 TX 接飞控的 RXRX 接飞控的 TXGND 对接供电是 5V但要注意 MR72 的峰值电流可能到 500mA 左右最好单独供电或者确认飞控的 5V 输出能力够如果飞控的串口不够用可以用一个串口扩展板或者把 TFmini Plus 接到 I2C 上TFmini Plus 支持 I2C 模式我用的飞控是 Pixhawk 4串口分配是这样的串口用途波特率协议SERIAL1接数传57600MAVLink1SERIAL2接 MR72115200自定义SERIAL3接 GPS38400GPSSERIAL4接 TFmini Plus115200自定义在 Mission Planner 或者 QGroundControl 里需要把对应的串口协议设成SERIALx_PROTOCOL 1MAVLink或者根据传感器驱动的要求设置。MR72 在 ArduPilot 里有专门的驱动选PRX_TYPE 5MR72就行。3.2 TFmini Plus 的两种接入方式对比TFmini Plus 支持 UART 和 I2C 两种模式我两种都试过各有优劣。UART 模式的好处是配置简单直接接串口就行波特率默认 115200。缺点是占用一个串口而且如果飞控串口紧张就比较麻烦。I2C 模式的好处是省串口一根线可以挂多个设备但需要改传感器的固件配置用北醒的上位机软件切换模式而且 I2C 的线长有限制太长容易通信失败。我最后选了 UART 模式因为 Pixhawk 4 的串口够用而且 UART 的稳定性更好。接线方式和 MR72 一样TX/RX 交叉接供电 5V。在 ArduPilot 里TFmini Plus 的驱动类型是PRX_TYPE 4TFmini Plus。如果你用的是 I2C 模式需要额外设置PRX_ADDRESS参数默认是 0x10。3.3 传感器安装位置与角度校准安装位置对避障效果影响很大我踩过的坑主要集中在这里。MR72 的安装建议装在车头正中央高度大概在车体高度的 1/2 到 2/3 处稍微向下倾斜 5 到 10 度。这样既能探测到前方的障碍物也能兼顾地面的一些起伏。注意 MR72 的雷达波束有垂直方向的扩散如果装得太高可能会把上方的树枝或者标志牌误判为障碍物。TFmini Plus 的安装装在车头偏低的位置朝正前方不要倾斜。因为它的视场角很窄倾斜会导致测距点偏移。我一般把它装在离地 15 到 20 厘米的位置这样能探测到大部分地面障碍物。角度校准装好之后需要用飞控的日志或者地面站软件看一下传感器的实际读数。MR72 可以通过 MAVLink 的DISTANCE_SENSOR消息查看TFmini Plus 也是。如果发现读数方向不对可能需要调整PRX_ORIENT参数或者物理上重新调整安装角度。注意MR72 的雷达波束对金属物体特别敏感如果车体本身有金属结构在雷达前方可能会产生虚假回波。安装时尽量让雷达前方没有遮挡。4. ArduPilot 参数配置全流程4.1 基础参数设置与串口配置先把基础参数配好这是后面所有调试的前提。首先设置串口协议。假设 MR72 接在 SERIAL2TFmini Plus 接在 SERIAL4SERIAL2_PROTOCOL 1 SERIAL2_BAUD 115 SERIAL4_PROTOCOL 1 SERIAL4_BAUD 115这里的115对应 115200 波特率ArduPilot 的参数值是用波特率除以 100 来填的。然后设置接近传感器类型PRX_TYPE 5这个值对应 MR72。如果你同时接了 TFmini Plus需要设置第二个接近传感器PRX2_TYPE 4ArduPilot 支持多个接近传感器同时工作固件会把它们的数据融合起来用。4.2 避障行为参数详解与计算避障行为的核心参数是AVOID_ENABLE、AVOID_MARGIN和AVOID_BEHAVE。AVOID_ENABLE设为 1 打开避障功能。这个参数打开后固件会在 AUTO 和 GUIDED 模式下自动避障在 MANUAL 模式下不会干预你的操作。AVOID_MARGIN是避障时保持的安全距离单位是米。这个值需要根据你的车体尺寸和速度来算。我的经验公式是AVOID_MARGIN 车体长度/2 速度(米/秒) × 反应时间(秒) 安全余量(米)举个例子车体长 1 米速度 2 米/秒反应时间按 0.5 秒算安全余量取 0.5 米AVOID_MARGIN 0.5 2 × 0.5 0.5 2 米所以AVOID_MARGIN设 2 米比较合适。如果你在狭窄空间作业可以适当减小但不要小于 1 米。AVOID_BEHAVE有两个选项0 是停止Brake1 是绕行Loiter。对于无人车来说我建议先用 0确认避障逻辑正常后再试 1。绕行模式需要更复杂的路径规划调试起来更麻烦。4.3 MR72 专属参数调优MR72 有几个专属参数需要调PRX_MIN 0.5 PRX_MAX 40PRX_MIN是传感器的最小有效距离MR72 的盲区大概在 0.5 米左右所以设 0.5。PRX_MAX是最大有效距离设 40 米对应它的最远探测距离。还有一个参数是PRX_FILT这是距离数据的滤波系数默认是 0.25。如果发现避障触发太频繁可以适当调大比如 0.5让数据更平滑。但调太大也会导致反应迟钝需要权衡。MR72 还有一个PRX_YAW_CORR参数用于校正雷达的安装偏航角。如果你发现雷达探测到的障碍物位置和实际有偏差可以调这个参数。单位是度范围 -180 到 180。4.4 TFmini Plus 专属参数调优TFmini Plus 的参数相对简单PRX2_MIN 0.1 PRX2_MAX 12对应它的测量范围。TFmini Plus 的更新率很高一般不需要额外滤波PRX2_FILT保持默认就行。需要注意的是TFmini Plus 在强光下比如直射阳光测距会不准如果发现数据跳变可以加一个遮光罩或者把PRX2_FILT调大一点。提示TFmini Plus 的 I2C 模式下如果通信失败飞控日志里会有PRX2相关的错误信息。可以先在 Mission Planner 的 MAVLink Inspector 里看一下有没有DISTANCE_SENSOR消息确认传感器是否正常工作。5. 避障功能验证与调试实录5.1 地面站实时数据监控方法参数配好之后不要急着让车跑先在地面站上看数据。Mission Planner 里打开 MAVLink Inspector找到DISTANCE_SENSOR消息可以看到每个传感器的当前距离、最小最大距离、类型等信息。如果数据正常你会看到距离值随着你手在传感器前面晃动而变化。QGroundControl 里可以在 Analyze 页面看实时数据或者用 MAVLink Console 输入listener distance_sensor命令查看。我一般会先用一个纸板在传感器前面慢慢移动观察距离值的变化是否平滑、是否跟得上。如果发现数据跳变或者不动先查接线和串口配置。5.2 避障触发的实测流程数据确认正常后可以开始实测避障触发。第一步把车放在空旷场地切换到 AUTO 模式给一个简单的航线航线上放一个障碍物。观察车在接近障碍物时是否减速、停止或者绕行。第二步如果避障没触发先检查AVOID_ENABLE是否打开然后看AVOID_MARGIN是否设得太大大于传感器探测距离。我遇到过AVOID_MARGIN设了 5 米但传感器最大距离只有 3 米结果永远触发不了。第三步如果避障触发太早或者太晚调整AVOID_MARGIN。触发太早说明 margin 太大触发太晚说明 margin 太小。第四步测试不同速度下的避障效果。速度越快需要的 margin 越大。我一般会在 1 米/秒、2 米/秒、3 米/秒三个速度下分别测试记录触发距离和实际停止距离。5.3 日志分析与问题定位ArduPilot 的日志是排查问题的利器。避障相关的数据在日志里的PRX和AVOID消息里。用 Mission Planner 的日志分析工具打开.bin日志找到PRX消息可以看到每个传感器的距离读数。AVOID消息里记录了避障状态和决策信息。如果发现避障行为异常先看PRX数据是否正常。如果PRX数据有问题说明是传感器或者接线的问题如果PRX正常但AVOID没反应说明是参数配置的问题。我遇到过一次 MR72 数据正常但避障不触发的情况查了半天发现是AVOID_ENABLE在切换模式时被重置了。后来发现是遥控器的一个开关通道映射到了避障使能误触了。所以检查参数的时候也要确认遥控器通道没有冲突。6. 常见问题与避坑经验6.1 传感器数据异常排查表现象可能原因排查方法距离值一直为 0接线错误或串口未配置检查 TX/RX 是否交叉串口协议和波特率是否正确距离值跳变严重供电不稳或滤波不足单独供电调大PRX_FILT距离值偏大或偏小安装角度不对或校准问题调整安装角度检查PRX_YAW_CORR传感器时好时坏线缆接触不良更换线缆检查接头MR72 近距离测不到盲区问题正常现象用 TFmini Plus 补盲6.2 避障逻辑不触发的几个原因避障不触发是最常见的问题我总结了几种情况第一种是AVOID_ENABLE没打开。这个参数在有些固件版本里默认是 0需要手动设成 1。第二种是飞行模式不对。避障只在 AUTO、GUIDED、RTL 等自动模式下生效MANUAL 模式下不会干预。第三种是AVOID_MARGIN设得比传感器最大距离还大。比如传感器最大 10 米margin 设了 15 米那永远触发不了。第四种是传感器数据没有被正确识别。可以在地面站看DISTANCE_SENSOR消息如果消息里没有你的传感器说明驱动没加载或者串口配置不对。第五种是多个传感器冲突。如果 MR72 和 TFmini Plus 都设了但PRX_TYPE和PRX2_TYPE搞反了固件可能读不到数据。6.3 多传感器融合的注意事项同时用 MR72 和 TFmini Plus 的时候有几个点要注意。第一是数据优先级。ArduPilot 会取所有传感器中最近的距离作为避障依据所以如果 TFmini Plus 测到一个很近的障碍物即使 MR72 没测到也会触发避障。这个逻辑是合理的但要注意 TFmini Plus 的窄视场角可能导致误触发——比如车经过一个低矮的台阶TFmini Plus 测到了但实际车能过去。第二是安装位置的一致性。两个传感器的探测区域最好有重叠这样数据融合更可靠。我一般让 MR72 的探测扇区覆盖 TFmini Plus 的正前方区域。第三是参数区分。PRX_和PRX2_的参数是独立的不要搞混。PRX_对应第一个传感器PRX2_对应第二个。6.4 实测中遇到的三个坑第一个坑是 MR72 的供电问题。我一开始直接从飞控的 5V 取电结果发现 MR72 工作时电流波动很大导致飞控电压不稳偶尔重启。后来单独用一个 5V BEC 给 MR72 供电问题解决。所以大功率传感器一定要单独供电。第二个坑是 TFmini Plus 的 I2C 地址冲突。我用 I2C 模式的时候发现 TFmini Plus 和另一个 I2C 设备地址冲突了导致两个设备都工作不正常。后来查了手册TFmini Plus 的默认地址是 0x10可以通过上位机软件改。如果要用 I2C 模式提前规划好地址分配。第三个坑是避障参数在固件升级后重置。有一次我升级了 ArduPilot 固件发现避障不工作了查了半天发现是升级后参数被重置为默认值。所以每次升级固件后都要重新检查一遍避障相关参数。7. 进阶调优与场景适配7.1 不同速度下的参数适配避障参数不是一成不变的需要根据你的实际运行速度来调。我一般会做一个速度-距离的对照表速度米/秒推荐 AVOID_MARGIN米推荐 PRX_FILT11.50.2522.00.333.00.455.00.5这个表是基于我的车体尺寸长约 1 米和反应时间约 0.5 秒算出来的。你的车如果更大或者反应更慢需要适当加大 margin。7.2 室内外场景的参数差异室内场景通常空间狭窄障碍物多避障需要更灵敏。我一般会把AVOID_MARGIN调小到 1 米左右PRX_FILT调小到 0.2让反应更快。但要注意太灵敏会导致频繁触发车走走停停。室外场景空间大障碍物少可以把AVOID_MARGIN调大到 3 到 5 米PRX_FILT调到 0.4 到 0.5让行驶更平滑。另外室外阳光强烈的时候TFmini Plus 的数据可能会受影响可以考虑在室外场景下主要依赖 MR72把 TFmini Plus 的权重降低或者暂时禁用。7.3 避障与路径规划的配合避障功能只是安全兜底真正的路径规划还是要靠 AUTO 模式下的航点任务。我一般会先用航点规划一条大致安全的路径然后用避障功能处理突发障碍物。如果要做动态避障比如障碍物会移动ArduPilot 的接近传感器避障只能做到停止或者简单绕行更复杂的动态避障需要上视觉或者更高级的规划算法。但对于大部分无人车/船场景接近传感器避障已经够用了。提示在 AUTO 模式下如果避障触发了停止车会停在原地等待障碍物消失。如果障碍物一直不消失车会一直停着。可以设置一个超时参数AVOID_TIMEOUT超时后执行 RTL 或者继续任务。8. 个人实操体会与后续扩展这套 MR72 加 TFmini Plus 的避障方案我在三台不同的无人车上都部署过稳定性总体满意。MR72 的远距离探测能力确实强TFmini Plus 的近距离精度也靠谱两者搭配基本覆盖了 0.1 米到 40 米的探测范围。如果让我给新手一个建议我会说先把单个传感器调通再上双传感器融合。我见过太多人一上来就接两个传感器结果数据乱了不知道是哪个的问题。先把 MR72 调好确认避障能触发再加 TFmini Plus这样排查问题简单得多。后续如果想扩展可以考虑几个方向。一是加装后向或者侧向的传感器实现全向避障。二是把避障数据和路径规划结合起来做更智能的绕行。三是用飞控的脚本功能Lua Scripting自定义避障逻辑比如根据障碍物距离动态调整速度。最后分享一个小技巧调试避障的时候把车架空用手转动轮子模拟行驶同时用纸板在传感器前面移动观察避障逻辑的反应。这样不用实际跑车就能快速验证参数效率高很多。