韓玉香,張曉亮,張曉明,2,耿煜琛
(1.中北大學(xué)電子測試技術(shù)國家重點實驗室,太原 030051; 2.中北大學(xué)儀器科學(xué)與動態(tài)測試教育部重點實驗室,太原 030051; 3. 濟南金豐源電子科技有限公司,濟南 250101 )
現(xiàn)如今,越來越多的高新技術(shù)被應(yīng)用到各體育運動中,以更好地對運動員的運動狀況進行分析[1-2]。其中,運動場中運動員的定位精度要求為分米級,更新率大于10Hz,可實時準確顯示運動員的運動軌跡。目前常用的定位技術(shù)如超聲波定位技術(shù)[3]、藍牙定位技術(shù)[4]和WiFi定位技術(shù)[5]等,在覆蓋范圍及定位精度方面均不能滿足運動場高精度實時定位的要求;全球?qū)Ш叫l(wèi)星系統(tǒng)(Global Navigation Satellite System, GNSS)[6-7]定位技術(shù)適合室外大范圍定位,單點定位精度低;實時動態(tài)定位(Real-Time Kinematic,RTK)技術(shù)雖可實現(xiàn)單點實時定位,但所需設(shè)備復(fù)雜,操作難度大。
超寬帶(Ultra Wide Band,UWB)定位技術(shù)由于功耗低、系統(tǒng)復(fù)雜度低、多徑分辨率高、系統(tǒng)安全性高、定位精度可達分米級[8-9]等優(yōu)點,在室內(nèi)外定位領(lǐng)域得到了廣泛應(yīng)用[10]。傳統(tǒng)的UWB可移動基站定位方法借用外部設(shè)備(如高精度全站儀)進行人工測量以獲取基站位置[11],雖然人工測量基站位置較為精確,但使用不便,需利用全站儀等工具進行輔助測量,不但增加了使用成本,還導(dǎo)致UWB定位系統(tǒng)的基站布設(shè)工作量增加,限制了定位系統(tǒng)的可移動性[12]。除人工測量之外,還可以將移動基站定位在標準運動場的場地邊緣,以運動場的標準尺寸確定基站坐標[13]。多數(shù)運動場地在建設(shè)時不能達到標準尺寸要求,并且基站在安裝時可能與場地邊緣不完全重合,導(dǎo)致基站坐標存在誤差。 因此,本文提出了一種可移動基站快速自定位方法。
為滿足運動場中可移動基站快速定位的需求,利用基于飛行時間(Time of Flight,TOF)[14]的UWB可移動基站快速自定位方法,建立局部坐標系以獲取基站坐標。根據(jù)需要在運動場中布設(shè)基站,通過各基站間互相通信即可快速定位基站的相對位置。該方法可減少定位基站的布設(shè)時間和成本,降低UWB移動定位基站的布設(shè)難度,提高系統(tǒng)的可移動性,達到快速精確確定運動場可移動基站坐標的目的。
假設(shè)運動場內(nèi)有n個定位基站,任意2個基站之間均可進行通信,為減小基站的時鐘誤差帶來的測距誤差,基站之間進行雙向測距,如圖 1所示。雙邊雙向測距分為兩次測距:基站j主動發(fā)起第一次測距消息并記錄發(fā)送時間戳t0,基站i記錄接收時間戳t1并產(chǎn)生應(yīng)答信息,同時記錄發(fā)送時間戳t2,當(dāng)基站j收到數(shù)據(jù)之后記錄時間戳t3;第二次為基站j返回帶有時間戳t0、t3、t4的數(shù)據(jù),基站i接收并記錄時間戳t5。最終可以得到4個時間差,根據(jù)時間差計算基站i到基站j的距離[15]。
令4個時間差分別為
treply1=t2-t1treply2=t4-t3tround1=t3-t0tround2=t5-t2
tround1為基站j發(fā)送輪詢信號到接收到基站i應(yīng)答信號的時間;tround2為基站i發(fā)送應(yīng)答信號到接收到基站j發(fā)送的測距信息的時間;treply1為基站i接收到輪詢信號到發(fā)送應(yīng)答信號的時間;treply2為基站j接收到應(yīng)答信號到發(fā)送測距信息的時間。
則進行一次測距所需時間t可表示為
(1)
根據(jù)式(1)可進一步得出距離d
d=ct+Δd
(2)
其中,c為無線電傳播速度;Δd為TOF測距誤差。
圖1 TOF測距原理圖Fig.1 TOF ranging schematic diagram
由于運動場地面平坦,將地面定義為三維坐標系的xoy平面。運動場內(nèi)任意不同的2個基站作為基站1和基站2?;?和基站2在地面投影點的連線定義為三維坐標系的x軸,將經(jīng)過基站1的地面法線定義為三維坐標系的z軸,根據(jù)右手定則,得到y(tǒng)軸方向。利用測量工具測得各基站到地面的距離作為z軸坐標,測量誤差在0.001m內(nèi)。不失一般性,假設(shè)基站均在xoy平面的第一象限內(nèi),如圖2所示?;?的坐標為(0,0,z1),基站2的坐標為(x2,0,z2),基站i的坐標為(xi,yi,zi),基站j的坐標為(xj,yj,zj),則每2個基站之間的距離表示為
dij2=(xi-xj)2+(yi-yj)2+(zi-zj)2i=1,2,3,…,n;j=1,2,3,…,n;i≠j
(3)
圖2 基站快速定位原理圖Fig.2 Schematic diagram of base station rapid positioning
根據(jù)式(3)可得關(guān)于距離及基站坐標的非線性方程組,本文采用牛頓迭代法求解基站坐標。假設(shè)Xk為第k次迭代的坐標值,則
Xk=[x1k,x2k,y2k…xik,yik…xnk,ynk]T
對式(3)所得的非線性方程組進行泰勒展開得
(4)
其中,Δxi=xi-xik,i=2,3,…,n;Δyi=yi-yik,i=3,4,…,n。
由文獻[16]以及實驗數(shù)據(jù)可知,距離值的測量存在誤差且誤差服從正態(tài)分布。由數(shù)理統(tǒng)計知識:當(dāng)誤差服從正態(tài)分布時,最小二乘是最優(yōu)線性無偏估計。通過最小二乘求解,使得測距誤差的平方和為最小。下文將通過上述泰勒展開式求方程的最小二乘解。
記系數(shù)矩陣Hk為
Hk=[Ak(m×n1)Bk(m×n2)]
其中
Xk迭代初始值由非線性方程組解得
(5)
其中
(6)
令各個基站到地面的距離差為Δz,則Δz可表示為
Δz={Δzij|1≤i≤n,1≤j≤n,i≠j}
令
ΔXk=[Δx2k,Δxik…Δxnk,Δy2k,Δyik…Δynk]T
令
ΔRk=f-fk
(7)
其中
f=[f12,f1i…fij]TXk=[x1,x2,…xi…xn,y2…yi…yn]Tfk=[f12|Xk,d1i|Xk…fij|Xk]T
則
ΔRk=HkΔXk
(8)
運用最小二乘法解算ΔXk,得
(9)
第一次迭代的X1為
X1=ΔX+X0
(10)
通過牛頓迭代法對ΔXk進行解算,當(dāng)ΔXk小于誤差閾值時停止迭代,此時的Xk+1為
Xk+1=Xk+ΔXk
(11)
最終基站x、y軸坐標值為Xk+1,z軸坐標值為基站和地面之間的距離,實現(xiàn)了基于TOF測距的UWB基站快速定位方式。
在設(shè)定的局部坐標系內(nèi)求得基站坐標后,在運動場自身坐標系x′o′y′以及建立的局部坐標系xoy內(nèi)選取典型位置點,求得坐標轉(zhuǎn)換關(guān)系,將坐標進行平移旋轉(zhuǎn)即可得到基站在運動場內(nèi)的坐標。
基站坐標ΔXk的期望為
(12)
基站坐標ΔXk的方差為
(13)
(14)
每個基站坐標處的誤差系數(shù)可表示為
(15)
通過誤差系數(shù)及測距標準差,可進一步得到基站x坐標和y坐標的標準差
誤差系數(shù)反映了測距誤差和定位誤差的關(guān)系。根據(jù)文獻[17],誤差系數(shù)與基站個數(shù)及基站布設(shè)方式有關(guān)。
假設(shè)UWB可移動基站的測距誤差服從均值為0、標準差為0.1m的正態(tài)分布。通過上述定位算法解算基站坐標,并進行誤差系數(shù)及標準差計算,分析布設(shè)數(shù)目分別為4、6、8時,對UWB可移動基站自定位精度的影響。
表1 基站坐標仿真數(shù)據(jù)(4個基站)
表2 基站坐標仿真數(shù)據(jù)(6個基站)
表3 基站坐標仿真數(shù)據(jù)(8個基站)
3組仿真實驗結(jié)果表明,基站數(shù)目多的一組相較于基站數(shù)目少的一組,測量誤差及標準差均減小。在100m×50m區(qū)域內(nèi),布設(shè)6個UWB可移動基站時,誤差均值及標準差均在誤差可接受范圍內(nèi)。布設(shè)8個UWB可移動基站時,相對于6個基站布設(shè)情況,誤差標準差有所減少,但是減小效果不明顯。在100m×50m區(qū)域內(nèi),布設(shè)6個基站即可達到理想定位精度,繼續(xù)增加基站數(shù)目,定位精度的提高效果并不明顯,同時提高了系統(tǒng)復(fù)雜度,使得定位速度變慢。因此,在長為100m、寬為50m的運動場內(nèi),布設(shè)6個UWB基站即可達到精確定位的目的。
以6個基站布局仿真圖中(50,0)為例,測量坐標的誤差情況如圖3所示。
圖3 仿真結(jié)果與實際位置對比效果Fig.3 Comparison between simulation results and actual position
仿真結(jié)果表明,100m×50m的運動場內(nèi)6個UWB基站及8個UWB基站均可達到精確定位的目的??紤]到運動場定位精度的要求,采用仿真實驗中6個UWB基站的布局方式驗證算法的可行性。在足球場布設(shè)基站,用全站儀進行測量,全站儀測量精度為0.001m,如圖4所示?;?坐標為(0,0,1),測得其余5個基站坐標情況如表4所示。6個UWB基站完成一次定位用時小于1s,可達到快速定位的目的。
圖4 基站布設(shè)環(huán)境Fig.4 Layout environment of base station
表4 運動場基站坐標數(shù)據(jù)
實驗結(jié)果表明,基于該算法的UWB移動基站自定位結(jié)果與全站儀的標定結(jié)果相比,坐標相對誤差最大為0.05m,因此基站的自定位結(jié)果準確。
本文提出了一種基于TOF的UWB可移動基站快速自定位方法。
1)通過最小二乘法及牛頓迭代法對算法進行了誤差傳播規(guī)律的推導(dǎo);通過室外運動場定位實驗進行算法的可行性驗證,定位結(jié)果表明,可移動基站的定位精度在0.05m以內(nèi)。
2)相對于人工測量基站的位置,本文算法不需要借助高精度儀器輔助測量,大大節(jié)省了基站布設(shè)時間,解決了傳統(tǒng)的UWB可移動基站布設(shè)復(fù)雜、成本高等方面的問題。
3)本文算法利用所有可移動基站互相通信的方式,采用最小二乘法求解,可實現(xiàn)誤差補償。通過對誤差傳遞系數(shù)的分析,該算法在誤差傳遞過程中,可減小測距誤差對測量結(jié)果的影響,提高了定位結(jié)果的準確度。該算法可實現(xiàn)運動場內(nèi)運動員的三維定位,適用于UWB定位等無線定位技術(shù)中局部定位系統(tǒng)的組建,具有很強的指導(dǎo)意義和使用價值。