1. 為什么要用UWB做自動(dòng)跟隨？

在做跟隨型機(jī)器人之前，我們?cè)囘^(guò)很多定位方法——GPS、藍(lán)牙、Wi-Fi、純視覺(jué)。但最終，UWB（Ultra Wideband，超寬帶）成了最靠譜的那個(gè)。原因很現(xiàn)實(shí)：

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

舉個(gè)例子，我們?cè)谝粋€(gè)倉(cāng)庫(kù)做過(guò)跟隨機(jī)器人，GPS在室內(nèi)直接報(bào)廢，藍(lán)牙RSSI飄得像彩票數(shù)字，視覺(jué)因?yàn)槎逊诺南渥佣l繁丟目標(biāo)。最后換成UWB，配上IMU和濾波算法，機(jī)器人終于能老老實(shí)實(shí)跟著人走，而不是去和貨架談人生。

2. 核心原理：測(cè)距 + 三邊定位

UWB的核心思路是“先測(cè)出距離，再算出位置”，聽起來(lái)簡(jiǎn)單，但每一步都能讓工程師熬夜。

2.1 TOF（Time of Flight）飛行時(shí)間測(cè)距

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

d=c?t

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

看似容易，但實(shí)際測(cè)試時(shí)會(huì)遇到幾個(gè)坑：

1. 時(shí)鐘不同步 ：標(biāo)簽和基站的時(shí)鐘不一致會(huì)導(dǎo)致測(cè)距誤差。
2. 非視距（NLOS）：信號(hào)繞路走，測(cè)出來(lái)的距離比真實(shí)的長(zhǎng)。

我們?cè)?jīng)在一個(gè)金屬棚下測(cè)試，結(jié)果距離全都比實(shí)際值多了1~2米，后來(lái)我們通過(guò)在固件中加入NLOS檢測(cè)+濾波補(bǔ)償才解決。

2.2 TDOA（Time Difference of Arrival）到達(dá)時(shí)間差定位

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

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

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

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

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

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

PDOA利用載波相位差來(lái)測(cè)角度（AOA，Angle of Arrival），公式：

其中：

λ 是波長(zhǎng)

Δ? 是相位差

da 是天線間距

優(yōu)勢(shì)是方向分辨率高，缺點(diǎn)是對(duì)硬件一致性要求高。我們?cè)谧?a target="_blank">天線陣列測(cè)試時(shí)，哪怕兩根射頻走線長(zhǎng)度差了 1mm，角度估計(jì)都能飄幾度。

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

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

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

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

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

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

有一次我們做多機(jī)器人跟隨演示，忘了配置時(shí)隙，結(jié)果三臺(tái)機(jī)器人互相干擾，最后排成了一個(gè)“機(jī)器人廣場(chǎng)舞”的陣型。

5. 總結(jié)

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

審核編輯 黃宇