孫繼平，李晨鑫

(中國礦業(yè)大學(xué)(北京) 機(jī)電與信息工程學(xué)院，北京 100083)

基于WiFi和計(jì)時(shí)誤差抑制的TOA煤礦井下目標(biāo)定位方法

孫繼平，李晨鑫

(中國礦業(yè)大學(xué)(北京) 機(jī)電與信息工程學(xué)院，北京 100083)

針對現(xiàn)有煤礦井下目標(biāo)定位方法精度不能滿足應(yīng)急救援、井下人員作業(yè)管理以及煤礦物聯(lián)網(wǎng)建設(shè)對精確定位的需要，提出基于TOA(Time of Arrival)的煤礦井下目標(biāo)精確定位方法。針對TOA方法用于目標(biāo)定位受設(shè)備計(jì)時(shí)誤差影響較大，井下巷道呈一維條狀分布，無法采用地面常用的二維、三維抑制誤差算法，提出基于計(jì)時(shí)誤差抑制的TOA煤礦井下目標(biāo)定位方法，建立雙路WiFi(Wireless Fidelity)信道+單路光纖信道的一維定位方法和信號收發(fā)計(jì)時(shí)方式，在此基礎(chǔ)上提出計(jì)時(shí)誤差抑制算法。測試結(jié)果證明計(jì)時(shí)誤差抑制算法在采用此定位方法基礎(chǔ)上，有效地抑制了設(shè)備計(jì)時(shí)誤差造成的測距誤差，實(shí)測誤差不影響定位精度，驗(yàn)證了此方法的定位性能。

煤礦井下；目標(biāo)定位；TOA；WiFi；計(jì)時(shí)誤差抑制算法

現(xiàn)有煤礦井下目標(biāo)定位方法定位精度不足，不能滿足事故應(yīng)急救援、井下作業(yè)人員管理、煤礦物聯(lián)網(wǎng)建設(shè)對精確定位的需求[1-6]。

目前，基于到達(dá)時(shí)間的TOA(Time of Arrival)方法應(yīng)用于目標(biāo)精確定位具有一定研究基礎(chǔ)[7-11]。TOA方法定位精度受設(shè)備時(shí)延、計(jì)時(shí)器頻率偏移等計(jì)時(shí)誤差因素影響，二維平面、三維空間定位的算法可以對抑制計(jì)時(shí)誤差，但不適用呈條狀分布的煤礦井下巷道一維環(huán)境。對稱雙邊雙路測量的SDS-TWR方法[12-13]能部分抑制計(jì)時(shí)誤差，但僅針對每次信號收發(fā)處理時(shí)延完全一致的情況，未考慮每次處理時(shí)延存在差異造成的影響。

筆者提出針對煤礦井下特定環(huán)境的TOA目標(biāo)定位方法，建立雙路WiFi(Wireless Fidelity)信道+單路光纖信道的一維定位方法，提出抑制計(jì)時(shí)誤差的算法，將計(jì)時(shí)誤差在計(jì)算中抵消，實(shí)現(xiàn)TOA方法在煤礦井下目標(biāo)定位中的有效應(yīng)用。

1 計(jì)時(shí)誤差對TOA方法的影響

TOA方法利用信號在發(fā)射機(jī)和接收機(jī)之間的傳播時(shí)間計(jì)算距離，實(shí)現(xiàn)目標(biāo)定位。計(jì)時(shí)誤差對定位精度影響較大。

1.1 計(jì)時(shí)誤差對單程測距的影響

利用信號單程傳播時(shí)間測距方法計(jì)算公式為

(1)

式中，d為發(fā)射機(jī)與接收機(jī)距離；c為光速；t為測得的信號傳播時(shí)間；Δt為設(shè)備時(shí)鐘同步時(shí)延。

測距誤差與同步時(shí)延的關(guān)系如圖1所示。同步時(shí)延對單程測距方法影響極大。

圖1 單程測距誤差Fig.1 Error of one-way distance-measuring

1.2 計(jì)時(shí)誤差對雙程測距的影響

利用信號雙程往復(fù)傳播時(shí)間方法計(jì)算公式為

(2)

式中，T1為發(fā)射機(jī)自發(fā)出檢測信號起至接收到回應(yīng)信號止的時(shí)間；T2為接收機(jī)自接收到檢測信號起至發(fā)出回應(yīng)信號止的時(shí)間；e1，e2分別為發(fā)射機(jī)計(jì)時(shí)器、接收機(jī)計(jì)時(shí)器的頻率偏移系數(shù)。

雙程測距方法誤差-(e1T1-e2T2)是由于計(jì)時(shí)器存在頻率偏移造成計(jì)時(shí)誤差導(dǎo)致。參考IEEE802.11標(biāo)準(zhǔn)，頻率偏移不超過±25×10-6[14]，測距誤差與收發(fā)計(jì)時(shí)器頻率偏移系數(shù)差、處理時(shí)延的關(guān)系如圖2所示。計(jì)時(shí)器頻率偏移及處理時(shí)延對雙程測距方法影響較大。

圖2 雙程測距誤差Fig.2 Error of reciprocating path distance-measuring

1.3 小 結(jié)

圖1和圖2表明，TOA定位的精度受設(shè)備時(shí)延、計(jì)時(shí)器頻率偏移等計(jì)時(shí)誤差因素影響較大，必須加以抑制才可用于煤礦井下目標(biāo)精確定位。地面環(huán)境采用二維、三維算法進(jìn)行誤差抑制。煤礦井下巷道呈一維條狀，無法采用上述算法，需要建立針對井下特定環(huán)境的定位方法和計(jì)時(shí)誤差抑制算法。

2 方法描述

根據(jù)前文所述，實(shí)現(xiàn)TOA方法在煤礦井下目標(biāo)定位中的應(yīng)用，需要建立一維定位方法，并解決如下技術(shù)問題:

(1)導(dǎo)致計(jì)時(shí)誤差的因素多，包括同步時(shí)延、計(jì)時(shí)器頻率偏移、處理器的處理時(shí)延；

(2)導(dǎo)致計(jì)時(shí)誤差的因素不易被消除、不易被測得、多為變量。

基于上述原因，筆者提出煤礦井下一維TOA目標(biāo)定位方法和計(jì)時(shí)誤差抑制算法:針對存在多個(gè)計(jì)時(shí)誤差因素，提出三條信道的進(jìn)行定位檢測的方法，包括一條已知長度的光纖信道和兩條用于定位測距的WiFi信道，提出三條信道的信號收發(fā)及計(jì)時(shí)方式；針對計(jì)時(shí)誤差變量不易被測量、多為變量，抑制誤差算法利用三條信道的信號傳輸時(shí)間關(guān)系和長度關(guān)系建立計(jì)算式，應(yīng)用矩陣計(jì)算的消元方法將造成誤差的變量在計(jì)算中抵消，建立計(jì)算結(jié)果僅與實(shí)測時(shí)間值有關(guān)的距離計(jì)算公式。

2.1 技術(shù)方案

提出雙路WiFi信道+單路光纖信道的一維定位方法(圖3)。

圖3 雙路WiFi信道+單路光纖信道Fig.3 Two-way WiFi channel+one-way fiber channel

該方法構(gòu)成包括綜合通信基站，定位分站，識別卡，埋入式光纖網(wǎng)絡(luò)。

(1)綜合通信基站，為具有定位子站的通信基站，間距為2d*，計(jì)算中為已知值，根據(jù)WiFi天線覆蓋性能[15-17]和系統(tǒng)設(shè)計(jì)需求進(jìn)行設(shè)定；

(2)定位分站，置于2個(gè)綜合通信基站的中點(diǎn)；因此定位分站與綜合通信基站的距離為d*；

(3)識別卡，作為定位標(biāo)識由定位目標(biāo)攜帶，集成于WiFi手機(jī)，識別卡與綜合通信基站、定位分站的距離分別記為d1，d2，為待測值；

(4)埋入式光纖網(wǎng)絡(luò)用于綜合通信基站和定位分站的有線連接；

(5)綜合通信基站，定位分站，識別卡均有計(jì)時(shí)功能和計(jì)算功能，其中識別卡與WiFi手機(jī)共用計(jì)時(shí)器和處理器；計(jì)時(shí)器滿足分辨率τ≤1×10-8s，可實(shí)現(xiàn)定位精度為AC=τ×c≤3 m，c為光速；

(6)綜合通信基站和定位分站分別采用2個(gè)定向天線進(jìn)行WiFi信號覆蓋和接收信號方向判別，定向天線的覆蓋方向即為目標(biāo)所在方向；

(7)本技術(shù)方案需建立在支持SerialNET(透明傳輸模式)方式的WiFi通信模塊上，以實(shí)現(xiàn)作為定位節(jié)點(diǎn)的識別卡與作為錨節(jié)點(diǎn)綜合通信基站的定位子站和定位分站同時(shí)進(jìn)行通信。

在本技術(shù)方案基礎(chǔ)上，利用2.2節(jié)提出的信號收發(fā)及計(jì)時(shí)方式得出每一條信道上的信號收發(fā)時(shí)間，利用2.3節(jié)提出的抑制誤差算法計(jì)算得出識別卡與綜合通信基站距離d1、定位分站的距離d2，確定目標(biāo)位置。

2.2 信號收發(fā)及計(jì)時(shí)方式

雙路WiFi信道+單路光纖信道方法的信號收發(fā)計(jì)時(shí)方法流程如圖4所示。利用信號收發(fā)兩端時(shí)間相減的方式對信號在節(jié)點(diǎn)之間的雙程傳播時(shí)間計(jì)算，能夠消除WiFi技術(shù)本身存在的時(shí)延問題。

圖4 信號收發(fā)及計(jì)時(shí)過程Fig.4 Process of signal transceiving and timing

綜合通信基站、定位分站分別記為錨節(jié)點(diǎn)A、錨節(jié)點(diǎn)B，目標(biāo)及識別卡記為移動(dòng)節(jié)點(diǎn)M。

(1)M分別向A和B發(fā)出信號SMA和SMB，開始記錄時(shí)間TMA和TMB；

(2)B收到SMB，向M回復(fù)信號SBM，計(jì)時(shí)TBM；

(3)A收到SMA，向M回復(fù)信號SAM，計(jì)時(shí)TAM；

(4)M收到SBM，SMA，分別結(jié)束計(jì)時(shí)，記錄TMB，TMA；

(5)A向B發(fā)送信號SAB，開始記錄時(shí)間TAB；

(6)B收到SAB，向A回復(fù)信號SBA，計(jì)時(shí)TBA；

(7)A收到SBA，結(jié)束計(jì)時(shí)，記錄TAB；

(8)M和B分別將時(shí)間值TMB，TMA和TBM，TBA包含于信號STM和STB中發(fā)送至A。

綜合通信基站A利用時(shí)間值TAM，TAB，TMB，TMA，TBM，TBA，采用2.3節(jié)提出的計(jì)時(shí)誤差抑制算法的距離計(jì)算式(13)，計(jì)算得出識別卡與綜合通信基站距離d1、定位分站的距離d2，確定目標(biāo)位置。

2.3 計(jì)時(shí)誤差抑制算法

本文在雙路WiFi信道+單路光纖信道方法基礎(chǔ)上提出計(jì)時(shí)誤差抑制算法。

圖4所示的A與B之間的有線信號傳輸時(shí)間計(jì)算中，存在以下關(guān)系:

(3)

(4)

IEEE802.11規(guī)定，設(shè)備的時(shí)鐘頻率偏移容限為±25×10-6[14]，因此，存在下面的關(guān)系:

(5)

TAB-TBA→

(6)

即

(7)

同理,M與A，B之間的WiFi信號傳輸時(shí)間存在類似關(guān)系:

(9)

圖3所示方法存在距離之間的關(guān)系:

(10)

因此:

(11)

消元變換得:

(12)

計(jì)時(shí)誤差抑制算法的距離計(jì)算公式為

(13)

計(jì)時(shí)誤差抑制算法的距離計(jì)算式(13)顯示，距離計(jì)算結(jié)果僅與測得的時(shí)間值有關(guān)，與設(shè)備同步時(shí)延、計(jì)時(shí)器頻率誤差系數(shù)、信號處理時(shí)延等計(jì)時(shí)誤差無關(guān)，計(jì)時(shí)誤差的影響能夠被有效抑制。

3 實(shí) 驗(yàn)

3.1 計(jì)時(shí)誤差抑制結(jié)果

對比1.1，1.2節(jié)的方法與2.3節(jié)抑制誤差算法，對計(jì)時(shí)誤差導(dǎo)致的測距誤差進(jìn)行仿真實(shí)驗(yàn)。測試條件:d=400m，同步時(shí)延≤1μs，計(jì)時(shí)器頻率偏移不超過±25×10-6[14],處理時(shí)延≤4ms(考慮WiFi時(shí)延，利用BCM8000WiFi模塊多次處理得出參考值)。

計(jì)時(shí)誤差導(dǎo)致的測距誤差如圖5和表1所示。

表1誤差最值
Table1Maximumsandminimumsoferrors

方法誤差區(qū)間最值1/m誤差區(qū)間最值2/m單程測距方法-299 2733299 9853雙程測距方法-52 770951 4159計(jì)時(shí)誤差抑制算法-0 01660 0174

圖5 誤差抑制結(jié)果Fig.5 Results of error suppression

1000次隨機(jī)仿真實(shí)驗(yàn)結(jié)果顯示，前兩種方法的測距誤差分布區(qū)間為[-299.273 3 m,299.9853 m],[-52.7709m,51.4159m]，本文提出的計(jì)時(shí)誤差抑制算法的測距誤差分布區(qū)間為[-0.016 6 m,0.017 4m]，抑制誤差效果明顯。

3.2 實(shí)測實(shí)驗(yàn)

采用BCM8000WiFi模塊作為信號收發(fā)器，F(xiàn)CA3000高分辨率計(jì)時(shí)器作為計(jì)時(shí)器，利用高約3 m，寬約4m,長約100m的計(jì)算機(jī)機(jī)房通道模擬巷道環(huán)境，BCM8000WiFi模塊提供網(wǎng)線接口可直接利用機(jī)房的雙絞線進(jìn)行有線連接，每間隔5m進(jìn)行5次定位測試并取平均值。測試環(huán)境如圖6所示。

圖6 測試環(huán)境示意Fig.6 Schematic plan of test environment

準(zhǔn)確位置與測試位置對比如圖7所示。

實(shí)測誤差如圖8所示。

圖7 實(shí)測結(jié)果Fig.7 Results of tests

圖8 實(shí)測誤差Fig.8 Errors of tests

測試結(jié)果顯示，定位結(jié)果與實(shí)際位置誤差最大值為-2.4m，平均為0.58m，其中，接近綜合通信基站或定位分站時(shí)誤差相對較大，這是由于本文定位方法忽略煤礦井下巷道側(cè)壁高度和頂?shù)装鍖挾?，將巷道視為一維環(huán)境進(jìn)行目標(biāo)定位，會對目標(biāo)定位結(jié)果產(chǎn)生一定誤差。實(shí)測誤差小于定位精度，因此誤差不會影響系統(tǒng)3 m的定位精度。

3.3 小 結(jié)

仿真和實(shí)際測試結(jié)果顯示本文提出的方法，可以實(shí)現(xiàn)本文所述指標(biāo)下的3 m的定位精度。

4 結(jié) 論

(1)提出的計(jì)時(shí)誤差抑制算法有效抑制了計(jì)時(shí)誤差對TOA方法用于煤礦井下目標(biāo)定位造成的誤差。

(2)提出的基于計(jì)時(shí)誤差抑制的TOA煤礦井下目標(biāo)定位方法在不增加系統(tǒng)復(fù)雜度的前提下，具有3 m的定位精度，能夠有效實(shí)現(xiàn)TOA方法在煤礦井下目標(biāo)定位中的有效應(yīng)用。

[1] 孫繼平.煤礦物聯(lián)網(wǎng)特點(diǎn)與關(guān)鍵技術(shù)研究[J].煤炭學(xué)報(bào),2011,36(1):167-171. Sun Jiping.Research on characteristics and key technology in coal mine internet of things[J].Journal of China Coal Society,2011,36(1):167-171.

[2] 孫繼平.煤礦安全生產(chǎn)監(jiān)控與通信技術(shù)[J].煤炭學(xué)報(bào),2010,35(11):1926-1929. Sun Jiping.Technologies of monitoring and communication in the coal mine[J].Journal of China Coal Society,2010,35(11):1926-1929.

[3] 孫繼平.煤礦安全監(jiān)控系統(tǒng)聯(lián)網(wǎng)技術(shù)研究[J].煤炭學(xué)報(bào),2009,34(11):1546-1549. Sun Jiping.Networking technology for safety supervision system in a coal mine[J].Journal of China Coal Society,2009,34(11):1546-1549.

[4] 孫繼平.安全高效礦井監(jiān)控關(guān)鍵技術(shù)研究[J].工礦自動(dòng)化,2012(12):1-5. Sun Jiping.Research of key technologies for mine safety and efficiency monitoring[J].Industry of Mine Automation,2012(12):1-5.

[5] 孫繼平.煤礦井下安全避險(xiǎn)“六大系統(tǒng)”的作用和配置方案[J].工礦自動(dòng)化,2010(11):1-4. Sun Jiping.Effect and configuration of "six systems" for safe act of rescue of coal mine underground[J].Industry and Mine Automation,2010(11):1-4.

[6] 喬鋼柱,曾建潮.信標(biāo)節(jié)點(diǎn)鏈?zhǔn)讲渴鸬木聼o線傳感器網(wǎng)絡(luò)定位算法[J].煤炭學(xué)報(bào),2010,35(7):1229-1233. Qiao Gangzhu,Zeng Jianchao.Localization algorithm of beacon nodes chain deployment based on coalmine underground wireless sensor networks[J].Journal of China Coal Society,2010,35(7):1229-1233.

[7] Chan Yiutong,Tsui Wing-yue.Time-of-arrival based localization under NLOS conditions[J].IEEE Trans.Vehicular Technology,2006,55(1):17-24.

[8] 楊天池,金 梁.基于坐標(biāo)平移不變性的TOA 定位算法[J].電子學(xué)報(bào),2008,36(9):1848-1851. Yang Tianchi,Jin Liang.The TOA position algorithm based on coordinate shift invariance[J].Acta Electronica Sinica,2008,36(9):1848-1851.

[9] 張 華,宋正勛,石 云,等.基于超寬帶的TOA定位技術(shù)研究[J].吉林大學(xué)學(xué)報(bào)(信息科學(xué)版),2008,26(1):106-110. Zhang Hua,Song Zhengxun,Shi Yun,et al.Research of TOA Ranging technology based on UWB[J].Journal of Jilin University(Information Science Edition),2008,26(1):106-110.

[10] 孫繼平,樊 京.井下主動(dòng)超聲定位系統(tǒng)[J].煤炭學(xué)報(bào),2009,34(7):993-996. Sun Jiping,Fan Jing.Active ultrasonic location system in mine tunnel[J].Journal of China Coal Society,2009,34(7):993-996.

[11] 劉 平,李國民.一種用于井下人員定位的TOA定位算法研究[J].西安科技大學(xué)學(xué)報(bào),2007,27(3):439-442. Liu Ping,Li Guomin.A TOA-based people locating algorithm in coalmine[J].Journal of Xi’an University of Science and Technology,2007,27(3):439-442.

[12] 包建軍,霍振龍,徐 煒,等.一種高精度井下人員無線定位方法[J].工礦自動(dòng)化,2009(10):18-21. Bao Jianjun,Huo Zhenlong,Xu Wei,et al.A wireless location method with high precision for underground personnel tracking[J].Industry and Mine Automation,2009(10):18-21.

[13] 劉世森,湯明朝,吳 畏.無線傳感器網(wǎng)絡(luò)的TOA測距方法研究[J].工礦自動(dòng)化,2012(3):31-35. Liu Shisen,Tang Mingchao,Wu Wei.Research of TOA ranging method in wireless sensor network[J].Industry and Mine Automation,2012(3):31-35.

[14] IEEE standard for information technology-telecommunications and information exchange between systems-local and metropolitan area networks-specific requirements-Part 11:Wireless LAN Medium Access Control(MAC)and Physical Layer(PHY)specifications[S].IEEE Std 802.11-2007.2007.

[15] 張 玉,楊 維.礦井巷道綜合衰減模型與無線傳輸誤碼率性能綜合比較[J].煤炭學(xué)報(bào),2011,36(9):1581-1586. Zhang Yu,Yang Wei.Integrated attenuation model and BER performance analysis of typical wireless transmission technologies in mine tunnel[J].Journal of China Coal Society,2011,36(9):1581-1586.

[16] 孫繼平.礦井移動(dòng)通信的現(xiàn)狀及關(guān)鍵科學(xué)技術(shù)問題[J].工礦自動(dòng)化,2009(7):110-114. Sun Jiping.Present situation and key problems of science and technology of mine mobile communication[J].Industry and Mine Automation,2009(7):110-114.

[17] 尚 偉,胡 彧.基于WiFi的礦用移動(dòng)定位服務(wù)終端設(shè)計(jì)[J].工礦自動(dòng)化,2012(10):37-42. Shang Wei,Hu Yu.Design of mine-used location-based services Terminal Based on WiFi[J].Industry and Mine Automation,2012(10):37-42.

TOAundergroundcoalminetargetpositioningmethodbasedonWiFiandtimingerrorsuppression

SUN Ji-ping,LI Chen-xin

(SchoolofMechanicalElectronic&InformationEngineering,ChinaUniversityofMining&Technology(Beijing)，Beijing100083，China)

As the precision of the existing target positioning methods for underground coal mine can not meet the requirements of emergency rescue and operation management of underground personnel as well as the requirements for accurate positioning of the construction of coal mine-related internet of things,a precise positioning method based on TOA(Time of Arrival)was proposed.As for the impact from equipment timing errors upon the target positioning by TOA method and the failure of two-dimensional or three-dimensional error suppression algorithms commonly used on the ground due to the one-dimensional strip distribution in the tunnel,the TOA target positioning method for underground coal mine based on timing error suppression was proposed,to establish the one-dimensional positioning method and signal transceiving timing method with two-way WiFi(Wireless Fidelity)channel+one-way fiber channel,and on such basis,the timing error suppression algorithm was put forward.The test results prove that such algorithm based on the positioning method in this paper effectively suppresses the ranging error caused by the equipment timing error,and the actually-measured error does not affect the positioning accuracy,which verifies the positioning performance of this method.

undergroundcoal mine;target positioning;TOA;WiFi;timing error suppression algorithm

10.13225/j.cnki.jccs.2013.0082

國家自然科學(xué)基金重點(diǎn)資助項(xiàng)目(51134024)；國家高技術(shù)研究發(fā)展計(jì)劃(863)資助項(xiàng)目(2012AA062203)

孫繼平(1958—)，男，山西翼城人，博士，教授，博士生導(dǎo)師。Tel:010-62331929，E-mail:sjp@cumtb.edu.cn。通訊作者:李晨鑫， E-mail:cumtblichenxin@126.com

TD655

A

0253-9993(2014)01-0192-06

孫繼平，李晨鑫.基于WiFi和計(jì)時(shí)誤差抑制的TOA煤礦井下目標(biāo)定位方法[J].煤炭學(xué)報(bào),2014,39(1):192-197.

Sun Jiping,Li Chenxin.TOA underground coal mine target positioning method based on WiFi and timing error suppression[J].Journal of China Coal Society,2014,39(1):192-197.doi:10.13225/j.cnki.jccs.2013.0082