1. 从零讲清楚：ArduPilot 避障到底在解决什么问题
很多人第一次接触 ArduPilot 的避障功能，脑子里想的都是“装个雷达，车就能自己绕开障碍物了”。但实际动手之后才发现，事情远没有这么简单——雷达装上了，参数也改了，结果要么是车根本不动，要么是遇到障碍物直接撞上去，要么就是频繁误触发导致车在原地抽搐。这些问题的根源，往往不是硬件不行，而是对 ArduPilot 避障的整个数据链路没有搞清楚。
ArduPilot 的避障体系本质上是一个“感知—决策—执行”的闭环。感知层负责把物理世界中的障碍物距离信息转换成飞控能理解的数字信号；决策层根据这些距离数据判断是否需要改变当前的运动路径；执行层则通过调整油门、转向等输出让车辆实际避开障碍。这三个环节中任何一个出了问题，避障都会失效。而大多数教程只告诉你“把某个参数改成某个值”，却不解释这个参数在链路中处于什么位置、为什么必须这样设，导致你换个车型、换个雷达就完全不知道怎么调了。
这篇内容面向的是正在用 ArduPilot 做无人车或无人船、并且需要加入避障功能的开发者。无论你用的是 Pixhawk 系列还是其他兼容飞控，无论你选的是 MR72 毫米波雷达还是 TFmini Plus 激光雷达，底层的配置逻辑是相通的。我会把整个配置过程拆开，从雷达的通信协议选择、飞控参数的含义、到实际调试中会遇到的各种“玄学”问题，一步步讲透。你不需要有深厚的嵌入式背景，但需要对 ArduPilot 的基本操作（比如用 Mission Planner 连接飞控、修改参数、查看日志）有一定了解。
先说一下我自己的经历。我第一次给一辆差速转向的无人车配 TFmini Plus 避障时，按照网上找到的教程把PRX_TYPE设成了 4，AVOID_ENABLE设成了 7，满以为大功告成。结果推到户外一测，车对着墙壁就冲过去了，连减速都没有。后来查日志才发现，雷达数据确实进了飞控，但避障算法根本没触发，因为AVOID_MARGIN设得太小，而车的转弯半径又太大，算法判断“来不及避让”就直接放弃了。这个坑让我明白一个道理：避障参数不是孤立的，它和车体的运动学特性强相关。
提示：在开始配置之前，先确认你的飞控固件版本。ArduPilot 4.0 以后的避障框架和之前有较大变化，本文所有参数说明基于 4.3 及以上版本。用 Mission Planner 连接后，在“消息”标签页可以看到当前固件版本号。
2. 雷达选型与通信链路：MR72 和 TFmini Plus 的差异在哪
2.1 两种雷达的物理特性决定了适用场景
MR72 是一款 77GHz 毫米波雷达，探测距离远、穿透雾霾和雨雪的能力强，但角度分辨率相对较低，近距离盲区也更大。TFmini Plus 则是基于 ToF（飞行时间）原理的激光雷达，测距精度高、盲区小、响应快，但在强光直射或雨雾天气下性能会明显下降。这两种雷达在 ArduPilot 中的配置方式有相似之处，但参数细节差别很大。
选型的时候不要只看“哪个更准”，而要看你的应用场景。无人船在水面上跑，雾气和水花是常态，MR72 的毫米波穿透性优势就体现出来了；无人车在室内或园区道路行驶，TFmini Plus 的厘米级精度和快速响应更适合精细避障。我见过有人把 TFmini Plus 装在室外无人车上，中午阳光一照，测距直接从 3 米跳到 0.5 米，车就疯了。
| 对比项 | MR72 | TFmini Plus |
|---|---|---|
| 测距原理 | 毫米波调频连续波 | 激光飞行时间 |
| 最大探测距离 | 约 40 米（取决于目标 RCS） | 约 12 米 |
| 最小盲区 | 约 0.3 米 | 约 0.1 米 |
| 数据接口 | CAN / UART | UART / I2C |
| 刷新率 | 约 20Hz | 最高 100Hz |
| 受天气影响 | 较小 | 较大（雨雾、强光） |
| 典型 ArduPilot 参数 | PRX_TYPE=5（CAN）或自定义 | PRX_TYPE=4（UART） |
2.2 通信链路搭建中的关键细节
MR72 如果用 CAN 接口，接线相对简单，但需要在飞控中设置 CAN 参数。以 Pixhawk 6C 为例，MR72 的 CANH 接飞控的 CAN1_H，CANL 接 CAN1_L，然后在 Mission Planner 中设置CAN_P1_DRIVER=1和CAN_P1_BITRATE=500000。注意 MR72 出厂默认波特率可能是 500k 或 250k，必须和飞控设置一致，否则总线上一片死寂。
TFmini Plus 用 UART 接口时，接线是 TX 接飞控的 RX，RX 接飞控的 TX，供电 5V。这里有个很容易忽略的点：TFmini Plus 的 UART 电平是 3.3V，而某些飞控的串口电平是 5V，长期直连可能烧毁雷达。稳妥的做法是加一个电平转换模块，或者确认飞控串口支持 3.3V 电平。我自己的 Pixhawk 4 的 TELEM2 口是 3.3V 电平，直连没问题，但换到另一块飞控上就出过事。
在 ArduPilot 中，串口雷达需要指定对应的 SERIAL 端口和协议。比如 TFmini Plus 接在 TELEM2 上，就要设置SERIAL2_PROTOCOL=9（Lidar 协议），SERIAL2_BAUD=115（对应 115200 波特率）。MR72 如果走 UART，类似设置，但协议号可能不同，需要查 ArduPilot 的官方文档确认。
注意：每次修改 SERIAL 参数后必须重启飞控，否则协议不会生效。我见过有人改完参数直接测试，结果雷达数据死活进不来，折腾了半天才发现是没重启。
2.3 验证雷达数据是否真正进入飞控
雷达接好、参数设完，怎么确认数据真的进来了？最直接的方法是在 Mission Planner 的“飞行数据”页面添加一个“距离传感器”的显示项，或者打开“状态”标签页查看rangefinder1的数值。如果数值一直是 0 或者不变，说明数据链路有问题。
另一个方法是看日志。解锁后让车稍微动一下，然后下载日志用 Mission Planner 的日志分析工具打开，查看RFND消息。如果RFND消息里的Dist字段有变化，说明雷达数据确实进了飞控。如果RFND完全没有记录，那就是串口配置或接线的问题。
我自己的排查顺序是：先看雷达模块本身的指示灯是否正常闪烁（TFmini Plus 正常工作时会有蓝色指示灯），再用 USB 转串口工具直接连雷达，用厂商的上位机软件确认雷达能正常输出数据，最后才查飞控端的配置。这样能把问题范围快速缩小到飞控侧还是雷达侧。
3. ArduPilot 避障参数体系：从 PRX 到 AVOID 的完整链路
3.1 PRX 参数组：告诉飞控“障碍物在哪里”
PRX_TYPE是避障功能的入口参数，它决定了飞控从哪个来源获取障碍物距离信息。常用的取值包括：0 表示禁用，4 表示使用 UART 接口的激光雷达，5 表示使用 CAN 接口的雷达，还有其他的如 1 表示使用模拟电压输入等。这个参数设错了，后面所有避障参数都是白搭。
PRX_ORIENT参数定义雷达的安装方向。对于无人车，雷达通常朝前安装，这个值设为 0（前方）。如果雷达朝后装，就设为 180。这个参数影响的是避障算法对障碍物方位的判断，设错了会导致车往障碍物方向转而不是避开。
PRX_YAW_CORR和PRX_PITCH_CORR用于修正雷达安装时的角度偏差。比如雷达装的时候稍微偏了几度，可以通过这两个参数补偿。大多数情况下保持默认 0 即可，但如果发现避障时车总是往一侧偏，可以检查一下雷达是不是装歪了。
3.2 AVOID 参数组：决定“怎么避”
AVOID_ENABLE是一个位掩码参数，控制哪些避障功能被启用。Bit 0 启用避障，Bit 1 启用主动避障（Proximity），Bit 2 启用避障刹车。对于无人车，通常设为 7，即三个功能全开。但如果你发现车在障碍物前频繁刹停，可以尝试只开 Bit 0 和 Bit 1，关掉刹车功能。
AVOID_MARGIN是最关键的参数之一，它定义了车辆与障碍物之间需要保持的最小距离（单位：米）。这个值设得太小，车会贴得很近才避让，容易撞上；设得太大，车会在离障碍物很远的地方就开始绕，影响通行效率。对于 TFmini Plus 这种近距离雷达，建议设为 1.5 到 2.0 米；对于 MR72 这种远距离雷达，可以设到 3.0 到 5.0 米。
AVOID_BEHAVE参数决定避障行为。0 表示只绕行不刹车，1 表示绕行并刹车，2 表示只刹车不绕行。对于无人车，通常用 0 或 1。如果车体比较宽，绕行空间不足，用 2 更安全。
AVOID_ANGLE_MAX限制避障时的最大转向角度。这个值需要根据车体的最小转弯半径来设。如果设得太大，车会试图做一个它根本转不过来的弯，结果就是原地卡死。我的经验是，对于轴距 0.5 米左右的小车，这个值设为 30 到 45 度比较合适。
3.3 参数之间的联动关系：为什么单独调一个没用
很多人调避障的时候喜欢一个一个参数试，改一个测一次，这样效率极低。因为避障参数之间存在强耦合关系。比如你把AVOID_MARGIN设得很大，但AVOID_ANGLE_MAX设得很小，车虽然想避让，但转不过去，最后还是撞上。又比如PRX_TYPE设对了，但SERIAL2_PROTOCOL没设，雷达数据根本进不来，后面所有参数都是空谈。
我的建议是先把数据链路打通（确认RFND有数据），然后一次性设置一组基础参数，再根据实测表现微调。基础参数可以参考这个组合：PRX_TYPE=4，PRX_ORIENT=0，AVOID_ENABLE=7，AVOID_MARGIN=2.0，AVOID_BEHAVE=1，AVOID_ANGLE_MAX=40。这套参数在大多数小型无人车上都能跑起来，然后再根据实际情况调整。
| 参数名 | 推荐值（TFmini Plus） | 推荐值（MR72） | 说明 |
|---|---|---|---|
| PRX_TYPE | 4 | 5 | 雷达接口类型 |
| PRX_ORIENT | 0 | 0 | 雷达朝向 |
| AVOID_ENABLE | 7 | 7 | 启用避障+主动避障+刹车 |
| AVOID_MARGIN | 1.5~2.0 | 3.0~5.0 | 最小避让距离 |
| AVOID_BEHAVE | 1 | 1 | 绕行并刹车 |
| AVOID_ANGLE_MAX | 40 | 30 | 最大转向角 |
| SERIAL2_PROTOCOL | 9 | 9 | 串口协议（UART雷达） |
| SERIAL2_BAUD | 115 | 115 | 波特率 |
4. 实测调试：从“能动”到“好用”的完整过程
4.1 室内静态测试：确认避障逻辑正确
在户外跑之前，先在室内做静态测试。把车放在离墙壁 3 米左右的位置，解锁后用手推着车慢慢靠近墙壁，观察车的转向输出是否有变化。如果车开始往一侧转，说明避障逻辑在工作。如果车毫无反应，或者直接往前冲，说明参数有问题。
静态测试时可以用 Mission Planner 的“飞行数据”页面查看PSCN或AVOID相关的状态量。如果能看到AVOID状态从 0 变成 1，说明避障算法被触发了。如果一直是 0，那就要回头检查AVOID_ENABLE和雷达数据。
我自己的习惯是在静态测试时把AVOID_MARGIN临时设大一点，比如 3 米，这样车在离墙很远的地方就会有反应，方便观察。确认逻辑正确后再改回正常值。
4.2 户外动态测试：速度与避让距离的匹配
户外测试时，车速对避障效果影响很大。车速越快，从发现障碍物到需要开始避让的距离就越长。ArduPilot 的避障算法会根据当前速度动态调整避让时机，但前提是你的AVOID_MARGIN设得合理。如果车速 2m/s，AVOID_MARGIN只有 1 米，那从触发避让到撞上只有 0.5 秒，车根本来不及转。
一个粗略的经验公式是：AVOID_MARGIN至少等于车速（m/s）乘以 1.5。比如车速 1.5m/s，AVOID_MARGIN至少 2.25 米。当然这还要看车体的转向响应速度，转向越慢的车，需要的余量越大。
测试时建议从低速开始，比如 0.5m/s，确认能稳定避让后再逐步提速。每次提速后都要重新观察避让距离是否足够。如果发现车在避让时出现“犹豫”现象（先往左转一点又往右转），通常是AVOID_ANGLE_MAX设得太大，或者雷达数据有噪声导致算法反复判断。
4.3 常见异常现象与排查思路
现象一：车在无障碍物时也频繁转向。这通常是雷达误触发。TFmini Plus 在强光下容易把地面反射当成障碍物，可以尝试调整雷达的安装角度，让它稍微朝上一点，避免直射地面。MR72 如果灵敏度设得太高，也会把路边的草丛当成障碍物，需要在雷达上位机软件中调整灵敏度阈值。
现象二：车遇到障碍物直接停下不绕行。检查AVOID_BEHAVE是否设成了 2（只刹车不绕行）。另外，如果AVOID_ANGLE_MAX太小，算法判断无法绕行也会选择刹车。可以适当增大这个值，但不要超过车体实际能转的角度。
现象三：车绕行时撞到障碍物侧面。这说明避让距离不够，或者雷达的探测角度太窄，没有覆盖到侧面。TFmini Plus 的探测角只有几度，如果障碍物不在正前方，雷达可能探测不到。这种情况下可以考虑装多个雷达，或者换用探测角更宽的 MR72。
现象四：避障功能时好时坏。优先检查接线是否松动，尤其是 UART 的 TX/RX 线。我遇到过因为杜邦线接触不良导致雷达数据间歇性丢失的情况，车在避障时突然“失明”，直接撞上去。后来换成带卡扣的端子线就再没出过问题。
提示：每次修改避障参数后，建议先在地面推车测试，确认逻辑正确再解锁动力。直接上路测试风险太高，尤其是参数设错导致车全速冲向障碍物的情况并不少见。
5. 进阶话题：多雷达融合与动态避障的边界
5.1 多雷达配置：覆盖更多方向
单个雷达只能覆盖一个方向，对于需要全方位避障的场景，可以装多个雷达。ArduPilot 支持多个距离传感器，通过PRX_TYPE和PRX_ORIENT的组合来配置。比如前面装一个 TFmini Plus（PRX_TYPE=4，PRX_ORIENT=0），后面再装一个（PRX_TYPE=4，PRX_ORIENT=180），但需要注意两个雷达不能接在同一个串口上，需要分别接到不同的 SERIAL 端口。
多雷达配置时，每个雷达的SERIALx_PROTOCOL都要设为 9，但PRX_TYPE只需要设一次（因为它是全局参数）。实际上 ArduPilot 的多雷达支持是通过PRX_TYPE设为特定值（如 4）后，在PRX_ORIENT中指定不同方向来实现的。具体配置方式需要参考对应固件版本的文档，不同版本可能有差异。
5.2 动态避障的局限性
ArduPilot 的避障算法本质上是“反应式”的，它只能对当前探测到的障碍物做出反应，没有全局路径规划能力。这意味着如果障碍物是移动的（比如行人、其他车辆），避障效果会大打折扣。算法无法预测障碍物的运动轨迹，只能根据当前距离决定是否避让。
对于动态障碍物，可以适当增大AVOID_MARGIN，给算法更多反应时间。另外，降低车速也能显著提升动态避障的成功率。如果应用场景中有大量移动障碍物，可能需要考虑更高级的方案，比如结合外部计算机做视觉感知和路径规划，但这已经超出了 ArduPilot 本身的能力范围。
5.3 参数调优的边界与安全冗余
调避障参数的时候，很容易陷入“调到完美”的执念。但实际上，任何避障系统都有失效的可能。雷达可能被遮挡，算法可能判断错误，执行机构可能响应不及时。所以无论参数调得多好，都要保留安全冗余。
我的做法是：在AVOID_MARGIN的基础上再加 0.5 米作为实际设置值，比如计算需要 2 米，就设 2.5 米。另外，在车体上装一个物理急停开关，测试时随时准备切断动力。这些措施看起来简单，但关键时刻能避免很多损失。
还有一个容易被忽略的点：避障功能开启后，手动控制模式下的行为可能会变化。有些飞控在避障触发时会限制手动输入的转向幅度，导致操作手感变差。如果发现这个问题，可以在不需要避障的场景下通过遥控器开关临时关闭避障功能（通过AVOID_ENABLE的位掩码控制）。
6. 我踩过的那些坑与最终稳定方案
回顾我配置 ArduPilot 避障的整个过程，踩过的坑主要集中在三个方面：数据链路、参数耦合、以及测试方法。
数据链路的坑最隐蔽。有一次 TFmini Plus 的 TX/RX 接反了，雷达指示灯正常亮，但飞控就是收不到数据。我查了半天参数，最后用示波器看串口波形才发现根本没有数据发出。所以接线后一定要用串口工具确认雷达有输出，再查飞控端。
参数耦合的坑最耗时。我曾经为了让车在更远的距离开始避让，把AVOID_MARGIN从 2 米改到 4 米，结果车在避让时直接原地转圈。后来才明白，AVOID_MARGIN增大后，避让所需的转向角度也变大了，而AVOID_ANGLE_MAX没跟着调，算法判断“转不过去”就选择了持续转向，导致原地打转。
测试方法的坑最危险。有一次我在户外直接解锁测试，参数设错了，车全速冲向一棵树。幸好树前面有草丛缓冲，车没撞坏。从那以后，我所有的避障测试都先在室内推车验证，确认逻辑正确后才解锁动力，并且一定会在车前方放一个软质障碍物（比如纸箱）作为第一道防线。
最终我稳定下来的方案是：TFmini Plus 朝前安装，PRX_TYPE=4，SERIAL2_PROTOCOL=9，SERIAL2_BAUD=115，AVOID_ENABLE=7，AVOID_MARGIN=2.5，AVOID_BEHAVE=1，AVOID_ANGLE_MAX=35。车速限制在 1.2m/s 以内，在这个配置下，车能稳定避开正前方 2.5 米以外的障碍物，绕行过程平滑，没有出现原地打转或撞墙的情况。
如果你用的是 MR72，把PRX_TYPE改成 5，AVOID_MARGIN设到 4 米左右，其他参数类似。MR72 的探测距离远，可以适当提高车速，但要注意它的近距离盲区比 TFmini Plus 大，太近的障碍物可能探测不到，所以AVOID_MARGIN不能设得太小。
最后分享一个小技巧：在 Mission Planner 的“配置/调试”页面里，可以把常用的避障参数添加到“收藏”列表，这样调试时不用每次翻找。另外，每次修改参数后导出一次参数文件，万一调乱了可以快速恢复。这些习惯看起来不起眼，但在反复调试的过程中能省下大量时间。
