曾永華
【摘 要】為了提高礦山井下定位系統(tǒng)的精度,本文提出了一種基于TOF測距算法的精確定位設(shè)計。本文闡述了無線測距方式的選擇、無線測距設(shè)計及基于nRF2401芯片精確定位收/發(fā)模塊的設(shè)計。
【關(guān)鍵詞】精確定位;TOF測距;nRF2401
0 引言
隨著礦山自動化、信息化建設(shè)的不斷深入,礦山行業(yè)對井下人員/機車等動目標(biāo)的定位管理要求越來越高,傳統(tǒng)的區(qū)域定位已經(jīng)難以滿足礦山建設(shè)的需要。與區(qū)域定位只能定位一個大的區(qū)域范圍不同,精確定位能將井下動目標(biāo)準(zhǔn)確定位到具體位置,能直觀展現(xiàn)井下動目標(biāo)的確切位置,對礦井的安全生產(chǎn)具有重要意義。
1 無線測距方式選擇
1.1 小區(qū)定位測距
采用泄漏電纜,以多點連續(xù)的射頻信號實現(xiàn)巷道長距離信號連續(xù)覆蓋,在重點及關(guān)鍵區(qū)域密集設(shè)置定位器,實現(xiàn)準(zhǔn)精確定位。
小區(qū)定位的定位精度較低,定位參照點多,數(shù)據(jù)量大,系統(tǒng)可靠性和可維護性較差。
1.2 RSSI定位測距
Zigbee和WiFi網(wǎng)絡(luò)通常采用RSSI定位方法,通過無線信號的傳輸損耗模型計算移動節(jié)點與節(jié)點間的距離:[p(d)]dBm=[p(d0)]dBm-10nlg(d/d0)+XdBm
p(d)為距離發(fā)射點d米處的接受信號強度,即RSSI值;p(d0)為參考距離為d0的信號功率;n為實際的路徑損耗指數(shù),障礙物越多,n值越大;X為0均值的高斯分布隨機變量。
無線信號的傳輸損耗模型受環(huán)境影響大,礦山井下巷道狹窄、不規(guī)范,環(huán)境濕度大,巷道壁及巷道內(nèi)設(shè)備對信號有吸收、反射、折射等影響,定位誤差較難控制。
1.3 TOF測距定位
TOF(飛行時間,Time of Flight)。根據(jù)IEEE802.15.4a規(guī)范,定義了兩種測距標(biāo)準(zhǔn): TW-TOA和SDS-TW-TOA。
TW-TOA測距方式:節(jié)點A向節(jié)點B發(fā)送測距幀、節(jié)點B向節(jié)點A返回響應(yīng)幀,Tab為節(jié)點A發(fā)出幀到收幀間的時間,Tdb為節(jié)點B自身延時,節(jié)點AB間的距離dAB=0.5*c*(Tab-Tdb),其中c=3*108m/s。
SDS-TW-TOA測距方式:在TW-TOA的基礎(chǔ)上增加了節(jié)點A 向節(jié)點B的二次響應(yīng)幀,Tba為節(jié)點B發(fā)出幀到收到幀的時間,Tda為節(jié)點A自身延時,節(jié)點AB間的距離dAB=0.25*c*(Tab+Tba-Tdb-Tda)。
TOF兩種測距方法都具有精度高、抗擾強、功耗低等特點,符合在礦山井下應(yīng)用的環(huán)境要求。
考慮節(jié)點A和節(jié)點B的晶振誤差限度,SDS-TW-TOA方式理論上能更好地控制不同發(fā)射器間晶振頻率差異引起的測距誤差。
通過以上比較,本次設(shè)計采用SDS-TW-TOA方式的TOF測距方式。
2 無線測距設(shè)計
礦山井下動目標(biāo)的定位測距,一般通過在礦井巷道安裝定位測距接收器、動目標(biāo)配備發(fā)射器來實現(xiàn)。發(fā)射器發(fā)出標(biāo)識碼信號,通過天線發(fā)射,再由接收器接收。由于被測目標(biāo)是移動的,要求信號必須具備傳送速度快、容量大、信息傳送可靠的特點。與一般通信系統(tǒng)類似,發(fā)射端必需將信號編碼、調(diào)制,接收端必需將信號解調(diào)、譯碼。本次采用FM調(diào)制,編碼、解碼、調(diào)制、解調(diào)均由NRF2401芯片自動完成。
TOF測距是一個連續(xù)的通訊過程,節(jié)點間的訪問沖突會導(dǎo)致測距產(chǎn)生嚴(yán)重偏差甚至測距失敗。因此,在SDS-TW-TOA測距中需要設(shè)計一套無線空中協(xié)議來協(xié)調(diào)所有發(fā)射器的測距和通訊。本次采用TDMA時分多路存儲方法來協(xié)調(diào)多個發(fā)射器的測距和定位。
空中協(xié)議實現(xiàn)過程:
1)接收器廣播空閑時隙數(shù)據(jù)幀,通知所有發(fā)射器開始分配時隙;
2)發(fā)射器收到后發(fā)送時隙申請;
3)接收器接受時隙申請后,確定各定位時隙并廣播;
4)分配到時隙的發(fā)射器在規(guī)定時間完成測距,然后重新進入休眠;未分配到時隙的發(fā)射器也進入休眠;
5)接收器在所有定位時隙執(zhí)行完后,重新進入階段1)。
在無線通信協(xié)議的物理層加入CCA空閑信道評估機制,能減少無線信道碰撞、增加了無線并發(fā)數(shù)、降低漏讀率。
根據(jù)定位參照點數(shù)量可分為單點、兩點和多點定位。單點定位只采用一臺接收器,能定位某個發(fā)射器到收發(fā)器的距離,不區(qū)分方向。兩點定位采用一臺收發(fā)器定位、一臺作為參考點,既定位距離又可區(qū)分方向。由于礦山井下巷道的特殊性(線性特征),只需采用單點定位或兩點定位。
3 基于nRF2401的收發(fā)設(shè)計
3.1 發(fā)射器設(shè)計
發(fā)射器采用nFR2401芯片實現(xiàn)射頻收發(fā)。nRF2401是單片射頻收發(fā)芯片,由頻率合成器、功率放大器、晶體振蕩器和調(diào)制器組成,輸出功率和通信頻道可通過程序進行配置。內(nèi)置地址解碼器、先入先出堆棧區(qū)、解調(diào)處理器、時鐘處理器、GFSK濾波器、低噪聲放大器、頻率合成器、功率放大器等功能模塊,只需要增加很少外部器件就可組成無線收發(fā)系統(tǒng)。芯片功耗低,以-5dBm的功率發(fā)射時工作電流只有10.5mA,接收時工作電流只有18mA。
本設(shè)計采用ShockBurstTM收發(fā)模式,可降低功耗、減少碰撞,自動處理字頭和CRC校驗碼。
本設(shè)計采用外部晶振為16MHz,空閑模式工作電流為32uA。
3.2 接收器設(shè)計
接收器由主控、電源、通信、定位等模塊組成。主控模塊采用LPC2114芯片,電源模塊將18V電源輸入經(jīng)隔離轉(zhuǎn)換成5V和3.3V,通信模塊通過RS485總線實現(xiàn)收發(fā)器與上位機通信。定位模塊采用nRF24E1芯片,其自帶2.4GHz無線收發(fā)器nRF2401和增強型8051內(nèi)核。
4 結(jié)語
本文所提出的采用TOF(SDS-TW-TOA方式)測距的精確定位設(shè)計,經(jīng)測試能夠?qū)崿F(xiàn)3-5m精度的定位,適應(yīng)礦山井下的應(yīng)用環(huán)境,是一種可行的礦井精確定位設(shè)計。
【參考文獻】
[1]王琦.基于RSSI測距的定位算法的實現(xiàn)[M].電子科技出版社,2012.
[2]范平志,鄧平,劉林. 蜂窩網(wǎng)無線定位[M].電子工業(yè)出版社,2002.
[3]黃智偉.單片無線發(fā)射與接收電路設(shè)計[M].西安電子科技大學(xué)出版社,2009.
[4]鄭啟忠,朱宏輝,耿四軍.2.4GHz射頻收發(fā)芯片nRF2401及其應(yīng)用[J].武漢理工大學(xué),2009.
[責(zé)任編輯:田吉捷]