2.3cm间距里的定位魔法：4天线如何实现360°智能跟随定位

• 3基站TDoA在跟随场景是"能用但不好用"，单基站AOA才是"即装即用"
• 4个天线、2.3cm间距、相位差测角——物理原理不复杂，工程实现全是坑
• 爱蓝信360°基站已实现±3°测角精度、40Hz刷新率、<50ms端到端延迟
• 选型时记住：标称±3°的很多，能在仓库跑1小时不丢目标的很少

──────────────────────────────────────────────────

一、如果你正在做跟随机器人，这些坑你肯定踩过

如果你正在做跟随机器人、行李箱或推车，大概率遇到过这些场景：

• 人快走时，设备"追不上"，轨迹画蛇
• 转角或人群遮挡，信号一丢就原地打转
• 3个基站塞不进底盘，塞进去了振动就漂移

这些问题，TDoA解决不了——不是技术不行，是用错了场景。

跟随需要的是AOA：1个基站、4个天线、360°全向测角。

下面从物理原理到工程落地，说清每一层。

二、为什么TDoA在跟随场景"能用但不好用"

技术	原理	跟随场景的问题
TDoA	3个基站测时间差，双曲线交叉定位	移动场景装不了3个基站，时钟同步在振动/温度变化下漂移
TWR	1个基站测往返时间，算距离	只知道"2米远"，不知道"在前方还是后方"
AOA	1个基站测距离+测角度	单基站搞定，即装即用，振动不敏感

关键区分：TDoA在固定场景（工厂、仓库挂顶）已成熟商用，部分等厂商的TDoA方案稳定性很高。但在移动/跟随场景——机器人底盘、行李箱、推车——基站本身在动，同步和几何约束全崩。

跟随的硬指标：≥30Hz刷新率、<100ms延迟、厘米级精度。TDoA/TWR在移动场景够不着。

三、PDOA测角：2.3cm里的物理魔法

核心公式（远场近似）

Δφ = (2π/λ) · d · sin(θ)

θ = arcsin(Δφ · λ / 2πd)

• λ：波长（6.5GHz时≈4.6cm）
• d：天线间距，取λ/2 ≈ 2.3cm（防相位模糊）
• Δφ：两个天线接收同一信号的相位差

为什么间距必须是λ/2

相位差测量范围是[-π, +π]。如果 d > λ/2，真实相位差可能超过π，导致相位模糊——无法区分 θ和 π-θ。

代价： d越小，相位差越小，测角灵敏度越低。工程上靠高信噪比设计和多天线冗余组合补偿。

代价：d越小，相位差越小，测角灵敏度越低。工程上靠高信噪比设计和多天线对组合补偿。

从2个天线到360°全向

一对天线只能测一维角度（如水平方位角），且有镜像模糊。要360°全向，需要

• 相邻天线对间距 ≈ λ/2（2.3cm）
• 4天线圆阵直径 ≈ 1.5λ ≈ 7cm
• 所有天线联合接收，通过 MUSIC/ESPRIT等阵列信号处理算法，同时估计方位角（Azimuth）和俯仰角（Elevation）

合成三维方向向量，结合ToF测距 →三维极坐标定位。

工程现实：线阵在端射方向（θ≈±90°）分辨率极差。爱蓝信360°基站采用圆形阵列+多天线对冗余设计，配合MUSIC/ESPRIT等阵列信号处理算法，才实现全向±3°精度。

四、全链路：从UWB信号到轮子转动

UWB标签发射脉冲

↓

单基站4天线同时接收

↓

├─→ ToF测距：r = c × t（精度±10cm）

└─→ PDOA测角：θ = arcsin(...)（精度±3°）

↓

极坐标合成：(r,θ,φ) → (x, y, z)

↓

卡尔曼滤波（平滑瞬时噪声）

↓

PID运动控制：输出线速度v +角速度ω

↓

电机驱动 →底盘运动

延迟预算：为什么刷新率卡在40Hz

环节	延迟	瓶颈
UWB通信	2-3ms	协议帧间隔
PDoA解算	3-5ms	芯片内置MCU处理
ToF解算	1-2ms	并行处理
卡尔曼滤波	1-2ms	平滑算法
控制算法	5-10ms	简化PID
电机响应	10-20ms	选低惯量电机
总延迟	20-40ms	目标<50ms

实际串口输出波特率115200，数据帧包含Distance(cm)+Azimuth(°)+Elevation(°)+状态位，单帧约30字节。

串口理论带宽： 115200bps ÷ (10bit/byte) ÷ 30byte ≈384帧/秒

实际瓶颈在射频层： IEEE 802.15.4z标准帧包含前导码、SFD、PHR、数据载荷及帧间隔，有效数据时隙受限。工程上做到30-50Hz已足够跟随场景。

五、5个工程难点：我们怎么踩过来的

1.多径效应（最头疼）

问题： 信号经墙壁/金属反射，PDOA测的是合成信号相位差，不是直达径。

解法：

• 首径检测： UWB脉冲2ns宽度，60cm空间分辨率，锁定最早到达分量
• NLOS识别与抑制： 通过CIR（信道冲激响应）波形分析，判断是否存在直达径
• 卡尔曼滤波： 利用运动连续性平滑瞬时干扰

效果： 组合可将角度误差从±10°压到±3°

爱蓝信规格书确认：数据输出自带卡尔曼滤波，走廊实测1小时角度漂移<±5°。

2.天线相位一致性（隐蔽杀手）

问题：4个通道的LNA/混频器/ADC有固有相位差，且随温度漂移。

解法：

• 出厂微波暗室校准（0°/30°/60°/90°建立查找表）
• 在线温度补偿（温度传感器+补偿表）
• 校准后残余误差：±0.5°

3.速度预测（蛇形轨迹的根源）

问题：人跑步3-4m/s，30Hz刷新率下每帧移动13cm，纯位置反馈有相位滞后，轨迹呈"蛇形"。

解法：扩展卡尔曼滤波（EKF），状态向量[x, y, vx, vy, ax, ay]，观测[r,θ,φ]，输出预测位置用于提前控制。

4.遮挡恢复（决定体验下限）

问题：人群遮挡、转角导致信号中断100ms-数秒。

解法：多传感器融合

• UWB正常 → 直接用
• 短暂丢失（<200ms）→ IMU积分推算
• 长时间丢失 →搜索模式（原地旋转扫描）
• 超声波/激光雷达 →独立避障层

选型底线：遮挡后不能乱跑。有些方案信号一丢就原地打转，用户直接退货。

5.多目标并发（容易被忽视）

问题：多个标签同时工作，信号碰撞。

解法：TDMA时分复用

• 每标签分配2ms时隙
• 4标签理论帧周期8ms，每标签刷新率125Hz
• 实际：加上帧开销（前导、SFD、帧间隔）和基站处理延迟，有效刷新率分频至30-50Hz
• 或FDMA频分复用（多信道并行，成本更高）

六、选型4个硬指标（附验证方法）

指标	验证方法	底线
测角精度 vs角度范围	要角度-精度曲线图，关注θ=0°/±45°/±90°	正面±60°≤±3°，全向≤±5°
刷新率 vs 延迟	问单标签和4标签并发分别多少，要端到端延迟数据	单标签≥30Hz，延迟<100ms
多径抑制	是否首径检测？走廊/仓库实测报告？	必须支持，走廊漂移<±5°
多传感器融合	是否IMU辅助？遮挡后行为？	必须支持，遮挡后不能乱跑

记住这句话：标称±3°的很多，能在仓库跑1小时不丢目标的很少。要实测报告，不要PPT参数。

七、一句话总结

单基站360°跟随 = 1个基站 + 4个天线 + PDOA相位差测角 + ToF测距 +卡尔曼滤波 + PID控制。

不是黑科技，是五层技术的叠加。每层都有坑，坑坑不一样。

如果你正在评估跟随方案，建议先做这3件事：

1.让供应商拿设备到你现场测，不要看实验室数据

2.要走廊/仓库1小时连续跟踪的视频记录

3.问清楚遮挡200ms后的恢复行为——这是体验的分水岭

──────────────────────────────────────────────────

技术声明：本文公式和数据基于公开文献、IEEE标准及典型工程实践整理，部分实测数据引用爱蓝信360°基站规格书。具体数值因芯片方案、天线设计、算法实现不同而有差异。标注"典型值"的内容不代表任何具体产品的性能承诺。实际应用请以现场勘测和实测为准。