乘性噪聲背景下基于非線性漸消濾波的單信標(biāo)測距定位算法
doi: 10.11999/JEIT180239 cstr: 32379.14.JEIT180239
-
海軍潛艇學(xué)院 ??青島 ??266044
Single Beacon Location Algorithm Based on Nonlinear Fading Filter Under Multiplicative Noise Background
-
Navy Submarine Academy, Qingdao 266044, China
-
摘要:
針對基于加性噪聲模型的單信標(biāo)測距定位算法不能精確表征距離觀測量的實際特征,存在模型失配的問題,該文給出一種考慮乘性噪聲特性的聯(lián)合最小二乘法和非線性漸消濾波的兩步定位算法。在分析有效聲速誤差與距離觀測量乘性噪聲內(nèi)在聯(lián)系的基礎(chǔ)上,建立了乘性噪聲背景下的測距誤差模型,通過引入一種新的弱化因子計算方法對乘性噪聲背景下帶單重漸消因子的非線性漸消濾波算法進(jìn)行了改進(jìn),利用基于最小二乘法的預(yù)定位過程解決改進(jìn)算法對初值敏感的問題。仿真及試驗數(shù)據(jù)表明該算法在水下航行器接近信標(biāo)的態(tài)勢下定位精度明顯優(yōu)于加性噪聲背景下的擴展卡爾曼濾波算法。
-
關(guān)鍵詞:
- 單信標(biāo)測距定位 /
- 乘性噪聲 /
- 漸消因子 /
- 非線性濾波 /
- 有效聲速
Abstract:Single beacon location algorithm based on additive noise model can not accurately represent the actual characteristics of distance measurement, leading to a problem of model mismatch. A two step location algorithm considering the multiplicative noise characteristics is presented, which combines least squares algorithm and nonlinear fading filter. A range error model in the background of multiplicative noise is established based on the analysis of the effective sound velocity error. The nonlinear fading filtering algorithm with single fading factor under multiplicative noise background is improved by introducing the attenuation factor which increases the track continuity. Using the least squares based pre-location process to solve the problem that the improved algorithm is sensitive to the initial value. The simulation and experimental data show that the location precision of the proposed algorithm is obviously better than the extended Kalman filtering algorithm under the additive noise background.
-
孫大軍, 鄭翠娥. 水聲導(dǎo)航、定位技術(shù)發(fā)展趨勢探討[J]. 海洋技術(shù)學(xué)報, 2015, 34(3): 64–68.SUN Dajun and ZHENG Cuie. Study on the development trend of underwater acoustic navigation and positioning technologies[J]. Journal of Ocean Technology, 2015, 34(3): 64–68. 張延順, 郭雅靜, 黃小娟, 等. 水下運載體航位推算系統(tǒng)初始位置確定方法[J]. 北京航空航天大學(xué)學(xué)報, 2015, 41(12): 2211–2216.ZHANG Yanshun, GUO Yajing, HUANG Xiaojuan, et al. Method for determining initial position of dead reckoning system of underwater vehicle[J]. Journal of Beijing University of Aeronautics and Astronautics, 2015, 41(12): 2211–2216. FERREIRA B, MATOS A, and CRUZ N. Single beacon navigation: Localization and control of the MARES AUV[C]. IEEE Oceans Conference, Washington D.C., USA, 2010: 1–9. SARAH E W. Decentralized single beacon acoustic navigation: Communication and navigation for underwater vehicles[D]. [Ph.D. dissertation], The Johns Hopkins University, 2010: 30–96. 王彬, 翁海娜, 梁瑾. 一種慣性/水聲單應(yīng)答器距離組合導(dǎo)航方法[J]. 海洋技術(shù)學(xué)報, 2017, 25(1): 86–90.WANG Bin, WENG Haina, and LIANG Jin. Inertial/acoustic range integrated navigation with single transponder[J]. Journal of Chinese Inertial Technology, 2017, 25(1): 86–90. 曹俊, 鄭翠娥, 孫大軍, 等. 系數(shù)矩陣正定的單信標(biāo)測距定位算法[J]. 電子與信息學(xué)報, 2017, 39(4): 981–988. doi: 10.11999/JEIT150483CAO Jun, ZHENG Cuie, SUN Dajun, et al. A single beacon location algorithm with positive definite coefficient matrix[J]. Journal of Electronics &Information Technology, 2017, 39(4): 981–988. doi: 10.11999/JEIT150483 WANG Xingbo, FU Minyue, and ZHANG Huanshui. Target tracking in wireless sensor networks based on the combination of KF and MLE using distance measurements[J]. IEEE Transactions on Mobile Computing, 2012, 11(4): 567–576. 史秀紡. 復(fù)雜因素影響下的定位跟蹤問題研究[D]. [博士論文], 浙江大學(xué), 2016: 20–67.SHI Xiufang. Research on localization and tracking under the influence of complex factors[D]. [Ph.D. dissertation], Zhejiang University, 2016: 20–67. 張征. 一類帶乘性噪聲非線性系統(tǒng)的估計算法研究[D]. [碩士論文], 中國海洋大學(xué), 2006: 40–82.ZHANG Zheng. Study of estimation algorithm for a class of nonlinear systems with multiplicative noise[D]. [Master dissertation], Ocean University of China, 2006: 40–82. 王炯琦, 矯媛媛, 周海銀, 等. 適合處理乘性噪聲估計衛(wèi)星姿態(tài)的非線性迭代濾波算法[J]. 電子學(xué)報, 2011, 39(6): 1417–1422.WANG Jiongqi, JIAO Yuanyuan, ZHOU Haiyin, et al. An iterative filter for nonlinear satellite attitude determination system with multiplicative stochastic matrix[J]. Acta Electronica Sinica, 2011, 39(6): 1417–1422. 范小軍, 劉鋒. 一種新的機動目標(biāo)跟蹤的多模型算法[J]. 電子與信息學(xué)報, 2007, 29(3): 532–535.FAN Xiaojun and LIU Feng. A new IMM method for tracking maneuvering target[J]. Journal of Electronics &Information Technology, 2007, 29(3): 532–535. VINCENT H T. Models, algorithms and measurement for underwater acoustic positioning[D]. [Ph.D. dissertation], University of Rhode Island, 2001: 1–5. 毛永毅, 李明遠(yuǎn), 張寶軍. 一種NLOS環(huán)境下的TOA/AOA定位算法[J]. 電子與信息學(xué)報, 2009, 31(1): 37–40.MAO Yongyi, LI Mingyuan, and ZHANG Baojun. A TOA/ AOA location algorithm in NLOS environment[J]. Journal of Electronics &Information Technology, 2009, 31(1): 37–40. 楊元喜, 高為廣. 漸消濾波原理及其理論分析[J]. 測繪科學(xué)與工程, 2007, 27(2): 1–4.YANG Yuanxi and GAO Weiguang. Principle and theoretical analysis of fading filtering[J]. Geomatic Science and Engineering, 2007, 27(2): 1–4. 周東華, 席??? 非線性系統(tǒng)帶次優(yōu)漸消因子的擴展卡爾曼濾波[J]. 控制與決策, 1990, 5(5): 1–6.ZHOU Donghua and XI Yukang. Suboptimal fading extended Kalman filtering for nonlinear systems[J]. Control &Decision, 1990, 5(5): 1–6. -