3. UWB测距原理（TOF）：飞行时间法的数学推导与工程实现
各位工程师朋友，今天我们来聊聊UWB测距最核心的东西——飞行时间法（TOF）。
说实话，我刚接触UWB时，觉得测距不就是算个时间差嘛，有什么难的？直到我在一个工厂项目里，定位精度死活达不到要求，才意识到这里面门道有多深。嗯，今天我就把这块掰开了讲清楚。
3.1 飞行时间法的核心思想
TOF的原理其实特别简单：测出信号从A到B的飞行时间，乘以光速，就是距离。
公式长这样：
距离 = 光速 × 飞行时间
d = c × t_prop光速c大约是3×10⁸ m/s。你想想看，1纳秒的误差，距离就差了30厘米。这就是为什么UWB需要那么高的时间分辨率。
关键点：UWB脉冲宽度通常在2ns左右，时间分辨率能做到几十皮秒级别。我做过测试，好的UWB芯片时间分辨率能达到15ps，对应距离分辨率约4.5mm。
3.2 单边双向测距（SS-TWR）
SS-TWR是最基础的TOF实现方式。流程是这样的：
- 设备A发送一个Poll消息，同时记录发送时间t1
- 设备B收到Poll，记录接收时间t2
- 设备B等待固定时间T_reply后，发送Response消息，记录发送时间t3
- 设备A收到Response，记录接收时间t4
那么飞行时间怎么算？
t_round = t4 - t1 // A端测得的往返时间
t_reply = t3 - t2 // B端的处理延迟
t_prop = (t_round - t_reply) / 2距离就是：d = c × t_prop
注意：SS-TWR有个致命问题——它假设t_reply是精确已知的。但实际中，B端的处理延迟会有抖动。我曾经在一个项目中，B端用的是Linux系统，任务调度导致t_reply抖动达到微秒级，测距误差直接飙到上百米。
为什么会这样？因为SS-TWR的误差公式是：
误差 ≈ (t_reply的误差) / 2t_reply如果有1μs的误差，距离误差就是150米。这在实际系统中完全不可接受。
3.3 双边双向测距（DS-TWR）
DS-TWR就是为了解决SS-TWR的时钟误差问题而生的。我个人习惯叫它"三次握手"测距。
流程多了一步：
- A发送Poll（t1），B接收（t2）
- B等待T_reply1后发送Response（t3），A接收（t4）
- A等待T_reply2后发送Final消息（t5），B接收（t6）
这样我们得到了两组往返时间：
t_round1 = t4 - t1 // A的第一次往返
t_reply1 = t3 - t2 // B的第一次处理延迟
t_round2 = t6 - t3 // B的第二次往返
t_reply2 = t5 - t4 // A的第二次处理延迟最终的飞行时间计算公式：
t_prop = (t_round1 × t_round2 - t_reply1 × t_reply2) / (t_round1 + t_round2 + t_reply1 + t_reply2)这个公式看着复杂，但它的好处是——消除了时钟频率误差的影响。
实战经验：我在做隧道定位项目时，用的就是DS-TWR。隧道里温度变化大，晶振频率会漂移。SS-TWR在这种环境下误差能到5-10米，换成DS-TWR后，误差稳定在30厘米以内。这个提升是质的飞跃。
3.4 两种方案的误差对比
| 对比项 | SS-TWR | DS-TWR |
|---|---|---|
| 通信次数 | 2次（Poll + Response） | 3次（Poll + Response + Final） |
| 对时钟精度要求 | 高 | 低 |
| 受处理延迟抖动影响 | 严重 | 可忽略 |
| 典型测距误差 | 1-10米（视时钟质量） | 10-30厘米 |
| 功耗 | 低 | 略高（多一次通信） |
| 适用场景 | 低成本、低精度需求 | 工业级、高精度需求 |
说白了，SS-TWR适合玩具级应用，DS-TWR才是正经干活用的。
3.5 时钟误差的数学本质
我们来深挖一下误差来源。假设A和B的时钟频率有偏差：
A的时钟频率 = f_nominal × (1 + eA)
B的时钟频率 = f_nominal × (1 + eB)其中eA和eB是频率误差，通常在±20ppm以内。
对于SS-TWR，实际测得的飞行时间：
t_prop_measured = (t_round × (1+eA) - t_reply × (1+eB)) / 2真实飞行时间：
t_prop_true = (t_round - t_reply) / 2误差就是：
误差 = (t_round × eA - t_reply × eB) / 2你看，t_reply越大，误差越大。这就是为什么SS-TWR要求t_reply必须非常小且精确。
而DS-TWR通过两次往返，把时钟误差项抵消掉了。具体推导我就不展开了，你只要记住：DS-TWR的误差与t_reply无关，只与信号飞行时间本身有关。
核心结论：DS-TWR的测距误差 ≈ c × t_prop × (eA - eB) / 2。对于10米距离，t_prop≈33ns，即使时钟误差差20ppm，误差也只有约0.1mm。这才是UWB能实现厘米级定位的根本原因。
3.6 工程实现中的避坑指南
我曾经在一个仓储机器人项目里踩过一个大坑。当时用的DS-TWR方案，实验室测试精度很好，一到现场就崩了。排查了三天，最后发现是天线延迟没校准。
这里给大家几个建议：
- 天线延迟校准：每根天线都有固定的信号延迟，必须在出厂前校准。我习惯用已知距离的"黄金参考值"来反推天线延迟。
- 多径干扰：UWB虽然抗多径能力强，但金属反射还是会造成"拖尾"效应。建议用首径检测算法，不要用最大峰值。
- 温度补偿：晶振频率随温度变化，DS-TWR虽然抵消了大部分误差，但极端温度下还是需要做补偿表。
- 通信超时处理：无线通信不可靠，必须设计重传机制。我一般设置3次重传，超时后丢弃该次测距。
特别提醒：不要以为用了DS-TWR就万事大吉。如果两个设备的时钟频率差太大（比如一个在高温环境，一个在低温环境），DS-TWR的误差也会增大。我建议在系统设计时，定期做时钟同步，或者使用高精度温补晶振（TCXO）。
3.7 知识体系总览
下面这张图总结了TOF测距的核心逻辑，我建议你保存下来，做项目时对照着看：
这张图把SS-TWR和DS-TWR的差异、适用场景都串起来了。做项目选型时，对着这张图走一遍，基本不会出错。