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

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

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

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

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

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

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

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

d=c?t

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

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

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

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

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

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

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

三邊定位的數學推導很像你在地圖上用圓圈找朋友：

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

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

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

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

其中：

λ 是波長

Δ? 是相位差

da 是天線間距

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

3. 算法融合與濾波優化

光有測距還不夠，數據必須經過融合和濾波才能穩定跟隨。

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

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

4. 實際應用中的坑

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

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

5. 總結

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

審核編輯 黃宇