消防員應(yīng)急救助三維定位技術(shù)①

劉高平,張金燕(浙江萬里學(xué)院 EDA重點(diǎn)實(shí)驗(yàn)室,寧波 315100)

?

消防員應(yīng)急救助三維定位技術(shù)①

劉高平,張金燕
(浙江萬里學(xué)院 EDA重點(diǎn)實(shí)驗(yàn)室,寧波 315100)

摘 要:研究了一種在火災(zāi)現(xiàn)場對被困消防員進(jìn)行應(yīng)急救助的三維定位方案.該方案采用線性調(diào)頻擴(kuò)頻(CSS)技術(shù)與其獨(dú)有的對稱雙邊兩路測距(SDS-TWR)機(jī)制,并結(jié)合BMP085氣壓傳感器測量高度,實(shí)現(xiàn)對消防員的三維定位.由于火災(zāi)現(xiàn)場復(fù)雜的環(huán)境加強(qiáng)了Chirp信號(hào)傳輸時(shí)的多徑效應(yīng),因此采用卡爾曼濾波法濾除坐標(biāo)突變值,能夠?qū)⒍ㄎ徽`差控制在1m以內(nèi).

關(guān)鍵詞:線性調(diào)頻擴(kuò)頻; 對稱雙邊兩路測距; 消防救助; 三維定位; 卡爾曼濾波

由于人們消防意識(shí)的欠缺,越來越多關(guān)于年輕消防員救火犧牲的新聞見諸報(bào)端.本文研究的定位技術(shù)能夠記錄每一位消防員在火災(zāi)現(xiàn)場的運(yùn)動(dòng)軌跡,有助于對被困消防員進(jìn)行應(yīng)急救助,強(qiáng)有力的保障消防員的人身安全.由于大多數(shù)火災(zāi)都發(fā)生在室內(nèi),GPS衛(wèi)星的信號(hào)在室內(nèi)容易被遮擋,而CSS技術(shù)能夠很好地解決室內(nèi)定位的精度問題.線性調(diào)頻擴(kuò)頻技術(shù)(Chirp Spread Spectrum,CSS)是采用Chirp信號(hào)實(shí)現(xiàn)擴(kuò)頻的通信技術(shù).CSS技術(shù)通過對載波進(jìn)行調(diào)制以增加信號(hào)的發(fā)射帶寬,并在接收時(shí)實(shí)現(xiàn)脈沖壓縮,具有抗衰減能力強(qiáng)、傳輸距離遠(yuǎn)、功耗低等優(yōu)點(diǎn)[1-3].CSS技術(shù)其特有的對稱雙邊兩路測距(SDS-TWR,Symmetric Double-Sided Two-Way Ranging)機(jī)制是一種基于到達(dá)時(shí)間(Time of Arrival,TOA)的測距方法,根據(jù)無線信號(hào)從發(fā)射端到達(dá)接收端的傳輸時(shí)間計(jì)算出基站與定位目標(biāo)之間的距離,并通過一定的定位算法實(shí)現(xiàn)對消防員的定位.

1　CSS技術(shù)測距原理

1.1Chirp信號(hào)特征

Chirp(啁啾)信號(hào)是一種頻率調(diào)變的脈沖,在T的時(shí)間區(qū)間里面,其頻率隨著時(shí)間做線性變化,而且呈單調(diào)遞增或遞減的趨勢.Chip信號(hào)的數(shù)學(xué)表達(dá)式為[4]:

其中,rect(t/T)是Chirp信號(hào)的包絡(luò),T為脈沖寬度,f0為載頻,μ=B/T為線性調(diào)頻斜率,B為信號(hào)調(diào)頻帶寬.表達(dá)式中“+”表示正向線性調(diào)頻脈沖(Up-Chirp),“-”表示反向線性調(diào)頻脈沖(Down-Chirp).

1.2Chirp信號(hào)脈沖壓縮原理

CSS在接收數(shù)據(jù)時(shí)采用脈沖壓縮原理,Up-Chirp信號(hào)與Down-Chirp信號(hào)相互正交,有良好的自相關(guān)性,因此可以互相作為其匹配濾波器的沖擊響應(yīng),進(jìn)行相干匹配濾波.

以上升頻信號(hào)為例,Up-Chirp信號(hào)經(jīng)過匹配濾波后的最終表達(dá)式為:

由上式可知,輸出波形具有尖銳的時(shí)域特性,幅度為1的Chirp信號(hào)經(jīng)過壓縮后成為sinc函數(shù),包絡(luò)幅度放大為原來的倍,且能量集中在寬度為2/B的時(shí)間段內(nèi)[5].Chirp信號(hào)的一個(gè)重要指標(biāo)是時(shí)間帶寬積,即BT積.由于Chirp信號(hào)的BT積遠(yuǎn)大于1,因此Chirp信號(hào)具有較強(qiáng)的抗干擾能力.

1.3Chirp信號(hào)時(shí)延估計(jì)及仿真

在復(fù)雜的室內(nèi)環(huán)境中,發(fā)射出去的信號(hào)受到障礙物的遮擋,經(jīng)過反射、折射后形成多條路徑到達(dá)接收站,實(shí)際接收到的信號(hào)是多條路徑的疊加,這就是多徑效應(yīng).不同路徑到達(dá)接收站都具有一定的時(shí)差,該時(shí)差通常在ns級(jí)[6].對Chirp信號(hào)經(jīng)過匹配濾波后,通過峰值檢測會(huì)得到多個(gè)時(shí)延估計(jì)值,將最強(qiáng)徑所對應(yīng)的時(shí)延估計(jì)值作為信號(hào)的實(shí)際傳輸時(shí)間.

設(shè)接收端的Chirp信號(hào)相對于發(fā)送端時(shí)延為t0,匹配濾波器的增益為,那么匹配濾波器的輸出為:

用Matlab軟件對Chirp信號(hào)進(jìn)行仿真,假設(shè)Chirp信號(hào)的中心頻率f0=2GHz,脈沖寬度T=1μs,信號(hào)帶寬B=100MHz,斜率μ=B/T=100MHz/μs,該Chirp信號(hào)的時(shí)域波形及自相關(guān)波形如圖1所示.

圖1　Chirp信號(hào)的時(shí)域波形及自相關(guān)波形圖

假設(shè)信號(hào)是從距離發(fā)射端15m、30m、60m的位置反射回來,接收端進(jìn)行匹配濾波后檢測到不同的峰值,其對應(yīng)的到達(dá)時(shí)延分別為100ns、200ns、400ns.Chirp信號(hào)經(jīng)脈沖壓縮后的時(shí)延估計(jì)波形如圖2所示.

圖2　脈沖壓縮時(shí)延估計(jì)波形

1.4對稱雙邊兩路測距機(jī)制

CSS技術(shù)采用對稱雙邊兩路測距機(jī)制,只需滿足各基站之間保持時(shí)鐘同步即可[7],該方法能夠有效地避免晶振漂移,它有兩次數(shù)據(jù)交換的過程,其原理如圖3所示[8].

節(jié)點(diǎn)A向節(jié)點(diǎn)B發(fā)送數(shù)據(jù)包并接收節(jié)點(diǎn)B發(fā)送的應(yīng)答,計(jì)算出從發(fā)出數(shù)據(jù)包到接收到應(yīng)答的傳輸延時(shí)troundA,節(jié)點(diǎn)B從接收到數(shù)據(jù)包開始計(jì)時(shí),一直到發(fā)送出應(yīng)答,得到處理延時(shí)treplyB.節(jié)點(diǎn)A接收到由節(jié)點(diǎn)B發(fā)送的包含treplyB的應(yīng)答數(shù)據(jù)包后完成第一次數(shù)據(jù)交換.通過兩次數(shù)據(jù)交換,計(jì)算出信號(hào)傳輸?shù)臅r(shí)間tp,從而得出節(jié)點(diǎn)之間的距離計(jì)算公式如下,其中c為信號(hào)的傳播速率,約為光速.

圖3　對稱雙邊兩路測距原理

2　三維定位算法及誤差補(bǔ)償

2.1系統(tǒng)架構(gòu)

應(yīng)急救助定位系統(tǒng)在緊急情況(如火災(zāi))下架設(shè),一般由移動(dòng)標(biāo)簽(Tag)、位置固定的基站(Anchor)和監(jiān)控終端(PAD、PC或筆記本電腦)組成.

移動(dòng)標(biāo)簽是整個(gè)系統(tǒng)的最底層,負(fù)責(zé)測量與各個(gè)固定基站之間的距離,并以廣播包的形式將定位數(shù)據(jù)包發(fā)送給各個(gè)基站.移動(dòng)標(biāo)簽安裝在移動(dòng)節(jié)點(diǎn)(如消防員)上,并在規(guī)定時(shí)限內(nèi)定時(shí)將位置送到監(jiān)控終端,實(shí)現(xiàn)移動(dòng)標(biāo)簽的實(shí)時(shí)定位.

一種典型的移動(dòng)標(biāo)簽的內(nèi)部結(jié)構(gòu)框圖如圖4所示.其中氣壓傳感器用于標(biāo)簽的高度測量.近來利用氣壓傳感器進(jìn)行高度測量的應(yīng)用研究很多,如文獻(xiàn)[9-11],本文不再贅述.

圖4　典型的移動(dòng)標(biāo)簽硬件框圖

基站的位置是固定不變的,可以看成是已知坐標(biāo)的定位節(jié)點(diǎn),它用于接收從標(biāo)簽發(fā)送來的定位數(shù)據(jù)包,并利用CSS技術(shù)測距原理計(jì)算出基站與標(biāo)簽之間的距離.基站的數(shù)量根據(jù)應(yīng)急現(xiàn)場的情況設(shè)置而定,可以為2個(gè)、3個(gè)或者4個(gè),一般將基站臨時(shí)安裝在應(yīng)急現(xiàn)場(如大樓、倉庫等)的周圍,并根據(jù)基站的位置設(shè)定其坐標(biāo).其中一個(gè)基站與監(jiān)控終端相連,輸出接收到的數(shù)據(jù)給監(jiān)控終端,基站的硬件框圖基本上與移動(dòng)標(biāo)簽類似.

監(jiān)控終端的作用是接收各移動(dòng)標(biāo)簽發(fā)送來的位置與環(huán)境信息,利用下文2.2中的三維定位算法計(jì)算出移動(dòng)標(biāo)簽的坐標(biāo),并對基站輸出的數(shù)據(jù)進(jìn)行濾波處理與修正; 在定位軟件的圖形界面上實(shí)時(shí)顯示出當(dāng)前時(shí)刻各基站、標(biāo)簽的三維位置.

2.2三維定位算法

各基站與移動(dòng)標(biāo)簽之間的距離、以及它們相對于地平面的高度知道后,就可以通過幾何計(jì)算得出移動(dòng)標(biāo)簽的位置.

假設(shè)zi為基站i(i∈[1,N],其中N為基站總數(shù))到地面的高度,即基站i的z坐標(biāo)值,通過氣壓-高度轉(zhuǎn)換得到標(biāo)簽與基站i的海拔高度[9-11],分別為h、hi,則標(biāo)簽坐標(biāo)z的計(jì)算公式如下:

由于各基站并不嚴(yán)格地處于同一水平面,因此需要將基站及標(biāo)簽都投影到水平面.在此記標(biāo)簽與基站i之間的實(shí)際距離為ri,則ri在地面的投影為:

1)當(dāng)N=2時(shí)

在此情況下,基站部署時(shí)必須保證標(biāo)簽在兩個(gè)基站連線的同一側(cè),如圖5為二基站式三維定位示意圖.其中P1、P2為固定基站,其坐標(biāo)為(xi,yi),(i=1,2); T為移動(dòng)標(biāo)簽,通過幾何計(jì)算有兩種可能的坐標(biāo),分別設(shè)為Ta、Tb,其坐標(biāo)分別為(xta,yta)和(xtb,ytb).

圖5　二基站式三維定位示意圖

計(jì)算第一種可能的移動(dòng)標(biāo)簽坐標(biāo),d1與橫坐標(biāo)的夾角θ為:

移動(dòng)標(biāo)簽的縱坐標(biāo)為:

若x1

若x1>x2,則移動(dòng)標(biāo)簽的橫坐標(biāo)為:

計(jì)算第二種可能的移動(dòng)標(biāo)簽坐標(biāo),d1與橫坐標(biāo)的夾角θ為:

移動(dòng)標(biāo)簽的縱坐標(biāo)為:

若x1

若x1>x2,則移動(dòng)標(biāo)簽的橫坐標(biāo)為:

在兩個(gè)基站實(shí)際部署時(shí),事先知曉標(biāo)簽位于連線的側(cè)位,因此,可以選取正確的坐標(biāo)值.

2)當(dāng)N=3時(shí)

圖6為三基站式三維定位的示意圖.將3個(gè)基站兩兩組合,共有3組,即: (P1,P2)、(P1,P3)、(P2,P3).每組2個(gè)基站,與標(biāo)簽構(gòu)成類似于圖5的情況.對于一個(gè)組,通過上述(1)的定位計(jì)算方法,可以得出兩種可能的坐標(biāo)(xta,yta)和(xtb,ytb).然后,分別計(jì)算這兩個(gè)坐標(biāo)與另外一個(gè)基站的距離,選取距離較短的點(diǎn)為標(biāo)簽坐標(biāo).最后,將三組分別計(jì)算的標(biāo)簽坐標(biāo)求平均值,即為移動(dòng)標(biāo)簽的位置.

圖6　三基站式三維定位示意圖

3)當(dāng)N=4時(shí)

圖7為四基站式三維定位的示意圖.將4個(gè)基站兩兩組合,共有6組,即: (P1,P2)、(P1,P3)、(P1,P4)、(P2,P3)、(P2,P4)、(P3,P4).每組2個(gè)基站,與標(biāo)簽構(gòu)成類似于圖5的情況.對于一個(gè)組,通過上述(1)的定位計(jì)算方法,可以得出兩種可能的坐標(biāo)(xta,yta)和(xtb,ytb).然后,分別計(jì)算這兩個(gè)坐標(biāo)與另外2個(gè)基站的距離之和,選取距離之和較小的點(diǎn)為標(biāo)簽坐標(biāo).最后,將6組分別計(jì)算的標(biāo)簽坐標(biāo)求平均值,即為移動(dòng)標(biāo)簽的位置.

圖7　四基站式三維定位示意圖

2.3卡爾曼濾波法消除突變值

卡爾曼濾波法是一種線性最小均方誤差估計(jì),它采用迭代算法,根據(jù)前一次估計(jì)值和當(dāng)前輸入值計(jì)算得到當(dāng)前的估計(jì)值.卡爾曼濾波器主要由兩個(gè)方程實(shí)現(xiàn)[12]:

狀態(tài)方程:

測量方程:

以上兩式中,s(k)、z(k)分別是k時(shí)刻的狀態(tài)向量和測量向量,A和G分別是狀態(tài)轉(zhuǎn)移矩陣和測量矩陣,w(k)及v(k)是加性噪聲分量.

由于實(shí)際情況下物體運(yùn)動(dòng)軌跡的連續(xù)性和不可突變性,測量值也應(yīng)該是連續(xù)不可突變的.當(dāng)相鄰兩個(gè)時(shí)刻的估計(jì)值差異超過某一特定門限時(shí),就表示該時(shí)刻獲得的測量值誤差較大,如火災(zāi)室內(nèi)現(xiàn)場雜物(如鐵門)對無線電波的阻擋,造成移動(dòng)標(biāo)簽在運(yùn)動(dòng)過程中短時(shí)不能通過直接路徑與基站通信,引起標(biāo)簽的位置突變.這些突變的位置前后時(shí)間是不可預(yù)測也是不相關(guān)的,可以視為是在測量過程中高斯噪聲引起的誤差.此時(shí),需要對k時(shí)刻的估計(jì)值加以修正,而卡爾曼濾波法的速度估計(jì)性能提供了有效的修正方法,即

第1步.計(jì)算當(dāng)前時(shí)刻計(jì)算出的標(biāo)簽點(diǎn)與上一時(shí)刻計(jì)算出的標(biāo)簽點(diǎn)之間的水平距離d(k),以及兩者之間的高度差h(k):

第2步.計(jì)算標(biāo)簽點(diǎn)相對于上一時(shí)刻所在位置的水平移動(dòng)速度v(k)和高度變化速度u(k):

第3步.若v(k)>vmax或u(k)>umax,即該坐標(biāo)值為突變值,則對該坐標(biāo)值進(jìn)行修正:

其中x'(k)、y'(k)、z'(k)分別為x、y、z在時(shí)刻k時(shí)實(shí)際測量獲得的值.比如,卡爾曼濾波前后的x坐標(biāo)值波形如圖8所示,從圖中可見,濾波后的波形相對更加平滑,有效地提高了定位精度.

圖8　濾波前后的x坐標(biāo)波形對比

3　定位實(shí)驗(yàn)測試與結(jié)果

3.1系統(tǒng)實(shí)現(xiàn)

基站與標(biāo)簽的微處理器采用STM32F103CB,無線射頻芯片采用NA5TR1.NA5TR1采用對稱雙邊兩路測距(SDS-TWR)機(jī)制,通過測量不同節(jié)點(diǎn)間的信號(hào)傳輸延時(shí),可實(shí)時(shí)計(jì)算出基站與移動(dòng)標(biāo)簽間的距離.NA5TR1是Nanotron公司推出的基于CSS技術(shù)的無線收發(fā)芯片,該芯片的工作頻段為2.4G的免授權(quán)ISM頻段(2.4～2.4835 GHz),采用頻點(diǎn)為2.44 GHz,具有功耗低、精度高,抗干擾能力強(qiáng)、傳輸距離遠(yuǎn)等優(yōu)點(diǎn),能有效地應(yīng)用于室內(nèi)移動(dòng)物體定位[13][14].NA5TR1典型的最小應(yīng)用系統(tǒng)如圖9所示.

氣壓傳感器采用BMP085,用于測量基站與標(biāo)簽的絕對高度[9,11].BMP085數(shù)字氣壓傳感器由電阻式壓力傳感器、模數(shù)轉(zhuǎn)換器和帶有E2PROM的控制單元組成,控制單元通過I2C總線與STM32F103CB連接.

圖9　NA5TR1最小系統(tǒng)

3.2測試情況

定位實(shí)驗(yàn)在實(shí)驗(yàn)室環(huán)境下進(jìn)行.將基站1、基站2、基站3、基站4的坐標(biāo)分別設(shè)置為(0.0,0.0,1.4)、(0.0,13.2,1.6)、(15.4,13.2,2.6)、(15.4,0.0,1.6),將標(biāo)簽放置到(9.4,7.6,1.4)的位置.實(shí)驗(yàn)結(jié)果如圖10所示.

圖10　三維定位實(shí)驗(yàn)結(jié)果

定位誤差如圖11所示,誤差表示標(biāo)簽坐標(biāo)計(jì)算值與真實(shí)位置之間的距離.10次測試中定位誤差最大值為0.63m,最小值為0.24m,誤差平均值為0.51m.經(jīng)過多次實(shí)驗(yàn),定位誤差大多能控制在1m以內(nèi).

圖11　定位誤差

4　結(jié)語

本文針對目前火災(zāi)現(xiàn)場消防員的人身安全得不到保障的問題,研究了適用于室內(nèi)火災(zāi)現(xiàn)場的三維定位技術(shù).本文介紹了Chirp信號(hào)脈沖壓縮原理,對Chirp信號(hào)時(shí)延估計(jì)進(jìn)行了仿真,并介紹了CSS技術(shù)特有的對稱雙邊兩路測距原理; 重點(diǎn)提出了一種三維定位算法,并采用卡爾曼濾波法對坐標(biāo)突變值進(jìn)行濾波,有效地提高了定位精度.最后通過定位實(shí)驗(yàn)驗(yàn)證定位精度能達(dá)到1m以內(nèi),能夠精確定位被困消防員,因此研究本技術(shù)對被困消防員應(yīng)急救助具有深遠(yuǎn)的現(xiàn)實(shí)意義.

參考文獻(xiàn)

1R?hrig C,Iaeng M,Lategahn J,Müller M,Telle L.Global localization for a swarm of autonomous transport vehicles using IEEE 802.15.4a CSS.In: Ao SI,ed.Proc.of the International Multi Conference of Engineers and Computer Scientists 2012.Hong Kong.International Association of Engineers.2012.828–833.

2Kang H,Seo Gw,Lee J.Error compensation for CSS-based Localization System.In: Ao SI,ed.Proc.of the World Congress on Engineering and Computer Science.San Francisco: International Association of Engineers,2009: 696–701.

3Yang ZW,Wu Q,Lu YQ,Hou YH,Peng M.Enhanced ALOHA algorithm for chirp spread spectrum positioning.In: Zu QH,ed.Pervasive Computing and the Networked World.Berlin.Springer Berlin Heidelberg.2013.891–903.

4萬磊.Chirp超寬帶系統(tǒng)的同步技術(shù)研究與實(shí)現(xiàn)[碩士學(xué)位論文].成都:解放軍信息工程大學(xué),2010.

5陸侃.基于線性調(diào)頻信號(hào)的定位技術(shù)研究[碩士學(xué)位論文].成都:電子科技大學(xué),2011.

6王明.基于Chirp超寬帶通信技術(shù)的研究與實(shí)現(xiàn)[碩士學(xué)位論文].成都:電子科技大學(xué),2010.

7彭宇,王丹.無線傳感器網(wǎng)絡(luò)定位技術(shù)綜述.電子測量與儀器學(xué)報(bào),2011,25(5):389–399.

8張巖,魏書田,張守祥.啁啾擴(kuò)頻超寬帶技術(shù)的測距定位研究.計(jì)算機(jī)工程與應(yīng)用,2012,48(28):130–134.

9王俊彩,王福平,侯瑞峰,王成.基于BMP085的一種便攜式海拔高度測量系統(tǒng)設(shè)計(jì).傳感器與微系統(tǒng),2011,30(12):123 –125

10梁勝展,郭雪梅,余曉填.基于BMP085氣壓傳感器及BP算法的高度測量研究與實(shí)現(xiàn).傳感技術(shù)學(xué)報(bào),2013,26(5):654 – 659

11張金燕,劉高平,楊如祥.基于氣壓傳感器BMP085的高度測量系統(tǒng)實(shí)現(xiàn).微型機(jī)與應(yīng)用,2014,33(6): 64–67.

12黃清明,劉琚.基于卡爾曼濾波的測量值重構(gòu)及定位算法.電子與信息學(xué)報(bào),2007,29(7):1551–1555.

13谷戰(zhàn)壘,何誠,寧月松.基于NA5TR1的無線定位節(jié)點(diǎn)的設(shè)計(jì).電子設(shè)計(jì)工程,2011,19(9):189–192.

14鞏家昌,張軍.Nanotron技術(shù)在無線測距系統(tǒng)中的應(yīng)用.現(xiàn)代電子技術(shù),2011,34(3): 56–58.

3D Positioning Technology for Firefighters’ Emergency Rescue

LIU Gao-Ping,ZHANG Jin-Yan
(EDA Key Laboratory,Zhejiang Wanli University,Ningbo 315100,China)

Abstract:This paper researches a three-dimensional positioning scheme for emergency rescue of trapped firefighters at the fire scene.This scheme adopts Chirp Spread Spectrum (CSS)and it’s particular Symmetric Double-Sided Two-Way Ranging (SDS-TWR).Combining BMP085 pressure sensor to measure altitude,it can implement three-dimensional positioning of firefighters.Due to the complex environment of the fire scene would cause multipath effect when Chirp signal being transmitted,this scheme uses Kalman filtering method to filter out mutative coordinate value,thus the positioning error can be controlled within 1 m.

Key words:chirp spread spectrum; symmetric double-sided two-way ranging ranging; fire rescue; 3D positioning; Kalman filter

基金項(xiàng)目:①浙江省公益技術(shù)應(yīng)用研究計(jì)劃項(xiàng)目(2015C33023);寧波市社會(huì)發(fā)展科技攻關(guān)項(xiàng)目(2014C50022)

收稿時(shí)間:2015-07-08;收到修改稿時(shí)間:2015-09-21