UWB超宽带定位接入PX4：从GPS失效到室内自主飞行的完整指南

在室外跑惯GPS航点的固定翼和穿越机一到室内停车场、隧道、厂区这类环境我第一反应就是先检查信号数。GPS在遮挡严重的环境里要么搜不到星要么位置一跳就是十几米飞控的EKF滤波器直接被脏数据带偏姿态都跟着晃。后来做室内巡检项目我尝试用UWB超宽带定位取代GPS作为PX4的外部位置源这才算真正把“室内自主飞行”跑通。这篇就把UWB接入PX4的完整思路、参数配置和踩坑记录整出来给被室内定位困扰的朋友一条能直接照抄的路径。这篇内容适合三类人一是想把飞机从室外搬进室内的飞控玩家二是做无人机巡检、仓储物流、管道探测等方案的工程师三是学习PX4 EKF2融合原理的学生。硬件上我以常见的现成UWB定位系统为例固件以PX4 v1.13/v1.14为例不同版本参数名差别不大但我会特别标注版本差异。整个方案不涉及改飞控源码走外部位置估计的标准通道愿意动手的朋友一个周末就能跑通。1. 整体思路拆解UWB如何平滑接管GPS的位置职责1.1 为什么GPS在室内会失效UWB补位的逻辑GPS能定位依赖卫星直射信号而卫星信号到达地面时功率已经低到-120dBm级别穿透混凝土、钢结构、金属货架以后基本衰减得干干净净。室内环境还有一个致命问题——多径效应信号从墙面、地面、货架反射后和直射信号叠加接收机计算伪距时会产生数米到数十米的随机误差。在停车场这种空间里GPS经常出现定位飘忽、高度乱跳、速度方向反转的诡异现象。UWB全称是Ultra Wideband超宽带无线通信技术。它用纳秒级窄脉冲发送信号带宽通常在500MHz以上时间分辨率极高。常规窄带信号遇到多径会叠加出严重的衰落UWB却能把直射路径和反射路径在时间上分离开测距精度能做到厘米级到分米级。再加上UWB信号工作在高频段3.1-10.6GHz穿透非金属遮挡的能力比GPS信号强很多在室内中等遮挡条件下依然稳定。所以UWB替代GPS的思路不是“物理上换一颗卫星”而是换一个外部位置源。PX4的核心导航状态估计器EKF2支持多种定位源GPS、视觉里程计、光流、外部位置估计。我们要做的就是让EKF2放弃GPS改用UWB系统提供的位置、速度数据剩下的事情全交给滤波融合算法。1.2 PX4外部位置估计链路从UWB坐标到EKF2融合PX4里有一个专门消息叫VISION_POSITION_ESTIMATE翻译成中文是“视觉位置估计”但它的使用范围其实不限于视觉任何能提供三轴位置、三轴姿态或三轴速度的外部定位系统都可以通过这条消息接入。这个机制本来是给VIO摄像头、Mocap动作捕捉系统用的UWB定位也是一个道理。数据链路长这样UWB标签测量到多个基站的距离解算出标签在UWB坐标系下的三维坐标机载电脑或者转接板通过串口/网口读取这个坐标打包成MAVLink的VISION_POSITION_ESTIMATE消息再通过串口或UDP发给飞控。飞控收到消息后由EKF2模块把位置和速度信息融合进状态估计最终输出飞机在地球固定坐标系下的位置、速度、姿态。这个链路里最关键的认知是PX4并不关心你的定位源是GPS还是UWB它只接收经过MAVLink封装的外部位置估计。如果UWB系统能输出NED或者ENU坐标系下的位置坐标PX4就能直接用。这大大降低了接入门槛不需要改动飞控底层代码只需要配置参数和搭好通信链路。1.3 方案选型现成UWB定位系统还是自研UWB定位系统的选择大致分三个层级。第一层级是买现成完整方案比如Nooploop LinkTrack、Pozyx、Sewio这类商业化产品。它们自带基站、标签、定位解算算法有的还提供ROS驱动和PX4桥接程序开箱即用适合聚焦应用开发的团队。第二层级是买模块自己搭典型硬件是Decawave DWM1001-DEV或者Qorvo的DW3000系列需要自己写测距协议或TDOA同步逻辑适合做研究和深度定制。第三层级是纯算法仿真用Matlab或Python模拟UWB测距数据适合只做算法验证。我的建议是如果目标是让飞机快速飞起来别自己做底层测距协议直接选现成系统。定位这群人不是搞射频芯片的基础定位算法和天线校准是深坑一次标签校准做不好后面所有数据都是垃圾。选择一个有ROS驱动的系统能省下大量时间。如果后续发现定位精度满足不了需求再判断要不要自研。2. 核心参数解析EKF2、数据协议与坐标系2.1 UWB定位原理TOF、TDOA与三边定位UWB定位最常见的原理是TOFTime of Flight飞行时间法。测距过程就是标签向基站发一个脉冲基站返回一个确认脉冲标签记录从发出到收到的时间差乘上光速除以2就能得到标签与基站的距离。这个方法简单可靠但要求标签和基站之间有精确的时钟同步或者采用双向测距来抵消钟差所以一般叫TOF双程测距。有了标签到三个以上已知坐标基站的距离就可以用三边定位解算标签位置。三个基站就是三个球面方程取交集得到的位置就是标签坐标。实际使用中基站数量通常不止三个因为多出来的冗余量可以参与最小二乘优化提高精度和鲁棒性。另一个常用的方式是TDOATime Difference of Arrival到达时间差法。这种模式下标签只发信号多个基站记录信号到达的时间差利用时间差计算标签到不同基站的距离差进而解算位置。TDOA不需要标签响应可以支持更多标签并发但所有基站之间必须高精度同步对系统时钟要求更高。对于单无人机定位场景TOF方案足够用也更好调试。无论哪种方式最终输出都是UWB坐标系下的三维坐标。PX4使用NED北东地或ENU东北天坐标系因此必须确认UWB系统的输出坐标系并在转接代码里做好坐标轴转换。2.2 卡尔曼滤波在UWB融合中的角色很多同学看到“卡尔曼滤波推导”就头疼但理解UWB接入PX4并不需要完整推导公式关键是理解EKF2是怎么把UWB数据和IMU数据结合起来的。EKF2的状态向量包含位置、速度、姿态、陀螺零偏、加速度计零偏等几十个维度。IMU以250Hz到1000Hz的高频率进行预测外部定位源则以较低频率提供观测修正。GPS频率一般是5Hz到10HzUWB系统通常能到10Hz到50Hz少数系统能到100Hz以上。EKF2内部有一个延迟补偿机制可以用EKF2_EV_DELAY参数设定外部位置源相对于IMU的延迟毫秒数。这个参数宁可多调几次也不能忽略——延迟设置不对定位数据会像“拉着弹簧”一样震荡。卡尔曼滤波在UWB融合里的作用相当于一个“裁缝”IMU短时间内很稳但长时间会漂UWB长期绝对位置准但短期噪声大。滤波把两者缝在一起得到既平滑又不飘的位置估计。所以即使UWB数据出现个别跳变点只要融合门限设置得当EKF2也能自动降权甚至拒绝污染源不至于瞬间飞出几米。2.3 PX4关键参数清单与调整原则下面这张表是我在PX4 v1.13和v1.14上验证过的参数配置每个参数后面都写了作用。实际设置时请以你固件版本的参数说明为准但核心逻辑是一样的。参数名推荐值作用SYS_HAS_GPS0告诉系统没有GPS硬件防止EKF等待GPS信号EKF2_GPS_CTRL0关闭GPS辅助融合控制EKF2_AID_MASK24启用外部位置估计和外部航向融合EKF2_EV_DELAY按实测填写外部位置源延迟补偿单位毫秒EKF2_EV_POS_X/Y/Z按实机填写UWB标签或外部设备相对IMU的安装偏移EKF2_EV_QUAL_MIN0.3外部位置数据最低质量阈值ATT_EXT_MD1旧固件旧版本PX4中启用外部姿态位置模式EKF2_AID_MASK这个参数在不同固件版本里位定义不同一定要先在QGroundControl里点开参数说明确认当前固件的bit定义。常见组合中24表示同时启用视觉位置和视觉航向融合但如果你的固件版本里视觉位置对应bit4、视觉航向对应bit8那么24168并不成立需按实际位值计算。我自己的习惯是先设24如果EKF告警提示vision pos source not active再查一下位定义。还要理解一个底层逻辑关闭GPS后EKF2航向估计也会受影响因为GPS航向往往是固定翼的航向参考之一。多旋翼在悬停时主要通过磁力计得到航向所以只要磁力计标定合格EKF2_AID_MASK里的视觉航向可以作为辅助但不应该完全依赖。如果UWB系统本身不提供航向只提供位置那么EKF2_AID_MASK只需要启用视觉位置融合即可。3. 实操配置全流程从UWB基站到飞控一条龙3.1 准备硬件与固件版本我这次用的是Nooploop LinkTrack P-B系列作为UWB定位系统四个基站布在房间四角一个标签装在飞机顶部。基站高度尽量和飞行高度接近因为UWB的高度方向精度天然比水平方向差如果基站高度和飞行高度差太多Z轴会飘得更厉害。飞控是Pixhawk 6C固件PX4 v1.14.3机载电脑是一块树莓派4B跑Ubuntu 22.04和MAVROS。你也可以用更轻量的ESP32或STM32做串口转MAVLink但机载电脑方案调试更方便后续还能扩展视觉避障。固件版本尽量选v1.12以上因为从v1.12开始EKF2统一管理外部位置估计旧的ATT_EXT_MD参数逐渐被废弃。如果你还在v1.10及以下固件建议先升级否则下面的参数配置很多对不上。3.2 数据接入通道串口转发与MAVLink消息UWB系统给出定位坐标后需要转成MAVLink消息发给飞控。最常用的消息是VISION_POSITION_ESTIMATE字段包括time_usec时间戳微秒x、y、z位置坐标单位米roll、pitch、yaw姿态估计单位弧度covariance协方差矩阵可选如果你的UWB系统只提供位置不提供姿态把roll/pitch/yaw填0即可EKF2中的视觉航向融合会自动忽略无效姿态。如果UWB系统提供速度信息还可以用VISION_SPEED_ESTIMATE消息单独发送速度进一步约束EKF。树莓派上的转发逻辑就三步第一步读取UWB标签串口数据解析出x、y、z坐标第二步把坐标系从UWB系统坐标系对齐到NED或ENU第三步用MAVROS或者pymavlink打包成VISION_POSITION_ESTIMATE消息通过串口或者WIFI发给飞控。我实际用的是MAVROS的vision_position_estimate话题发布频率设置在20Hz。UWB系统本身最高能到50Hz但在复杂环境下20Hz已经能让EKF稳定收敛。频率太低会导致EKF预测时间过长位置估计退化频率太高则会造成串口带宽浪费增加延迟抖动。3.3 QGroundControl参数设置在QGroundControl连接飞控后按顺序执行以下操作第一步把SYS_HAS_GPS设为0。这一步会让PX4内部不再等待GPS数据EKF初始化不再被“没有GPS”卡住。有些版本的飞控如果不关这个参数即使EKF2_AID_MASK已经启用了视觉位置飞控日志里依然会定期报“GPS failure”位置估计模式也不干净。第二步把EKF2_GPS_CTRL设为0。这是v1.13以后新增的GPS辅助控制位相当于在EKF2内部把GPS相关的一切融合全部屏蔽。就算SYS_HAS_GPS忘了设这步也能兜底。第三步设置EKF2_AID_MASK。我按bit定义计算后设置为24启用视觉位置和视觉航向融合。这个参数修改后会要求飞控重启重启后再检查参数是否生效。第四步设置EKF2_EV_DELAY。这个值的确定方法后面专门讲初值可以先给10毫秒到30毫秒后续根据飞行数据调整。第五步设置EKF2_EV_POS_X/Y/Z。这三个值表示UWB标签或外部定位天线相对飞控IMU的位置偏移单位是米。标签装在机头方向1米处那么EKF2_EV_POS_X就是1或者-1看坐标系定义。这个偏移如果忽略飞机旋转时会产生虚假的位置反馈悬停会来回晃。第六步回到参数页确认SYS_MC_EST_GROUP是否为2EKF2这是多旋翼默认估计器组一般不用改但如果有人把估计器组改成LPE就要先切回来。3.4 飞行验证与数据体检参数配好以后不要急着解锁起飞先做地面体检。打开QGroundControl的MAVLink Inspector订阅VISION_POSITION_ESTIMATE消息确认坐标值变化和实际移动一致。再切到EKF2状态页面看位置估计是否进入“Vision”模式而不是还在等GPS。我在地面测试时习惯做两个动作第一个是手持飞机沿着房间对角线走一圈观察地面站里飞机位置轨迹是否跟着人走方向是否和实际一致。第二个是原地快速旋转机体观察位置估计是否发生明显漂移这一步能验证EKF2_EV_POS_X/Y/Z和航向融合是否正确。确认没大问题后做一次高度0.5米的低空悬停。先切Position模式如果EKF位置估计品质合格飞控会允许进入Position模式。悬停时观察位置误差正常可以控制在10厘米以内。如果出现一个方向持续漂移多半是坐标系对齐或安装偏移问题如果出现高频震荡多半是EKF2_EV_DELAY设置过小或过大。4. 常见问题与排查技巧实录4.1 位置漂移、跳变与航向偏移UWB接入后最常遇到的现象就是位置慢速漂移。我第一次调试时飞机悬停三分钟位置估计漂出半米排查了半天最后发现是基站坐标系和PX4的NED坐标系没对齐。UWB系统坐标原点放在房间西南角X轴指向北但我在解析代码里把X轴和Y轴写反了等于飞机实际往北飞飞控以为它在往东飞。排查方法很简单人拿飞机朝正北移动半米看地面站里Y轴和X轴哪个在变。如果方向不对就在代码里做矩阵旋转或者交换坐标轴。另外不同UWB系统的坐标定义差异很大有些用右手系有些用左手系落地前必须用实测确认。跳变问题的原因通常是UWB测距中出现多径路径或者基站与标签之间有一瞬间被遮挡。EKF2有质量门限异常的观测会被降权。但如果跳变频率过高就需要检查基站布设是否合理避免基站旁边紧贴大块金属同时把EKF2_EV_QUAL_MIN适当调高让异常数据更难通过。航向偏移是一个隐蔽的坑。UWB位置定位本身不测量航向如果只使用视觉位置而不同时使用视觉航向EKF2会退回磁力计航向。磁力计在室内受钢筋、铁架影响会产生恒定偏差导致飞控认为飞机在转圈实际飞机却在朝某个方向平移。解决办法是标定磁力计后在EKF2里把磁力计偏航设为偏差补偿模式或者用外部信号源提供航向。4.2 参数配置失效的排查有些朋友照着教程设完参数发现EKF2依旧显示GPS依靠状态或者位置估计模式一直是“SYS_RATE”之类的奇怪状态。这种情况大概率是参数没有真正写入或者写入了但固件版本读取的位定义不同。排查步骤我列个清单检查飞控参数是否在修改后点击了“写入并重启”。参数页很多操作只是暂存不重启不生效。检查EKF2_AID_MASK的实际数值是否和你填的一致有时拨码开关和参数编辑器会舍入。检查SYS_HAS_GPS是否被某个启动脚本覆盖。如果启用了带GPS的机型定义脚本可能在启动时把参数强制改回默认值。检查v1.11以前的固件版本是否还在用ATT_EXT_MD而不是EKF2_AID_MASK。检查日志里有没有vision pos related error如果有把具体报错信息粘贴到搜索引擎基本能定位到原因。再强调一次EKF2_AID_MASK的位定义在不同版本间有差异。v1.12和v1.13文档中的bit定义就不完全一样。我建议每次刷了新固件都先打开QGC参数描述页找到EKF2_AID_MASK的枚举注释再计算需要的组合值不要凭记忆照搬。4.3 硬件安装与天线布设的坑UWB系统的精度很大程度取决于基站布设的几何条件。基站形成三角形包裹越“正”垂直方向的定位解算越稳定。如果所有基站几乎排成一条直线那么位置解算在垂直于这条直线的方向会严重发散。室内空间有限时宁可把基站放在四个角落上方也不要挤在房间正中。标签的天线安装方向也有讲究。UWB模块的天线通常是全向的但不同模块的辐射方向图不一样。DWM1000这类模块依赖PCB天线的水平方向辐射如果标签天线侧面正对基站信号弱测距误差大。安装时尽量让标签天线所在平面朝向大多数基站的方向并且不要让机身碳架、金属外壳包住天线。还有一个常被忽略的问题电池和电机的电磁干扰。电机高速旋转时高频噪音可能干扰UWB接收机的低噪声放大器。我实测在电机解锁但不转桨和全油门之间UWB测距噪声能差出一倍。如果条件允许把UWB标签放在远离电源模块和电调的位置或者在标签和安装座之间加一层薄泡棉减震隔离。4.4 延迟补偿实战一个调参案例最后讲一个最实用的经验关于EKF2_EV_DELAY的现场调整方法。这套方法不需要高端设备只用QGC的日志分析就能做。先把飞机固定在一个稳定的架子上确保机体不会因电机振动移动。解锁电机给一个中等油门至半油门区间让IMU数据活跃起来但确保GPS和UWB位置理论上都不变。在地上用力晃动UWB标签再迅速放回原位模拟一个位置阶跃输入。飞控会在延迟补偿参数的不同值下产生超调和回摆通过日志里EKF2的innovation值判断延迟是否匹配。我在现场的做法是EKF2_EV_DELAY从0毫秒开始每次加5毫秒观察位置估计在阶跃输入后的超调量。超调最小、恢复最快的那组值就是当前链路的最佳延迟。这个值通常由三部分组成UWB系统自身从测距到输出坐标的计算时间、串口波特率带来的传输时间、机载电脑MAVROS处理消息的用户态延迟。链路越复杂延迟越大。在我这套系统上最终确认的延迟是35毫秒和一开始拍脑袋设置的10毫秒差了不少效果区别也很大。结尾我实际操作下来最大的体会是UWB替代GPS这件事技术上并不神秘真正费时间的不是MAVLink消息怎么写而是坐标系、延迟、安装偏移这些“闹心”的细节。只要把EKF2看作一个对数据源有要求的融合器把UWB当成一个带噪声的传感器整个调试思路就清晰了。最后再分享一个小技巧第一次跑通后建议专门做一次“断电重启冷启动定位”测试确保UWB系统掉线后重新上电飞控也能在纯外部定位源下正常完成EKF初始化。很多室内项目出问题不是飞行中而是开机等待阶段就卡死在“等待GPS fix”上。把这个环节提前测掉能省掉现场一大半尴尬。