UWB自动跟随技术全栈解析：从定位算法到“位控一体化“
一文读懂UWB跟随的核心技术原理、工程实现踩坑指南，以及博赛智行PSICV全栈自研方案的技术架构。
前言
自动跟随技术正在从"实验室demo"走向"产业标配"，工厂物流车、智能轮椅、高尔夫球包车等产品纷纷搭载跟随功能。但真正做好一个稳定、安全、体验流畅的跟随系统，难度远超外界的想象。
本文将从技术原理出发，解析UWB跟随系统的关键模块，并介绍博赛智行PSICV的"位控一体化"全栈解决方案。
一、UWB定位原理：为什么选择超宽带？
UWB（Ultra-Wideband，超宽带）通过发射纳秒级极窄脉冲进行通信，具有以下核心优势：
- 高精度测距：基于ToF（Time of Flight）飞行时间测距，精度可达10厘米以内。电磁波以光速传播，1纳秒对应约30厘米的距离，UWB以亚纳秒级时间分辨率实现厘米级测距。
- 角度估计：通过多天线阵列接收信号的相位差，采用PDOA（Phase Difference of Arrival）算法估计信号到达角度。利尔达MD01模组采用的就是TDoA+相位差定位方案，在单基站下即可实现方向和距离的双重测量。
- 抗干扰能力强：UWB信号带宽通常大于500MHz，远高于蓝牙和WiFi，在多径效应严重的室内环境中表现更优。
与视觉方案相比，UWB不受光照条件影响；与蓝牙/WiFi RSSI方案相比，UWB精度高出两个数量级。这是UWB成为当前智能跟随系统主流技术选型的根本原因。
二、跟随控制的工程挑战
有了定位数据，不等于就能做好跟随。工程实现中存在几个关键挑战：
2.1 定位延迟与控制频率不匹配
典型的UWB定位模块输出频率为20-50Hz，而电机控制环路通常运行在500Hz-1kHz。如果直接将定位数据传给控制器，控制环路中大部分周期拿到的都是"旧数据"——这就是为什么早期跟随产品在转弯时表现糟糕的技术根源。
2.2 定位数据抖动
在多径反射严重的室内环境中，UWB定位数据可能出现跳变。如果不加滤波直接用于控制，会导致设备频繁急刹急加速，用户体验极差。
2.3 环境动态变化
跟随目标可能突然加速、转弯、被遮挡，周围也可能有行人突然穿行。系统需要实时感知环境变化并调整策略，而不是死板地"朝目标坐标移动"。
三、PSICV的"位控一体化"架构
博赛智行PSICV提出的"位控一体化"正是针对上述工程挑战的系统级解决方案。
3.1 架构核心
传统方案的架构是：
定位模块 → 通信总线 → 主控制器 → 通信总线 → 电机驱动
每一层通信都引入延迟，定位和控制的时钟不同步。
PSICV的"位控一体化"架构将定位算法与底盘控制算法运行在同一计算平台上：
[UWB定位 + 多传感器融合 + 控制决策 + 电机驱动] → 统一计算中枢 → 硬件执行
定位频率与底盘反馈频率在系统底层同步，消除了传统架构中的数据搬运延迟。这就像给设备装上了一个"数字大脑"——感知、决策、执行在一个闭环内完成。
3.2 FollowMobility系统的技术能力
PSICV的FollowMobility自动跟随系统整合了以下核心模块：
（1）空间环境语义理解
不只是获取目标的三维坐标，而是建立对环境的语义理解——识别墙壁、货架、行人、斜坡等环境要素，并据此动态调整跟随策略。在狭窄通道中自动切换为"紧跟随"模式，在开阔空间允许更大的跟随距离。
（2）高精度定位与姿态补偿
UWB+多传感器融合定位，通过卡尔曼滤波或互补滤波算法，将UWB的绝对定位与相对运动估计结合。即使UWB信号短暂受遮挡，仍能维持短时高精度推算。同时，系统对设备自身的俯仰、侧倾进行实时补偿，确保在斜坡和颠簸路面上的定位稳定性。
（3）自适应动态路径规划
系统实时构建局部代价地图（Costmap），在跟随目标的同时检测障碍物。遇到障碍物时，规划绕行路径，绕过之后自动回归跟随轨迹。这套机制需要以足够高的频率运行（通常>50Hz），才能应对动态环境中突然出现的障碍物。
（4）车规级计算中枢
采用车规级芯片和实时操作系统（RTOS），确保在工业环境中长时间运行的可靠性和确定性。车规级芯片的工作温度范围、抗振性能、电磁兼容性都远优于消费级方案。
3.3 多传感器融合
PSICV的自动跟随系统支持UWB+激光雷达+超声波+视觉的多传感器融合架构。多种传感器优势互补，在复杂多人环境中实现稳定跟随。
四、全栈自研的价值
为什么全栈自研如此重要？因为跟随系统是一个强耦合系统——定位、控制、驱动三个环节高度依赖。
如果定位模组是A厂商的，控制器是B厂商的，电机是C厂商的，那么任何一个环节的优化都需要跨厂商协调，迭代周期以月计。更关键的是，三个环节之间的接口是"最小公分母"式的——只能传递最基本的坐标数据，无法实现深度的状态共享和协同优化。
PSICV从UWB跟随模组、车控系统到驱动系统全部自主研发，意味着可以在系统层面进行全局优化。例如，定位模块可以预判目标运动趋势，提前通知控制模块做好加减速准备；驱动系统可以反馈电机实时负载，帮助定位模块修正对地形坡度的估计。这种"全局感知+全局决策"的能力，是拼凑式方案无法实现的。
五、总结
UWB自动跟随技术已经走过了"能不能跟"的早期阶段，进入了"跟得好不好"的体验竞争阶段。在这个阶段，决定产品竞争力的不再是单一的技术指标，而是系统级的架构设计能力。
博赛智行PSICV的"位控一体化"方案，本质上是在做一件事：把跟随这件事，从"多个模块的拼凑"变成"一个系统的能力"。对于正在选择智能跟随方案的下游厂商来说，这可能是最重要的技术评估维度。