方文浩，陸 陽(yáng),2，衛(wèi) 星,2

(1.合肥工業(yè)大學(xué) 計(jì)算機(jī)與信息學(xué)院，合肥 230009； 2.安全關(guān)鍵工業(yè)測(cè)控技術(shù)教育部工程研究中心(合肥工業(yè)大學(xué))，合肥 230009)(*通信作者電子郵箱luyang.hf@126.com)

0 引言

隨著工業(yè)物聯(lián)網(wǎng)與人工智能技術(shù)在煤礦領(lǐng)域的不斷發(fā)展，煤礦井下人員與設(shè)備的位置信息已經(jīng)成為十分重要的基礎(chǔ)信息。目前，多采用射頻識(shí)別(Radio Frequency Identification, RFID)、WiFi、ZigBee、藍(lán)牙等無(wú)線技術(shù)實(shí)現(xiàn)礦井巷道下的物體定位，但由于煤礦井下環(huán)境復(fù)雜，導(dǎo)致以上無(wú)線定位技術(shù)普遍存在抗多徑效果差、易受環(huán)境干擾、定位精度差等問(wèn)題，不能滿足井下日益發(fā)展的各類(lèi)信息系統(tǒng)對(duì)高精度定位的要求。而超寬帶(Ultra WideBand, UWB)定位技術(shù)[1-2]采用帶寬大于500 MHz的納秒級(jí)超窄脈沖信號(hào)，穿透力強(qiáng)，時(shí)間分辨率高，信號(hào)在傳輸過(guò)程中抗多徑衰弱能力和抗干擾能力強(qiáng)，在井下巷道惡劣環(huán)境中不易受到影響，所以UWB定位可以有效克服傳統(tǒng)井下無(wú)線定位技術(shù)的缺陷。

基于測(cè)距的節(jié)點(diǎn)定位方法是目前高精度定位采用的主要技術(shù)。為實(shí)現(xiàn)高精度測(cè)距，Oh等[3]采用了傳播時(shí)間測(cè)距(Time Of Flight, TOF)算法，并提出了一種有效的預(yù)濾波方法，將接收到的信號(hào)轉(zhuǎn)化成正弦曲線，通過(guò)對(duì)正弦波應(yīng)用預(yù)濾波以消除正弦波的帶外噪聲，完成精確的TOF測(cè)距，該方法只是提高TOF估計(jì)精度，并未考慮到測(cè)距節(jié)點(diǎn)時(shí)鐘難以同步給測(cè)距精度帶來(lái)的巨大影響；Gao等[4]采用了雙向測(cè)距(Two Way Ranging, TWR)算法，并提出了一個(gè)魯棒最小二乘公式，將周轉(zhuǎn)時(shí)間與時(shí)鐘偏移作為干擾參數(shù)，采用二階錐松弛技術(shù)近似解決；卞佳興等[5]采用非對(duì)稱(chēng)雙邊雙向測(cè)距(Asymmetric Double Sided Two-Way Ranging, ADS-TWR)算法，消除測(cè)距節(jié)點(diǎn)間時(shí)鐘未同步對(duì)精度的影響，同時(shí)抑制時(shí)鐘偏移引起的誤差，具有較高的精度。在提升定位精度方面，Daely等[6]提出一種基于蜻蜓算法的節(jié)點(diǎn)定位算法，利用蜻蜓算法估算節(jié)點(diǎn)位置；Sinfh等[7]提出了一種基于粒子群優(yōu)化(Particle Swarm Optimization, PSO)算法的節(jié)點(diǎn)定位算法，利用PSO對(duì)定位目標(biāo)進(jìn)行坐標(biāo)解析；張會(huì)清等[8]提出了基于BP神經(jīng)網(wǎng)絡(luò)和泰勒級(jí)數(shù)的定位算法，采用泰勒級(jí)數(shù)展開(kāi)法確定目標(biāo)節(jié)點(diǎn)的坐標(biāo)；Wang等[9]提出了利用歐幾里得和三邊定位算法對(duì)目標(biāo)節(jié)點(diǎn)進(jìn)行定位。這些算法雖可提高定位精度，最高可達(dá)20 cm；但復(fù)雜度較高，對(duì)定位的實(shí)時(shí)性有較大影響。本文綜合考慮測(cè)距和定位的性能，采用ADS-TWR測(cè)距算法和三角形質(zhì)心坐標(biāo)解析算法[10]，在測(cè)距和定位的精度滿足要求的基礎(chǔ)上，通過(guò)定位算法的低復(fù)雜度減少定位時(shí)間。

考慮到井下巷道是封閉狹長(zhǎng)空間，長(zhǎng)達(dá)幾千米，需進(jìn)行井下多基站布置以完成井下定位。在多基站定位中，Han等[11]提出了一種多基站協(xié)同定位算法，提出用通信機(jī)制和投票機(jī)制來(lái)確定目標(biāo)節(jié)點(diǎn)的臨時(shí)坐標(biāo)，再使用兩跳基站節(jié)點(diǎn)來(lái)協(xié)助定位目標(biāo)節(jié)點(diǎn)；溫培博等[12]利用基站之間的幾何位置進(jìn)行篩選，根據(jù)每個(gè)定位目標(biāo)信息完成自適應(yīng)的最少基站的選擇及定位；鮑培明等[13]提出了無(wú)線傳感器網(wǎng)絡(luò)中多基站定位的多目標(biāo)蟻群算法，用多螞蟻位置的組合表示多基站的定位，用一組螞蟻并行搜索來(lái)獲得定位解。而本文針對(duì)狹長(zhǎng)巷道的多基站定位，利用UWB通信技術(shù)，通過(guò)多基站均勻分布進(jìn)行井下區(qū)域劃分，并在高精度測(cè)距的基礎(chǔ)上，進(jìn)一步提出了一種基于ADS-TWR測(cè)距的標(biāo)簽區(qū)域判定(Region Determination)策略。標(biāo)簽在首次定位廣播請(qǐng)求幀后，根據(jù)各基站返回的距離，比較獲得距離自身最近的兩個(gè)基站，判斷所在區(qū)域，并在下一次定位時(shí)，只需向區(qū)域基站發(fā)送請(qǐng)求幀即可，解決了每一次定位標(biāo)簽因廣播請(qǐng)求幀產(chǎn)生大量無(wú)效通信的問(wèn)題，大幅減少通信開(kāi)銷(xiāo)；并在檢測(cè)到區(qū)域發(fā)生異常時(shí)，引入?yún)^(qū)域校正機(jī)制，提升定位的準(zhǔn)確性和穩(wěn)定性。

1 系統(tǒng)方案

1.1 系統(tǒng)結(jié)構(gòu)

煤礦井下巷道是由多條狹長(zhǎng)隧道組成的封閉空間，在多數(shù)情況下通常只需要完成一維定位，即確定定位目標(biāo)延巷道伸展方向的坐標(biāo)，再結(jié)合巷道的地理信息便可確定其具體位置。一般情況下，可將多個(gè)UWB定位基站等間距地分布在巷道壁的一側(cè)[14]。系統(tǒng)結(jié)構(gòu)如圖1所示。

UWB定位系統(tǒng)主要由UWB測(cè)距基站、UWB移動(dòng)標(biāo)簽、以太網(wǎng)交換機(jī)和定位管理顯示平臺(tái)四部分構(gòu)成。移動(dòng)標(biāo)簽周期性地向測(cè)距基站發(fā)送UWB信號(hào)，測(cè)距基站遵循ADS-TWR測(cè)距原理與移動(dòng)標(biāo)簽進(jìn)行信息交互，并測(cè)得相對(duì)于標(biāo)簽的準(zhǔn)確距離。定位管理顯示平臺(tái)通過(guò)以太網(wǎng)獲取到測(cè)距基站測(cè)得的一組距離信息，根據(jù)基站已知坐標(biāo)，進(jìn)行移動(dòng)標(biāo)簽坐標(biāo)定位解析，并實(shí)時(shí)顯示。

1.2 節(jié)點(diǎn)設(shè)計(jì)

在硬件電路設(shè)計(jì)上，UWB測(cè)距基站與UWB移動(dòng)標(biāo)簽基本相同，主要由微控制器模塊、UWB無(wú)線收發(fā)模塊、電源模塊構(gòu)成。微控制器是整個(gè)節(jié)點(diǎn)的核心，控制節(jié)點(diǎn)各模塊的協(xié)調(diào)運(yùn)作。節(jié)點(diǎn)采用基于ARM Cortex-M3的低功耗主控芯片STM32F107，該芯片含有以太網(wǎng)模塊；UWB無(wú)線收發(fā)模塊采用DecaWave公司的DW1000芯片，支持110 kb/s、850 kb/s、6.8 Mb/s三種高數(shù)據(jù)率通信，具有16 MHz和64 MHz兩種脈沖重復(fù)頻率(Pulse Repetition Frequency, PRF)、皮秒級(jí)時(shí)鐘分辨率、高達(dá)1 331.2 MHz的帶寬、可調(diào)控的發(fā)射功率等特點(diǎn)，為高精度測(cè)距和定位提供多種方案?；谛酒倪x擇，設(shè)計(jì)節(jié)點(diǎn)原理如圖2。

圖1 系統(tǒng)結(jié)構(gòu)

圖2 定位節(jié)點(diǎn)原理

主控芯片通過(guò)串行外設(shè)接口(Serial Peripheral Interface, SPI)與射頻芯片相連，并利用SPI總線協(xié)議對(duì)DW1000內(nèi)部寄存器進(jìn)行控制，最終實(shí)現(xiàn)通信、測(cè)距、定位。

2 ADS-TWR測(cè)距

基于測(cè)距的實(shí)時(shí)定位系統(tǒng)中，精確地獲取標(biāo)簽位置坐標(biāo)的必要條件是基站測(cè)量出相對(duì)于標(biāo)簽的精確距離。ADS-TWR測(cè)距算法通過(guò)在基站與標(biāo)簽之間完成兩次雙向測(cè)距，求得UWB信號(hào)在兩節(jié)點(diǎn)間的平均傳播時(shí)間ttof，再根據(jù)UWB信號(hào)傳播速率計(jì)算出節(jié)點(diǎn)間距離。該算法克服了基站與標(biāo)簽時(shí)鐘不同步對(duì)精度產(chǎn)生影響的缺陷，且能夠有效抑制節(jié)點(diǎn)因時(shí)鐘偏移引起的測(cè)量誤差[15-16]，為高精度定位提供了高精度的距離信息。ADS-TWR測(cè)距原理如圖3。

圖3 ADS-TWR測(cè)距原理

按照?qǐng)D3基站與標(biāo)簽信息的交互方式，ADS-TWR測(cè)距的過(guò)程如下：

步驟1 由UWB移動(dòng)標(biāo)簽發(fā)起，向UWB測(cè)距基站發(fā)送請(qǐng)求幀Poll，記發(fā)送時(shí)刻為t1，基站在a1時(shí)刻接收到Poll幀，并經(jīng)過(guò)treplyB時(shí)間，在a2時(shí)刻向標(biāo)簽發(fā)送應(yīng)答幀Resp，則treplyB=a2-a1。

步驟2 記標(biāo)簽在t2時(shí)刻接收到Resp幀，則troundA=t2-t1，并經(jīng)過(guò)treplyA時(shí)間，在t3向基站發(fā)送終止幀F(xiàn)inal，便有treplyA=t3-t2。

步驟3 記基站在a3時(shí)刻接收到Final幀，則troundB=a3-a2。

移動(dòng)標(biāo)簽通過(guò)Final幀將troundA、treplyA值發(fā)送給測(cè)距基站，測(cè)距基站根據(jù)treplyB、troundA、treplyA、troundB值計(jì)算出標(biāo)簽到基站的UWB信號(hào)單向平均傳播時(shí)間ttof為：

(1)

精確的ttof確定后，兩節(jié)點(diǎn)間距離計(jì)算公式則為：

d=c×ttof

(2)

其中：c為電磁波傳播速度，為3×108m/s。最終，基站由式(2)計(jì)算出相對(duì)標(biāo)簽的精確距離d。

3 基于區(qū)域判定的定位機(jī)制

3.1 區(qū)域判定原理

3.1.1 問(wèn)題描述

對(duì)于每一個(gè)移動(dòng)標(biāo)簽，所處位置在不斷變換。通常標(biāo)簽的每一次定位都需要向井下所有基站廣播Poll幀，并與通信范圍內(nèi)的基站按ADS-TWR測(cè)距原理實(shí)現(xiàn)信息交互并測(cè)距，而完成井下移動(dòng)標(biāo)簽一維定位只需要兩個(gè)基站參與測(cè)距即可，所以對(duì)于這種定位方式，除了與參與定位的兩個(gè)基站建立的通信是有效的，其余通信都是無(wú)效的，這樣既大量消耗節(jié)點(diǎn)功率，又大幅增加獲取一組距離的時(shí)間，嚴(yán)重影響定位的實(shí)時(shí)性和定位精度。針對(duì)此問(wèn)題，提出了一種基于ADS-TWR測(cè)距的標(biāo)簽區(qū)域判定策略，如圖4，在ADS-TWR測(cè)距的基礎(chǔ)上，增加發(fā)送一個(gè)回傳幀Report。

圖4 基于ADS-TWR的回傳幀工作機(jī)制

標(biāo)簽初始化后，首先向所有基站廣播Poll幀，節(jié)點(diǎn)間通過(guò)ADS-TWR測(cè)距原理完成通信后，基站計(jì)算出相對(duì)標(biāo)簽的精確距離，并通過(guò)Report幀回傳給標(biāo)簽，標(biāo)簽根據(jù)所有距離信息判斷其所在區(qū)域。區(qū)域確定后，在下一次定位時(shí)，只選擇向區(qū)域內(nèi)的基站廣播Poll幀，按圖4方式進(jìn)行信息交互來(lái)實(shí)現(xiàn)測(cè)距和定位。

3.1.2 區(qū)域判定模型

在一維定位中，針對(duì)井下多基站情況，將所有基站等間距依次布置在巷道壁一側(cè)，兩個(gè)基站便形成一個(gè)區(qū)域。若基站標(biāo)簽節(jié)點(diǎn)的通信距離最高可達(dá)m，基站間距l(xiāng)一般可設(shè)置為m/2～m，本文考慮到基站測(cè)距的穩(wěn)定性，選取l=m/2，井下基站分布如圖5。

對(duì)于標(biāo)簽區(qū)域判定策略，可建立三元組模型：

RD→ {I,D,R}

其中：I表示基站編號(hào)的集合；D表示測(cè)距基站回傳給同一標(biāo)簽的距離集合；R表示劃分區(qū)域的集合。標(biāo)簽初始化后，根據(jù)距離集D，判斷最近的兩個(gè)基站，假設(shè)編號(hào)為i、j，滿足j=i+1，基站Ai、Aj便構(gòu)成區(qū)域Rj，則判定標(biāo)簽所處區(qū)域Rj。區(qū)域Rj判定后，標(biāo)簽選擇與基站Ai、Aj通信，Ai、Aj通過(guò)ADS-TWR算法測(cè)得距離di、dj，因此，區(qū)域判定策略中三元組I、D、R的關(guān)系如圖6所示。

圖5 井下基站分布

圖6 三元組關(guān)系

根據(jù)關(guān)系圖6，得到各元組映射關(guān)系：

f(D)={i,j};i,j∈I

(3)

其中i、j滿足條件di=min(D),dj=min(D-di)或dj=min(D),di=min(D-dj)。

f(i,j)=Rj;i=j-1

(4)

g(Rj)={i,j};i=j-1

(5)

(6)

3.1.3 基本策略

已知區(qū)域判定的三元組模型及其映射關(guān)系，則區(qū)域判定的基本策略如下：

步驟1 移動(dòng)標(biāo)簽初始化后，廣播請(qǐng)求幀Poll，所有測(cè)距基站通過(guò)ADS-TWR算法測(cè)得距離并通過(guò)Report幀回傳給標(biāo)簽，所有距離構(gòu)成距離集D，標(biāo)簽依據(jù)距離最短原則，根據(jù)式(3)判斷兩個(gè)最短的距離為di、dj，則選擇基站Ai、Aj作為最近的基站，再根據(jù)式(4)判定所在區(qū)域Rj。

步驟2 區(qū)域Rj確定后，移動(dòng)標(biāo)簽根據(jù)式(5)確定區(qū)域基站Ai、Aj，便只與Ai、Aj按圖4方式建立UWB通信完成測(cè)距，同時(shí)標(biāo)簽根據(jù)式(6)判斷標(biāo)簽是否移動(dòng)到Rj的相鄰區(qū)域。若di、dj有一值大于l，則移動(dòng)標(biāo)簽所在區(qū)域發(fā)生變化：當(dāng)di>l，區(qū)域Rj=Rj+1；dj>l時(shí)，則Rj=Rj-1。

步驟3 若di、dj都小于l，則接下來(lái)繼續(xù)進(jìn)行步驟2。

步驟4 若標(biāo)簽檢測(cè)出區(qū)域異常，復(fù)位，跳回步驟1，重新進(jìn)行區(qū)域判定。

綜合上述思想，結(jié)合圖5基站分布和標(biāo)簽位置，便得到測(cè)距基站與移動(dòng)標(biāo)簽的工作時(shí)序，如圖7。

移動(dòng)標(biāo)簽T的區(qū)域判定策略的工作機(jī)制為：在測(cè)距階段，標(biāo)簽T向基站A0至A4廣播Poll幀，由于基站A4所在位置超過(guò)標(biāo)簽T的通信距離，只有基站A0～A3與標(biāo)簽T建立連接，并通過(guò)ADS-TWR算法測(cè)得相對(duì)于T的距離d0～d3；在區(qū)域判定階段，標(biāo)簽T通過(guò)基站A0～A3的Report幀獲取到距離信息，并根據(jù)距離集D{d0,d1,d2,d3}選擇A1、A2為最近相鄰基站，判定T所在區(qū)域?yàn)镽2；此后的定位，標(biāo)簽T只與區(qū)域基站A1、A2按圖4方式通信，并時(shí)刻檢測(cè)回傳距離d1、d2，判斷區(qū)域的變化和異常。

圖7 區(qū)域判定時(shí)序

3.2 區(qū)域校正

井下巷道環(huán)境因素復(fù)雜，如空氣濕度大、空氣中浮游雜塵含量高、電磁環(huán)境多變等，極易影響標(biāo)簽區(qū)域判定的準(zhǔn)確性。針對(duì)此問(wèn)題，本文采用區(qū)域校正方法，在定位過(guò)程中，分析圖4信息交互中出現(xiàn)的異常情況，并根據(jù)圖6中三元組映射關(guān)系，檢測(cè)區(qū)域判定出現(xiàn)錯(cuò)誤的信號(hào)，若標(biāo)簽實(shí)際區(qū)域已不是Rj，立即復(fù)位，進(jìn)行區(qū)域重判。通常，移動(dòng)標(biāo)簽檢測(cè)到以下異常時(shí)，便實(shí)行區(qū)域校正方法確保區(qū)域Rj正確，維護(hù)定位的準(zhǔn)確性和系統(tǒng)的魯棒性。

1)j≠i+1，即最近基站不相鄰。移動(dòng)標(biāo)簽上電或復(fù)位后，根據(jù)距離集D，由式(3)返回最近基站編號(hào)i、j，假設(shè)j>i，而j≠i+1，則Ai、Aj基站無(wú)法判定區(qū)域標(biāo)簽，需進(jìn)行區(qū)域校正。

2)di、dj同時(shí)大于l。定位過(guò)程中，標(biāo)簽檢測(cè)區(qū)域基站Ai、Aj返回的距離di、dj，若di>l以及dj>l，則區(qū)域Rj已不是標(biāo)簽實(shí)際所在區(qū)域，需進(jìn)行區(qū)域校正。

3)基站無(wú)響應(yīng)。定位過(guò)程中，標(biāo)簽多次嘗試向區(qū)域基站Ai或Aj發(fā)送Poll幀時(shí)，未接收到Ai或Aj的應(yīng)答幀Resp，表明基站Ai、Aj至少有一個(gè)基站已不在標(biāo)簽通信范圍內(nèi)，需進(jìn)行區(qū)域校正。

4)距離回傳超時(shí)。定位過(guò)程中，區(qū)域基站Ai、Aj向標(biāo)簽回傳距離后，標(biāo)簽接收回傳幀Report超時(shí)，即標(biāo)簽無(wú)法確定距離di、dj，因此便無(wú)法根據(jù)式(6)判斷區(qū)域Rj的變化以及異常的產(chǎn)生，影響定位的實(shí)現(xiàn)，需進(jìn)行區(qū)域校正。

3.3 基于區(qū)域判定的定位機(jī)制

引入“區(qū)域判定”和“區(qū)域校正”思想后，移動(dòng)標(biāo)簽在定位過(guò)程中能夠準(zhǔn)確判斷其所在區(qū)域，只需與區(qū)域基站通信便能完成定位，解決了傳統(tǒng)多基站定位系統(tǒng)中所有基站參與同一標(biāo)簽定位的問(wèn)題，降低了系統(tǒng)復(fù)雜度。

圖8為基于區(qū)域判定的定位流程。標(biāo)簽區(qū)域Rj確定后，其后每一次定位都向區(qū)域基站Ai、Aj發(fā)送請(qǐng)求幀Poll進(jìn)行信息交互，基站Ai、Aj根據(jù)ADS-TWR測(cè)距算法計(jì)算出精確距離di、dj，由定位管理顯示平臺(tái)獲取到di、dj，采用定位算法實(shí)現(xiàn)移動(dòng)標(biāo)簽的一維定位。

本系統(tǒng)采用三角形質(zhì)心算法求解移動(dòng)標(biāo)簽的坐標(biāo)，該算法模型如圖9?；続i、Aj與標(biāo)簽T的測(cè)距值為di、dj，以Ai、Aj為圓心，對(duì)應(yīng)距離di、dj為半徑畫(huà)圓，Ai、Aj的連接線將畫(huà)出的圓截取成兩個(gè)半圓，得到標(biāo)簽的3個(gè)近似位置特征點(diǎn)B、C、D，形成三角形△BCD，則所求解的標(biāo)簽延巷道伸展方向的坐標(biāo)xT為：

xT=(xb+xc+xd)/3

(7)

其中：xb表示特征點(diǎn)B的橫坐標(biāo)；xc表示特征點(diǎn)C的橫坐標(biāo)；xd表示特征點(diǎn)D的橫坐標(biāo)。定位管理顯示平臺(tái)根據(jù)Ai、Aj的固定坐標(biāo)及di、dj計(jì)算出xb、xc、xd，再利用式(7)估算出移動(dòng)標(biāo)簽標(biāo)延巷道伸展方向的橫坐標(biāo)xT，完成一維定位。

圖8 基于區(qū)域判定的定位流程

圖9 三角形質(zhì)心算法模型

三角形質(zhì)心算法可削弱節(jié)點(diǎn)測(cè)距誤差對(duì)定位精度的影響，滿足定位系統(tǒng)的高精度需求；同時(shí)，該算法的計(jì)算量小，易于實(shí)現(xiàn)，處理時(shí)間短，有利于定位實(shí)時(shí)性處理。

4 實(shí)驗(yàn)結(jié)果及分析

應(yīng)用本文設(shè)計(jì)的基站與標(biāo)簽硬件平臺(tái)，系統(tǒng)的性能還將受DW1000芯片參數(shù)設(shè)置的影響。通過(guò)測(cè)距實(shí)驗(yàn)驗(yàn)證，越大的PRF和帶寬具有越高精度的測(cè)距，且越低的數(shù)據(jù)速率和越大的發(fā)射功率具有越長(zhǎng)的通信距離，因此設(shè)置基站標(biāo)簽節(jié)點(diǎn)參數(shù)為110 kb/s的傳輸數(shù)據(jù)率，16 MHz低功耗PRF，1 331.2 MHz帶寬，最大發(fā)射功率，以實(shí)現(xiàn)高精度的測(cè)距及最大距離的通信，同時(shí)兼顧節(jié)點(diǎn)功耗，并按照?qǐng)D1系統(tǒng)結(jié)構(gòu)在長(zhǎng)100 m、寬2 m、高3 m的封閉模擬環(huán)境下搭建實(shí)驗(yàn)平臺(tái)，設(shè)基站間距l(xiāng)=50 m，布置3個(gè)基站，構(gòu)成兩個(gè)區(qū)域R1、R2，然后運(yùn)行本文設(shè)計(jì)的多基站定位系統(tǒng)，獲取測(cè)試數(shù)據(jù)，分析系統(tǒng)性能。

4.1 測(cè)距誤差

測(cè)距誤差是影響定位精度的重要因素之一，利用基站標(biāo)簽在R1、R2區(qū)域?qū)Χ鄠€(gè)實(shí)際距離進(jìn)行分組測(cè)距實(shí)驗(yàn)，每組測(cè)量多個(gè)數(shù)據(jù)，并人工計(jì)算測(cè)距誤差。定義節(jié)點(diǎn)測(cè)距誤差為：

de=dr-ds

(8)

表1測(cè)距結(jié)果表明，基站與標(biāo)簽的測(cè)距誤差控制在20 cm以內(nèi)，某些時(shí)刻可達(dá)10 cm，總平均誤差為11.26 cm，實(shí)現(xiàn)了高精度測(cè)距，且相對(duì)于每個(gè)實(shí)際距離值，測(cè)距值都是正偏，所以采用三角形質(zhì)心算法作為坐標(biāo)求解算法非常合適。同時(shí)，測(cè)距的穩(wěn)定性較好，測(cè)距值波動(dòng)幅度不大。

表1 ADS-TWR測(cè)距誤差統(tǒng)計(jì)

4.2 定位誤差

(9)

定位系統(tǒng)運(yùn)行時(shí)，標(biāo)簽T在區(qū)域R1、R2內(nèi)移動(dòng)，每10 m內(nèi)標(biāo)簽被靜態(tài)地統(tǒng)計(jì)定位5次，將50個(gè)定位結(jié)果通過(guò)Matlab擬合成標(biāo)簽橫坐標(biāo)測(cè)量值曲線，結(jié)果如圖10，并根據(jù)式(9)計(jì)算每一次的定位誤差，得到結(jié)果如圖11。同時(shí)，在每個(gè)區(qū)域內(nèi)選取10個(gè)基準(zhǔn)點(diǎn)，給出具體的定位數(shù)據(jù)及誤差EX，如表2。

圖10 標(biāo)簽橫坐標(biāo)測(cè)量值與實(shí)際值對(duì)比

圖10結(jié)果顯示，仿真后的測(cè)量值曲線與實(shí)際值曲線近乎重合，且隨機(jī)放大區(qū)域的測(cè)量值偏移也很小，表明定位誤差很小。圖11結(jié)果表明，最差情況下，定位誤差可達(dá)到15 cm，某些時(shí)刻可實(shí)現(xiàn)厘米級(jí)定位，進(jìn)一步說(shuō)明本系統(tǒng)具有高精度定位的特點(diǎn)。

表2 定位誤差EX統(tǒng)計(jì)

結(jié)合表1和表2，實(shí)驗(yàn)數(shù)據(jù)表明，在高精度測(cè)距的基礎(chǔ)上，三角形質(zhì)心算法有效削弱了測(cè)距誤差對(duì)定位精度的影響，使得移動(dòng)標(biāo)簽定位誤差EX的平均值達(dá)到5.925 cm，相對(duì)于總平均測(cè)距誤差，降低約47.4%。結(jié)合表2和圖11可得，系統(tǒng)的定位精度穩(wěn)定在15 cm以內(nèi)。而且，移動(dòng)標(biāo)簽所在區(qū)域發(fā)生變換后，系統(tǒng)依舊能夠準(zhǔn)確地進(jìn)行定位，定位精度也保持在一個(gè)較高的指標(biāo)范圍之內(nèi)。

圖11 定位誤差

5 結(jié)語(yǔ)

本文針對(duì)井下狹長(zhǎng)巷道的多基站定位問(wèn)題，設(shè)計(jì)實(shí)現(xiàn)了一套基于UWB的高精度定位系統(tǒng)。該系統(tǒng)采用ADS-TWR測(cè)距技術(shù)，有效抑制了節(jié)點(diǎn)時(shí)鐘偏移引起的誤差，實(shí)現(xiàn)了高精度測(cè)距，為井下高精度定位提供了保障；采用三角形質(zhì)心算法，削弱測(cè)距誤差對(duì)定位精度的影響，進(jìn)一步提高定位精度。針對(duì)井下多基站定位中，標(biāo)簽每次定位都需向所有基站廣播請(qǐng)求幀的問(wèn)題，該系統(tǒng)采用一種基于ADS-TWR測(cè)距的區(qū)域判定策略，標(biāo)簽通過(guò)判定所在區(qū)域，定位時(shí)只與區(qū)域基站通信，避免重復(fù)地與未參與定位的基站建立連接，大幅減少了節(jié)點(diǎn)間的無(wú)效通信，同時(shí)引入?yún)^(qū)域校正機(jī)制，提升了區(qū)域判定的準(zhǔn)確性，增強(qiáng)了定位的可靠性與穩(wěn)定性。