1. 為什么要用UWB做自動跟隨？

在做跟隨型機器人之前，我們試過很多定位方法——GPS、藍牙、Wi-Fi、純視覺。但最終，UWB（Ultra Wideband，超寬帶）成了最靠譜的那個。原因很現(xiàn)實：

• 室外定位精度能做到10cm級，室內(nèi)也穩(wěn)定；
• 多徑干擾比藍牙和Wi-Fi小得多；
• 對遮擋容忍度比純視覺好；
• 延遲低，適合動態(tài)跟隨。

舉個例子，我們曾在一個倉庫做過跟隨機器人，GPS在室內(nèi)直接報廢，藍牙RSSI飄得像彩票數(shù)字，視覺因為堆放的箱子而頻繁丟目標(biāo)。最后換成UWB，配上IMU和濾波算法，機器人終于能老老實實跟著人走，而不是去和貨架談人生。

2. 核心原理：測距 + 三邊定位

UWB的核心思路是“先測出距離，再算出位置”，聽起來簡單，但每一步都能讓工程師熬夜。

2.1 TOF（Time of Flight）飛行時間測距

原理很直白：信號從A到B要花多久，乘以光速，就能算出距離：

d=c?t

其中 c≈3×10^8 m/s

看似容易，但實際測試時會遇到幾個坑：

1. 時鐘不同步 ：標(biāo)簽和基站的時鐘不一致會導(dǎo)致測距誤差。
2. 非視距（NLOS）：信號繞路走，測出來的距離比真實的長。

我們曾經(jīng)在一個金屬棚下測試，結(jié)果距離全都比實際值多了1~2米，后來我們通過在固件中加入NLOS檢測+濾波補償才解決。

2.2 TDOA（Time Difference of Arrival）到達時間差定位

TDOA不要求標(biāo)簽和基站時鐘同步，只要基站之間同步即可。核心公式：

這表示標(biāo)簽到兩個基站的距離差。配合多個基站，就能畫出幾條“雙曲線”，交點就是目標(biāo)位置。

三邊定位的數(shù)學(xué)推導(dǎo)很像你在地圖上用圓圈找朋友：

解這個方程組就能得到(x,y)坐標(biāo)。

但在現(xiàn)實中，TDOA很容易被基站同步誤差搞壞。有一次現(xiàn)場，工程師忘了給兩個基站的時鐘同步，結(jié)果機器人跟著人走著走著，突然往反方向跑，像是被什么東西嚇到一樣。

2.3 PDOA（Phase Difference of Arrival）相位差定位

PDOA利用載波相位差來測角度（AOA，Angle of Arrival），公式：

其中：

λ 是波長

Δ? 是相位差

da 是天線間距

優(yōu)勢是方向分辨率高，缺點是對硬件一致性要求高。我們在做天線陣列測試時，哪怕兩根射頻走線長度差了 1mm，角度估計都能飄幾度。

3. 算法融合與濾波優(yōu)化

光有測距還不夠，數(shù)據(jù)必須經(jīng)過融合和濾波才能穩(wěn)定跟隨。

• 卡爾曼濾波 （Kalman Filter）：適合高斯噪聲環(huán)境，推算平滑軌跡
• 擴展卡爾曼濾波（ EKF ） ：非線性運動模型下更精準(zhǔn)
• 粒子濾波 ：適合多模態(tài)和強干擾環(huán)境

一次室內(nèi)商場跟隨測試中，直接用原始UWB坐標(biāo)去控制機器人，結(jié)果走得像喝醉一樣；換成EKF后，軌跡平穩(wěn)了很多，客戶都以為換了更貴的硬件。

4. 實際應(yīng)用中的坑

• 人體遮擋 ：信號被人擋住時，距離會跳變，需要用IMU推算補償
• 金屬反射 ：在倉庫、工廠尤其嚴重，必須做NLOS檢測
• 多標(biāo)簽干擾 ：多個機器人在同一區(qū)域時，要規(guī)劃好時隙，避免碰撞

有一次我們做多機器人跟隨演示，忘了配置時隙，結(jié)果三臺機器人互相干擾，最后排成了一個“機器人廣場舞”的陣型。

5. 總結(jié)

UWB自動跟隨并不是一個“買個模塊就能用”的簡單技術(shù)，它是測距算法、幾何定位、濾波優(yōu)化和工程調(diào)試的綜合產(chǎn)物。真正能在商用環(huán)境下穩(wěn)定運行的方案，往往是在無數(shù)次現(xiàn)場調(diào)試、踩坑和優(yōu)化中打磨出來的。

審核編輯 黃宇