高端陽，李 安，傅 軍

(1.海軍工程大學(xué) 導(dǎo)航工程系，武漢 430033；2.海軍工程大學(xué) 訓(xùn)練部，武漢 430033)

0 引言

隨著基于位置的服務(wù)(location-based service，LBS)快速發(fā)展，所取得的各項(xiàng)科研及應(yīng)用成果給人們的日常生活帶來了極大的便利；如何提供更高性能、更全面的位置服務(wù)成為當(dāng)前科研工作人員關(guān)注的重點(diǎn)。室外環(huán)境下，由于全球衛(wèi)星導(dǎo)航定位系統(tǒng)技術(shù)的日漸成熟，室外定位技術(shù)已得到很好解決。而室內(nèi)環(huán)境下，無線信號(hào)容易受到建筑物遮擋、多路徑效應(yīng)、非視距(non line of sight，NLOS)傳播等因素的影響，單純的無線定位方式存在精度不高，且容易產(chǎn)生信號(hào)突變的現(xiàn)象，如何提高室內(nèi)定位精度成為當(dāng)前的研究熱點(diǎn)。文獻(xiàn)[1]回顧了近10年來的相對(duì)室內(nèi)定位的發(fā)展，并指出了今后的研究方向。文獻(xiàn)[2]采用神經(jīng)網(wǎng)絡(luò)和遺傳算法相結(jié)合的射頻識(shí)別(radio frequency identification，RFID)室內(nèi)定位方法，但是實(shí)現(xiàn)較高的定位精度需要較多的閱讀器。文獻(xiàn)[3]利用低精度的微機(jī)電系統(tǒng)(micro-electro-mechanical system，MEMS)器件實(shí)現(xiàn)了3維室內(nèi)定位，由于誤差隨時(shí)間積累，無法滿足長(zhǎng)時(shí)間的定位要求。文獻(xiàn)[4]利用信標(biāo)節(jié)點(diǎn)的距離差分信息，修正目標(biāo)節(jié)點(diǎn)的距離信息，減少了計(jì)算量，較少的信標(biāo)節(jié)點(diǎn)也能保證定位精度。在非視距條件下，文獻(xiàn)[5]提出基于到達(dá)時(shí)間(time of arrive，TOA)測(cè)量與慣導(dǎo)信息融合的定位算法，有效減少了非視距傳播對(duì)定位結(jié)果的影響。文獻(xiàn)[6]采用卡爾曼濾波處理TOA測(cè)量值，提高了定位精度。文獻(xiàn)[7]用卡爾曼濾波對(duì)估算位置坐標(biāo)進(jìn)行濾波處理，提高了無線定位方式的性能和穩(wěn)定性，但依然存在用戶位置不連續(xù)的問題。文獻(xiàn)[8]采用超寬帶(ultra-wide band，UWB)和捷聯(lián)慣導(dǎo)系統(tǒng)(strapdown inertial navigation system，SINS)組合方式，設(shè)計(jì)卡爾曼濾波器，抑制誤差的同時(shí)提高了室內(nèi)定位的精度。文獻(xiàn)[9]采用了一種基于無跡卡爾曼濾波的無線定位與慣性導(dǎo)航單元(inertial measurement unit，IMU)組合的室內(nèi)定位算法，降低了無線定位結(jié)果的波動(dòng)幅度，又解決了IMU累積誤差問題。文獻(xiàn)[10]提出了聯(lián)合全球定位系統(tǒng)(global positioning system，GPS)和無線局域網(wǎng)絡(luò)的組合定位方法，采用聯(lián)邦卡爾曼聯(lián)濾波算法實(shí)現(xiàn)室內(nèi)外的無縫定位與導(dǎo)航，但定位性能受環(huán)境影響較大。

針對(duì)大型船舶艙室內(nèi)無線定位技術(shù)的無線信號(hào)傳播過程中存在非視距傳播、多路徑效應(yīng)的問題，以及少數(shù)基站(base station，BS)在未知情況下會(huì)出現(xiàn)測(cè)距誤差較大的問題等情況，本文提出一種基于測(cè)距的自適應(yīng)定位算法，在基站冗余情況下將基站任意組合，并引入面積因子評(píng)價(jià)機(jī)制，選擇最優(yōu)的基站組合方式用于定位解算，以提高定位精度。

1 室內(nèi)定位技術(shù)

1.1 定位手段

目前用于室內(nèi)定位的手段[11]主要有無線局域網(wǎng)(wireless fidelity，WiFi)定位、發(fā)光二極管(light-emitting diode，LED)燈光定位、藍(lán)牙定位、射頻標(biāo)簽定位、超寬帶(ultra-wide band，UWB)無線定位、ZigBee定位、地磁定位、超聲波定位、計(jì)算機(jī)視覺定位等，每種定位方式都有其適用范圍和優(yōu)缺點(diǎn)。其中無線定位系統(tǒng)主要有UWB定位、Chirp擴(kuò)頻(chirp spread spectrum，CSS)定位、ZigBee定位、WiFi定位，有源或無源無線射頻識(shí)別(radio frequency identification devices，RFID)定位、基站定位等。比較市場(chǎng)上主流開發(fā)商的各種無線定位系統(tǒng)的定位精度和成本，性能總結(jié)如表1所示。

表1 無線定位系統(tǒng)性能對(duì)比

通過對(duì)比分析，不難看出第2類無線定位系統(tǒng)有著其獨(dú)特的優(yōu)勢(shì)，定位精度合適且定位成本易于接受，適用范圍較廣，性價(jià)比較高。當(dāng)然每種室內(nèi)定位技術(shù)在增加硬件數(shù)量的情況下，定位精度都會(huì)有所提高，但是成本也會(huì)隨之增加。

1.2 定位原理

目前用于定位的方法[11]主要有基于距離的定位方法、基于到達(dá)時(shí)間差的定位方法、基于到達(dá)角度的定位方法、基于信號(hào)指紋的定位方法等，本文主要介紹基于距離的定位原理。測(cè)距定位就是通過測(cè)量目標(biāo)點(diǎn)到基站之間的距離，利用多個(gè)距離位置線來確定目標(biāo)點(diǎn)的位置坐標(biāo)。平面定位中該方法至少需要3個(gè)測(cè)距信息，通過測(cè)量目標(biāo)點(diǎn)到各基站之間的無線信號(hào)傳播時(shí)間來獲取測(cè)距信息。以2維位置解算為例，圖1中虛線為理想情況下平面定位原理圖。

在實(shí)際工程應(yīng)用中，由于存在非視距傳播和多路徑效應(yīng)等因素影響，目標(biāo)點(diǎn)到各基站之間的測(cè)量距離通常都會(huì)大于實(shí)際距離，此時(shí)定位效果如圖1中實(shí)線所示。

1.2.1 解算方程的建立

理想情況下，目標(biāo)點(diǎn)位于以各個(gè)基站為圓心、測(cè)距長(zhǎng)為半徑的圓上。設(shè)基站坐標(biāo)分別為BS1(x1,y1),BS2(x2,y2),…,BSn(xn,yn)，目標(biāo)點(diǎn)位置為(x,y)，目標(biāo)點(diǎn)到第i個(gè)基站之間的測(cè)量距離為di，故目標(biāo)點(diǎn)與基站之間存在以下幾何關(guān)系，表達(dá)式為

(1)

1.2.2 泰勒級(jí)數(shù)解算

由于多路徑、非視距傳播等因素的影響，實(shí)際測(cè)量中會(huì)存在一定的誤差，目標(biāo)點(diǎn)與基站之間的測(cè)量距離通常都會(huì)大于真實(shí)距離；因此直接通過式(1)求解無法得到滿足所有方程的唯一解。為了提高解算的位置精度，可以通過增加基站數(shù)目的辦法，使得式(1)中方程個(gè)數(shù)大于未知數(shù)的個(gè)數(shù)，變?yōu)槌ǚ匠痰那蠼鈫栴}。超定方程的求解可以利用泰勒級(jí)數(shù)法求解，式(1)中的方程為非線性方程，通過泰勒級(jí)數(shù)展開并簡(jiǎn)化對(duì)其線性化。

1)給定目標(biāo)點(diǎn)初始位置為(x0,y0)，與真值之間的誤差設(shè)為δx、δy，則

(2)

2)將式(1)在(x0,y0)處用泰勒級(jí)數(shù)展開，為了便于計(jì)算，將2次及以上項(xiàng)忽略，則

(3)

整理得

(4)

然后采用最小二乘法解算目標(biāo)點(diǎn)的位置坐標(biāo)，令

方程矢量矩陣表示為

Aδ=b。

(5)

最小二乘求解為

δ=(ATA)-1ATb。

(6)

因此目標(biāo)點(diǎn)的位置為

(7)

2 基于測(cè)距的自適應(yīng)模型

2.1 存在的問題

大型艙室內(nèi)，基于測(cè)距的定位方法在實(shí)際應(yīng)用中通常會(huì)存在目標(biāo)點(diǎn)到某個(gè)基站之間的測(cè)距信息誤差較大，而到其他基站測(cè)距信息較為準(zhǔn)確的現(xiàn)象，如圖2所示。出現(xiàn)該現(xiàn)象一方面因?yàn)榕撌覂?nèi)環(huán)境相比較于室外環(huán)境復(fù)雜多變，房間的墻壁、物品的擺放以及人員的走動(dòng)都可能會(huì)導(dǎo)致無線信號(hào)的傳播存在非視距、多路徑等因素的影響，當(dāng)目標(biāo)點(diǎn)與該基站之間有物品的遮擋，無法實(shí)現(xiàn)目標(biāo)點(diǎn)與基站之間無線信號(hào)的視距傳播時(shí)，測(cè)距信息就會(huì)存在較大的非視距傳播誤差；另一方面由于未知情況下基站存在故障，也可能會(huì)導(dǎo)致目標(biāo)點(diǎn)到該基站之間的測(cè)距信息出現(xiàn)誤差較大的現(xiàn)象。

若將誤差較大的測(cè)距信息用于位置解算，該解算的結(jié)果也將存在較大誤差，降低定位精度。

2.2 自適應(yīng)模型

在目標(biāo)點(diǎn)位置解算過程中，發(fā)現(xiàn)某個(gè)基站的測(cè)距信息誤差較大，若該基站數(shù)據(jù)依然用于目標(biāo)位置解算，定會(huì)影響定位精度。在基站冗余的情況下，若能把該基站數(shù)據(jù)剔除，使用誤差較小的基站測(cè)距數(shù)據(jù)解算位置，將會(huì)提高定位精度。本文提出的自適應(yīng)算法著重于解決少數(shù)基站測(cè)距數(shù)據(jù)誤差較大問題，算法框圖如圖3所示。

(8)

式中i、j、k為n個(gè)基站中的任意3個(gè)。然后判斷交點(diǎn)是否都處于3個(gè)基站圓位置線上或者內(nèi)部。若滿足

(9)

則說明交點(diǎn)Cm處于3個(gè)基站圓位置線上或者內(nèi)部，其中Cm為6個(gè)交點(diǎn)中的任意一個(gè)。當(dāng)任意3個(gè)基站之間滿足

(10)

此時(shí)位于3個(gè)基站圓位置線上或內(nèi)部的交點(diǎn)僅有3個(gè)，說明該3個(gè)基站測(cè)距較為理想，可用于目標(biāo)點(diǎn)位置解算。設(shè)3個(gè)交點(diǎn)分別為A(xA,yA)、B(xB,yB)、C(xC,yC)，為了減少計(jì)算量，此時(shí)所得第i、j、k3個(gè)基站組合的圓位置線相交的公共區(qū)域面積Sijk近似為3個(gè)交點(diǎn)組成的三角形面積。則有

(11)

定義面積因子

(12)

比較不同基站組合之間的公共區(qū)域面積大小，選取面積最小時(shí)對(duì)應(yīng)的3個(gè)基站用于目標(biāo)點(diǎn)位置解算。J的值越小，通常情況下定位精度越高。

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

3.1 實(shí)驗(yàn)環(huán)境

為了驗(yàn)證算法的性能，本文采用Nanotron公司研發(fā)的基于CSS定位原理的Nano定位系統(tǒng)進(jìn)行實(shí)驗(yàn)，系統(tǒng)由4個(gè)基站和1個(gè)定位標(biāo)簽組成。實(shí)驗(yàn)在大會(huì)議室進(jìn)行，將基站布局在房間的4個(gè)角落，在中間區(qū)域選擇9個(gè)參考點(diǎn)，實(shí)驗(yàn)平面場(chǎng)景如圖4所示。

1)房間為11 m×10 m長(zhǎng)方形區(qū)域，定位系統(tǒng)布局如圖4所示；

2)基站高度為2 m，定位標(biāo)簽高度為1 m，采集標(biāo)簽到各個(gè)基站之間的距離數(shù)據(jù)；

3)基站放于房間4個(gè)角落，坐標(biāo)依次為A(0，0)、B(9，0)、C(9，9.6)、D(0，9.6)；

4)標(biāo)簽分別放置于9個(gè)參考點(diǎn)，坐標(biāo)依次為(4.2，4.2)、(3，2.4)、(4.2，2.4)、(6，2.4)、(6，4.2)、(6，6)、(4.2，6)、(3，6)、(3，4.2)。

3.2 方案設(shè)計(jì)及數(shù)據(jù)采集

將各個(gè)基站按照上述實(shí)驗(yàn)場(chǎng)景布置，分別對(duì)4個(gè)基站依次進(jìn)行實(shí)驗(yàn)。通過在基站與目標(biāo)之間擺放書柜，造成該基站受到非視距傳播的干擾，并將目標(biāo)點(diǎn)依次放于9個(gè)參考點(diǎn)位置，采集目標(biāo)點(diǎn)到各個(gè)基站之間的距離信息，采集的部分?jǐn)?shù)據(jù)如圖5所示。

圖5數(shù)據(jù)共分為4列，分別表示4個(gè)基站A、B、C、D依次受到干擾情況下所采集的數(shù)據(jù)信息。每一列中4行為一組，每行表示目標(biāo)與該基站之間的測(cè)距信息，且每行中的第一個(gè)數(shù)表示基站與目標(biāo)之間的距離，第2個(gè)數(shù)表示目標(biāo)代號(hào)，第3個(gè)表示基站代號(hào)，001、002、003、004對(duì)應(yīng)A、B、C、D，第4個(gè)數(shù)表示測(cè)距信息是否正常，015表示測(cè)距正常，其他值表示測(cè)距異常。由圖5可以看出：當(dāng)基站與目標(biāo)之間受到非視距傳播時(shí)，測(cè)距信息出現(xiàn)異常，測(cè)量距離遠(yuǎn)大于真實(shí)距離；而且第四列出現(xiàn)一組數(shù)據(jù)第四個(gè)基站測(cè)距無效現(xiàn)象，即第四個(gè)基站時(shí)而正常，時(shí)而故障。

3.3 數(shù)據(jù)處理及分析

按照采集的目標(biāo)點(diǎn)到各個(gè)基站之間的距離信息，分別利用傳統(tǒng)的坐標(biāo)位置解算方法(即將所有基站數(shù)據(jù)參與目標(biāo)點(diǎn)的位置解算)和本文改進(jìn)的自適應(yīng)算法進(jìn)行解算，同時(shí)采集定位系統(tǒng)自身輸出的定位結(jié)果進(jìn)行統(tǒng)計(jì)分析，比較3者之間在各個(gè)參考點(diǎn)的平均定位誤差。分別見表2和圖6。

表2 3種不同方式在各參考點(diǎn)的平均誤差

圖6表示3種不同方式在各個(gè)參考點(diǎn)的平均誤差，其中橫坐標(biāo)數(shù)值參考點(diǎn)的序號(hào)和坐標(biāo)值參照表2。綜合表2和圖6可知，傳統(tǒng)坐標(biāo)位置解算由于沒有排除誤差較大基站的影響，將所有可用的基站均參與目標(biāo)點(diǎn)的坐標(biāo)位置解算，平均誤差在2 m左右，在某些特殊情況下誤差更大。自適應(yīng)算法解算出的坐標(biāo)位置與系統(tǒng)直接輸出的坐標(biāo)位置在各個(gè)參考點(diǎn)的平均誤差基本小于1 m，說明改進(jìn)的自適應(yīng)算法在定位精度上有較大的提高。

4 結(jié)束語

本文在分析傳統(tǒng)定位算法的不足的基礎(chǔ)上，提出一種自適應(yīng)定位算法，通過分析多個(gè)圓位置線之間的關(guān)系，引入面積因子比較機(jī)制，剔除測(cè)距誤差較大的基站數(shù)據(jù)，選擇最優(yōu)的基站組合參與定位解算，提高了定位精度。該算法使得定位系統(tǒng)具有較好的環(huán)境適應(yīng)能力，即使在少數(shù)基站存在較為嚴(yán)重的非視距傳播或者少數(shù)基站發(fā)生故障時(shí)也具備良好的定位性能。而對(duì)于無線傳播的多路徑效應(yīng)問題，還有待進(jìn)一步研究和解決。

[1] STYLIANOU G.Relative indoor spatial tracking and navigation[J].International Journal of Wireless & Mobile Computing，2015，9(1)：8-26.

[2] CHEN R C，HUANG S W，LIN Y C，et al.An indoor location system based on neural network and genetic algorithm[J].International Journal of Sensor Networks，2015，19(3/4)：204-216.

[3] ZHENG L，ZHOU W，TANG W，et al.A 3D indoor positioning system based on low-cost MEMS sensors[J].Simulation Modelling Practice & Theory，2016，65：45-56.

[4] 李體紅，豐樹謙.室內(nèi)無線傳感網(wǎng)絡(luò)差分定位算法研究[J].計(jì)算機(jī)仿真，2010，27(7)：102-104.

[5] 傅軍，朱濤，李峰.一種NLOS環(huán)境下TOA與慣導(dǎo)信息的融合定位方法[J].海軍工程大學(xué)學(xué)報(bào)，2015，27(5)：34-38.

[6] 李峰，朱濤，傅軍.一種基于卡爾曼濾波的TOA定位算法[J].自動(dòng)化與儀器儀表，2013(1)：116-118.

[7] 趙永翔，周懷北，陳淼，等.卡爾曼濾波在室內(nèi)定位系統(tǒng)實(shí)時(shí)跟蹤中的應(yīng)用[J].武漢大學(xué)學(xué)報(bào)(理學(xué)版)，2009，55(6)：696-700.

[8] 劉見輝，王冬，劉鳳英，等.高精度UWB/SINS組合室內(nèi)定位系統(tǒng)研究[J].導(dǎo)航定位學(xué)報(bào)，2016，4(2)：53-56，86.

[9] 曾輝，鄧中亮，薛宸，等.基于無跡卡爾曼濾波的無線定位與IMU組合室內(nèi)定位算法[EB/OL].[2017-02-18].http：//d.wanfangdata.com.cn/Conference/8474978.

[10] 馬燕，袁蔚林，陳秀萬，等.基于WiFi與GPS組合定位算法的無縫定位方法研究[J].地理與地理信息科學(xué)，2013，29(3)：6-9，16.

[11] 趙銳，鐘榜，朱祖禮，等.室內(nèi)定位技術(shù)及應(yīng)用綜述[J].電子科技，2014，27(3)：154-157.