3、UWB测距原理（TOF/TDOA）：飞行时间测距与到达时间差的数学推导与误差分析
聊到UWB，大家最关心的就是它怎么测距。说白了，UWB能测准，靠的就是时间——电磁波在空气中飞行的速度是固定的（光速），只要测出飞行时间，距离就出来了。这个思路听起来简单，但实际落地时坑不少。我最早接触UWB时，以为只要发个脉冲、算个时间差就完事了，结果被多径和时钟漂移折腾得够呛。
这一章，我们重点拆解两种主流测距方法：TOF（飞行时间测距）和TDOA（到达时间差）。我会把数学推导掰开揉碎，再结合项目中的实际误差案例，帮你避开那些我踩过的坑。
3.1 飞行时间测距（TOF）——双向测距的数学本质
TOF的原理很直观：设备A发一个信号，设备B收到后回一个确认，A记录下从发出到收到回复的总时间，除以2就是单程飞行时间。但这里有个关键问题——两个设备的时钟不同步，直接除2会引入误差。
实际工程中，我们用的是双向测距（Two-Way Ranging, TWR）。来看一个简化模型：
- 设备A在时间 \( T_{A1} \) 发送Poll帧
- 设备B在时间 \( T_{B1} \) 收到Poll帧
- 设备B经过处理延迟 \( T_{reply} \) 后，在 \( T_{B2} \) 发送Response帧
- 设备A在时间 \( T_{A2} \) 收到Response帧
那么，信号在空中的单程飞行时间 \( T_{prop} \) 为：
T_prop = ( (T_A2 - T_A1) - (T_B2 - T_B1) ) / 2为什么这么算？因为 \( T_{A2} - T_{A1} \) 包含了飞行时间的两倍加上B的处理延迟，减去B的处理延迟后，再除以2就是单程时间。这个公式假设A和B的时钟频率完全一致——但现实中没有两个晶振是完全一样的。
关键点：TOF的精度瓶颈不在时间分辨率，而在时钟漂移。UWB脉冲的时间分辨率可以做到纳秒级甚至皮秒级，但晶振的ppm（百万分之几）误差会直接累积到测距结果中。
我在一个仓储机器人项目中遇到过这种情况：两台设备用同一批晶振，标称20ppm，理论上1微秒的飞行时间误差只有20皮秒，换算成距离约6毫米。但实际测试时，温度从25℃升到60℃，晶振漂移翻了一倍，测距误差直接飙到2厘米以上。后来我们加了温度补偿算法，才把精度拉回来。
3.2 到达时间差（TDOA）——不需要同步发射端
TDOA的思路和TOF完全不同。它不关心信号什么时候发的，只关心信号到达不同基站的时间差。你想想看，如果三个基站的位置已知，信号到达基站A和基站B的时间差为 \( \Delta t_{AB} \)，那么信号源一定位于以A、B为焦点的双曲线上。再引入第三个基站C，两条双曲线的交点就是信号源的位置。
数学上，TDOA的定位方程是这样的：
设基站i的坐标为 (x_i, y_i)，信号源坐标为 (x, y)，信号到达基站i的时间为 t_i。
则到达时间差 Δt_ij = t_i - t_j。
对应的距离差 Δd_ij = c × Δt_ij = sqrt((x - x_i)^2 + (y - y_i)^2) - sqrt((x - x_j)^2 + (y - y_j)^2)这个方程组是非线性的，通常用最小二乘法或Chan算法求解。我建议在实际项目中先用Chan算法得到一个初始解，再用泰勒级数展开迭代优化，收敛速度会快很多。
个人经验：TDOA最大的优势是终端设备不需要发射信号——它只需要广播一个UWB脉冲，所有基站被动接收。这意味着终端可以做得非常省电，适合标签类应用。但代价是基站之间必须严格同步，时钟偏差超过1纳秒，定位误差就会超过30厘米。
3.3 TOF vs TDOA：选型对比
很多初学者会问：到底用TOF还是TDOA？我的回答是：看场景。下面这张表是我根据多个项目经验总结的：
| 对比维度 | TOF（双向测距） | TDOA（到达时间差） |
|---|---|---|
| 是否需要时钟同步 | 不需要（双向补偿） | 需要（基站间严格同步） |
| 终端功耗 | 较高（需收发两次） | 较低（只需发一次） |
| 系统容量 | 有限（一对一轮询） | 高（广播模式） |
| 典型精度 | 10~30厘米（室内） | 10~50厘米（视同步质量） |
| 适用场景 | 机器人导航、点对点测距 | 人员定位、资产追踪 |
嗯，这里要注意：TOF的精度虽然理论上更高，但实际部署时受多径干扰影响很大。我在一个工厂里测试过，金属货架密集的区域，TOF测距值会跳变，因为信号反射导致飞行时间变长。TDOA反而好一些，因为它用的是多个基站的差分信息，对单一路径的异常不敏感。
3.4 误差来源与数学分析
不管是TOF还是TDOA，误差都逃不出这几个来源：
- 时钟漂移误差：晶振的ppm误差会直接转化为时间误差。对于TOF，如果两个设备的时钟漂移方向相反，误差会叠加。
- 多径误差：信号反射导致首径检测不准。UWB虽然抗多径能力强，但在强反射环境下，首径能量可能被淹没。
- 天线延迟：信号从芯片到天线有固定延迟，不同设备、不同天线这个延迟不一样。我见过一个案例，同一批设备天线延迟差了2纳秒，换算成距离就是60厘米。
- 几何因子（GDOP）：基站和终端的相对位置会影响定位精度。基站围成的区域越大、越均匀，GDOP越小，精度越高。
我们来做一个简单的误差传播分析。假设TOF测距中，时间测量误差为 \( \sigma_t \)，那么距离误差 \( \sigma_d = c \times \sigma_t \)。如果 \( \sigma_t = 1 \) 纳秒，\( \sigma_d \approx 30 \) 厘米。但实际系统中，经过多次测量平均，误差可以降到10厘米以内。
避坑指南：我曾经在一个项目中忽略了天线延迟校准，结果所有测距值都偏大30厘米。后来花了三天时间逐台设备标定，才把问题解决。记住：天线延迟不是固定值，它随温度、频率变化，最好在产线上做一次全温标定。
3.5 知识体系总览
下面这张图把TOF和TDOA的核心逻辑串起来了。你可以把它当作本章的“思维导图”：
3.6 工程中的误差控制手段
说了这么多误差，那实际项目中怎么控制？我分享几个经过验证的方法：
- 多次测量取平均：UWB的测距值服从高斯分布，做10次测量取平均，误差可以降低到单次的1/√10。但要注意，如果环境在变化（比如有人走动），平均反而会引入滞后。
- 卡尔曼滤波：对于运动中的终端，卡尔曼滤波能结合历史轨迹和当前测距值，平滑掉跳变。我习惯用扩展卡尔曼滤波（EKF），因为UWB的观测方程是非线性的。
- 天线延迟校准：在产线上用已知距离做反向标定。具体做法是：把两台设备放在1米距离，测出原始时间差，减去理论飞行时间（约3.3纳秒），剩下的就是天线延迟。
- 温度补偿：晶振的漂移和温度强相关。可以在设备中预置一个温度-频率曲线表，运行时根据温度查表修正。
一个小技巧：如果你用的是DW1000或类似芯片，芯片内部有内置的时钟校准寄存器。我建议在每次测距前先做一次短距离校准（比如1米），把当前的时钟偏差算出来，再用于后续测距。这样能抵消大部分温度引起的漂移。
好了，这一章的内容就到这里。TOF和TDOA各有千秋，选哪个取决于你的系统对功耗、容量和精度的要求。记住一点：不管用哪种方法，误差控制都是系统工程——从芯片选型到天线设计，从算法到校准，每个环节都不能马虎。