孟祥寧 肖響
摘 要 利用stm32單片機(jī)開發(fā)了UWB定位系統(tǒng)的錨節(jié)點及標(biāo)簽節(jié)點,同時對電源切換電路、DWM1000模塊、單片機(jī)處理電路和串口電路盡心了設(shè)計,并利用脈沖信號到達(dá)差算法實現(xiàn)了測距。通過在樓頂天臺實際測試,開發(fā)的模塊精度能夠?qū)崿F(xiàn)5cm且穩(wěn)定性較強(qiáng)。
關(guān)鍵詞 stm32單片機(jī);UWB錨節(jié)點;電源電路;精度
中圖分類號 TP3 文獻(xiàn)標(biāo)識碼 A 文章編號 1674-6708(2018)217-0121-02
1 硬件設(shè)計
超寬帶技術(shù)以其可以實現(xiàn)厘米級定位且具有抗多徑能力強(qiáng)、功耗低、帶寬寬等諸多優(yōu)點,在各行業(yè)得到了廣泛的應(yīng)用,其不需要載波,只需通過脈沖發(fā)射計算錨節(jié)點與標(biāo)簽之間的距離即可獲得需要定位的節(jié)點的具體坐標(biāo)。基站作為布置在定位區(qū)域中的錨節(jié)點,不停的對區(qū)域內(nèi)的所有標(biāo)簽節(jié)點通訊,實時獲取基站和標(biāo)簽之前的脈沖到達(dá)時間,通過TOA算法獲取二者之間距離。通過隔爆兼本安型電源供電,可以實現(xiàn)基站實時供電。在本項目中,同時還考慮到井下掉電情況,備選鋰電池供電?;居布蚣軋D如圖1所示。
當(dāng)隔爆兼本安店員電源持續(xù)供電時,系統(tǒng)自動斷開鋰電池供電,同時,對鋰電池進(jìn)行充電,當(dāng)?shù)綦姇r,自動切換為鋰電池供電。從而給STM32單片機(jī)和DWM1000精確定位模塊供電。兩個模塊之間通過SPI接口連接,單片機(jī)可以對精確定位模塊進(jìn)行配置并通訊,并對硬件進(jìn)行了設(shè)計,單片機(jī)應(yīng)用電路、精確定位模塊應(yīng)用電路如圖2、圖3所示。
定位標(biāo)簽通過廣播的形式向錨節(jié)點發(fā)送超寬帶定位信息,同時還包含一個2.4G的接收端用以接收上位機(jī)指令,其和錨節(jié)點間的硬件設(shè)計差別于串口電路和傳感器接口(由于后期可能將生理狀態(tài)兼容進(jìn)來)。傳感器接口是從單片機(jī)上接出IO口,這樣就可同PC上位機(jī)進(jìn)行實時數(shù)據(jù)傳輸。使用基站的PCB板子,焊接的時候?qū)⑥D(zhuǎn)串口的元件焊接,同時焊接傳感器接口,便能實現(xiàn)標(biāo)簽節(jié)點功能。
2 算法設(shè)計
在對超寬帶芯片編程時,共有兩種算法,一種是基于飛行時間的,另一種是基于時間刀叉差的,兩種算法都是利用標(biāo)簽以廣播形式向錨節(jié)點發(fā)射信息的時間與脈沖在空氣中的傳播速度的乘機(jī),通過該算法實現(xiàn)距離的獲取。
將信號飛行的時間和信號傳播的速度相乘,就可以得到發(fā)射機(jī)和接收機(jī)之間的距離。
具體計算過程如圖5,要定位的節(jié)點是B點,其在分別以P1、P2、P3為圓心以3個點到B點的距離為半徑的圓上,半徑即為接收機(jī)與發(fā)射機(jī)的到達(dá)距離,通過3個方程解方程組,可以計算出B點的具體坐標(biāo)。
無論是TOA還是TDOA算法得到的方程組在通常情況下都是非線性的,極值點較難確定,因此有較多學(xué)者提出復(fù)雜性算法,如Chan、泰勒展開法等,但是這種算法適用于理想高斯噪聲的情況下,當(dāng)存在測量誤差/非視距誤差的情況時,定位精度較差,由于卡爾曼濾波器的擬合特性和對非視距誤差的抑制,實現(xiàn)節(jié)點的定位跟蹤,解決了非視距誤差對定位精度影響極大的問題,鑒于篇幅有限,不做討論。
TOA算法計算出來的定位信息通過錨節(jié)點上傳給上位機(jī),上位機(jī)主要包括一下幾個模塊。
1)系統(tǒng)配置模塊。包括標(biāo)簽的ID號,時間到達(dá)間隔,錨節(jié)點具體坐標(biāo)等。
2)TOA算法信息顯示模塊。主要包括TOA計算公式源代碼,調(diào)用了List View模塊控件,通過查閱DW1000芯片手冊可以獲取源代碼。
3)軌跡顯示模塊。模塊主要功能是對標(biāo)簽實時定位結(jié)果通過軌跡的方式顯示出來,通過在上位機(jī)定義啟動按鈕,實現(xiàn)標(biāo)簽的位置定位,通過“更新”按鈕,刷新定位信息,通過繪圖模塊的開發(fā),可以實時顯示在上位機(jī)上。
3 定位精度測試
為了測試方便,利用鋰電池對基站板子進(jìn)行供電如下將3個基站節(jié)點和1個標(biāo)簽節(jié)點上標(biāo)記A1,A2, A3和T1的標(biāo)識。
第一步先將硬件設(shè)備安裝調(diào)試好,設(shè)置網(wǎng)絡(luò)IP地址,使得電腦可以跟中繼之間通信。點擊設(shè)置好的啟動按鈕,載入配置源文件,上位機(jī)即可得到定位信息并通過上位機(jī)顯示標(biāo)簽節(jié)點的實時軌跡。
圖6所示為上位機(jī)界面截取的圖片。
從測試結(jié)果看,測量精度越來越小,這是因為每一次測量結(jié)果都是根據(jù)前幾次的平均值得到的,從表中可以看到,第八次后,誤差穩(wěn)定到了5cm。
參考文獻(xiàn)
[1]馮金振,鄭國莘. Chirp-BOK-BPSK調(diào)制超寬帶無線傳輸技術(shù)[J].應(yīng)用科學(xué)學(xué)報,2008,26(2):123-126.
[2]胡仕兵,汪學(xué)剛,姒強(qiáng).UWB雷達(dá)LFM脈壓信號數(shù)字產(chǎn)生系統(tǒng)性能分析[J].現(xiàn)代雷達(dá),2007,29(12):51-55.
[3]張文杰,王艷芬.基于Chirp脈沖壓縮技術(shù)的超寬帶通信系統(tǒng)設(shè)計[J].電視技術(shù),2007,31(7):62-64.
[4]吳曉燕,龐宏,文光俊.MMIC毫米波倍頻器的研究[J].電子工程師,2007,33(4):10-13.
[5]張文杰,王艷芬.Chirp-UWB無線通信技術(shù)在煤礦井下的應(yīng)用研究[J].工礦自動化,2007(2):7-10.
[6]賀鵬飛,呂英華,張洪欣,等.基于Chirp-BOK調(diào)制的超寬帶無線通信系統(tǒng)研究[J].南京郵電大學(xué)學(xué)報(自然科學(xué)版),2006,26(2):21-25.
[7]朱宇虹,張其善,常青.GPS信號模擬器中sine存儲表的設(shè)計和實現(xiàn)[J].北京航空航天大學(xué)學(xué)報,2005(12).