基于改進TOA算法的飛艇定位優化研究

魏明輝 吳煒 陳吉瑞 楊昊霖 文偉

摘 ? 要：本文針對飛艇定位系統中的優化算法進行了相關分析與研究。通過簡要分析RFID定位算法，結合飛艇理論數據分析了算法的優缺點;選取精度較高的TOA算法的進行定位優化，在使用傳統的TOA定位算法時，通過大量的數據觀測點增加其實驗中的監測效果;引入Kalman濾波算法進行飛艇狀態點的修正和更新來達到提高定位精度的效果;融合Kalman濾波算法后，使用RMSE誤差分析模型得出，改進后的定位算法定位精度遠優于傳統的TOA算法。

關鍵詞：飛艇定位 ?RFID射頻識別 ?TOA算法 ?Kalman濾波

中圖分類號：TN929.53 ? ? ? ? ? ? ? ? ? ? ? ? ? ?文獻標識碼：A ? ? ? ? ? ? ? ? ? ? ? ?文章編號：1674-098X（2019）08（c）-0084-02

飛艇作為一種航空飛行器，強大的置空時間是其優勢。目前飛艇的定位方式主要通過GPS技術實現定位，可以實現全球大多數地方的實時定位，但由于衛星運行軌道、衛星時鐘存在誤差，大氣對流層、電離層對信號的影響，會造成比較大的偏差。為了保證定位精度，需要一種輔助定位技術對GPS定位的位置進行修正，本文研究的TOA定位算法既可以對定位進行修正，從而保證定位精度。

1 ? 無線定位

在一定范圍的空間區域內，通過放置一定的RFID讀寫器即AP，對場景內的標簽進行讀取RSSI值即可實現對標簽物體的定位。

TOA算法是目前常見的算法之一，其工作原理是通過測量信號傳輸時間來得到RFID標簽和讀寫器之間的距離即發射機發射到RFID標簽再返回發射機的所用時間來確定距離。TOA測距誤差的大小主要取決于測距過程中傳輸信道的狀態[1]。在室內應用中，嚴重的多徑和非視距現象造成測距誤差較大[2]。

為了在室內定位中克服這些誤差，現行的TOA定位算法有：

（1）給予數值處理的定位算法，如最小二乘法;

（2）幾何定位算法，傳統的是三邊定位算法;

（3）基于模型匹配的定位算法;

（4）基于信道狀態判別的定位算法。

TDOA算法是TOA算法的一種變體，工作原理是根據目標發射信號的時間差來確定位置。在這種算法的改進下，主要是減少了TOA算法對于時間同步程度的過度依賴，使得算法可以有更多的應用場合。

2 ?算法設計

本研究中模型算法的信道模型依據實際實驗中常用的IEEE802.15.4a作為信道。選擇參考節點個數為3，在定位算法實現過程中選擇以最小二乘法求解。采樣頻率為fs=20X109hz，采樣間隔為ts=1/fs。

2.1 TOA定位

TOA定位算法流程為：

RFID射頻識別讀寫器發送給標簽一個數據包。同時記錄當前的RFID標簽的時間信息，記為T1;

RFID標簽收到數據包后，向讀寫器反饋一個信號;

RFID讀寫器收到反饋信號，并記錄當前讀寫器的時間信息，記為T2;

計算讀寫器收到信號的時間差Tr=T2-T1。

2.2 TDOA定位

TDOA定位算法流程為：

RFID射頻識別標簽以廣播形式發出一個數據包;

兩個射頻識別讀寫器接受同一個數據包，假設第一個讀寫器接收到的時間為T1，第二個讀寫器接受到的時間為T2;

計算兩個讀寫器收到數據包的時間差為Td=T2-T1。

2.3 飛艇定位

基于1100個移動中飛艇的定位節點的基站觀測圖，使用TOA的定位算法實現定位。如圖1，可以看出在增加區域范圍后，可以通過增加觀測點即AP點達到對飛艇區域航跡的監測和追蹤，但是在數據量較大的時候也會存在一定的定位誤差。

3 ?Kalman修正算法

3.1 算法組成

第一步主要是將現有的系統狀態進行分析，并且根據預測方程構建預測狀態矩陣Xk=AXk-1+BUk-1，同時構建相應的誤差矩陣Pk=APk-1AT+Q。第二步加入Kalman算法，計算Kalman增益Kk=PkHT（HPkHT+R）-1，得到新的增益矩陣后，更新預測狀態矩陣Xk=Xk+Kk（Zk-HXk），同時更新誤差矩陣Pk=（1-KkH）Pk。算法中的第一步驟實現的就是基于前一刻狀態做的初步預測，第二部分主要是結合當前時刻的狀態方程，對已有的矩陣進行修正，更新估計定位坐標，并且輸出最終結果。

如圖2，可以看出傳統單一的TOA定位算法軌跡較kalman濾波算法后的軌跡存在更大的誤差，這是由于傳統的TOA算法缺少對狀態點位置的修正，而引入kalman濾波算法可以增加對狀態方程進行修正和更新，所以kalman濾波算法后的定位軌跡和真實軌跡更為貼合即定位誤差更小。

4 ?結語

本文針對飛艇定位系統中的優化算法進行了相關分析與研究。在使用傳統的TOA定位算法時，通過大量的數據觀測點增加其實驗中的監測效果;引入Kalman濾波算法進行飛艇狀態點的修正和更新來達到提高定位精度的效果;融合Kalman濾波算法后，使用RMSE誤差分析模型得出，改進后的定位算法定位精度遠優于傳統的TOA算法。

參考文獻

[1] 邵成剛.基于RFID虛擬標簽的室內定位算法研究[D].北京郵電大學，2013.

[2] 苑寶玉.超聲波室內定位系統[D].長春理工大學，2010.

[3] 扈羅全.無線電波傳播的隨機建模與應用[M].北京：華中科技大學出版社，2011.

[4] 馬柳州，梁森.基于的精密單點定位在航磁飛艇定位中的應用[J].山東工業技術，2015（9）：153-154.