Strong tracking robust adaptive filtering algorithm and its application on UAV navigation and positioning

doi:10.13474/j.cnki.11-2246.2021.0112

Abstract

Abstract: Aiming at the problems that filtering divergence and low positioning accuracy in the application of Sage-Husa adaptive filtering algorithm in UAV navigation and positioning, a strong tracking robust adaptive filtering algorithm is proposed in this paper.The algorithm is based on Sage-Husa adaptive filtering, introduces the strong tracking technology in it, and reduces the influence of historical data on current filtering through adaptive fading factor, so as to suppress the divergence of filtering and enhance the robustness of the algorithm.The measurement noise and system noise are combined for real-time estimation, and the robust factor is added to the estimation to suppress the interference of outliers to the filtering and improve the positioning accuracy.Simulation results show that this algorithm can perform well in the case of filtering divergence and outliers, and has stronger robustness than Sage-Husa algorithm.

Key words: UAV, navigation and positioning, adaptive filtering algorithm, strong tracking, robust

CLC Number:

P228

XIAO Yewei, XIE Xiaogang. Strong tracking robust adaptive filtering algorithm and its application on UAV navigation and positioning[J]. Bulletin of Surveying and Mapping, 2021, 0(4): 64-67.

References

[1] 毛君, 钟声, 马英. 基于模糊AKF地磁辅助导航的采煤机定位方法[J]. 传感器与微系统, 2018, 37(3):48-50.
[2] 高兵兵,高社生,胡高歌,等.基于极大似然准则与滚动时域估计的自适应UKF算法[J].系统工程与电子技术,2016,38(7):1629-1637.
[3] LIU J, CHEN H, LIU N. Effective Sage-Husa Kalman filter for SINS/Doppler/platform compass integrated navigation system[C]//Proceedings of IEEE Chinese Guidance, Navigation and Control Conference (CGNCC).[S.l.]:IEEE, 2016:541-546.
[4] SUN J, XU X, LIU Y, et al. FOG random drift signal denoising based on the improved AR model and modified Sage-Husa adaptive Kalman filter[J]. Sensors, 2016, 16(7):1073.
[5] 李果,刘旭焱,马建晓.Suge-Husa自适应滤波简化算法[J].计算机工程与设计,2019,40(5):1360-1364.
[6] 李鲁明, 赵鲁阳, 唐晓红, 等. 基于改进卡尔曼滤波的陀螺仪误差补偿算法[J]. 传感技术学报, 2018, 31(4):538-544.
[7] LIU S, LI S, ZHENG J, et al. C/N0 Estimator based on the adaptive strong tracking Kalman filter for GNSS vector receivers[J]. Sensors, 2020, 20(3):739.
[8] 郑戍华,鲁东原,王向周,等.基于改进强跟踪滤波器的UWB/AHRS紧组合定位方法[J].北京理工大学学报,2019,39(8):864-869.
[9] 李康乐,邵小强,潘红光,等.自适应抗差卡尔曼滤波对井下定位NLOS时延抑制方法的研究[J].西安科技大学学报,2020,40(1):173-180.
[10] ZHANG Z, DONG P, TUO H, et al. Robust variational bayesian adaptive cubature Kalman filtering algorithm for simultaneous localization and mapping with heavy-tailed noise[J]. Journal of Shanghai Jiaotong University (Science), 2020, 25(1):76-87.
[11] 蔡煊, 王长林. 基于抗差估计的BDS/ODO组合列车定位方法[J]. 铁道科学与工程学报, 2018(10):27.
[12] 储超, 黄亮, 杜仲进, 等. 抗差估计在RTK/INS紧组合中的应用研究[J]. 全球定位系统, 2019, 44(5):18-25.
[13] 张欣.多旋翼无人机的姿态与导航信息融合算法研究[D].长春:中国科学院研究生院(长春光学精密机械与物理研究所),2015.
[14] 路小燕, 杨柳庆, 郭锦, 等. 改进的Sage-Husa自适应滤波算法在MEMS航姿参考系统中的应用[J]. 导航与控制, 2019, 18(2):105-112.

[1]	HU Yiqiang, YANG Ji, JING Wenlong, PENG Xiaoyan, LAN Wenlu, PENG Mengwei, ZHANG Yumeng. Remote sensing investigation on water pollution of pond aquaculture in estuary of Maowei Sea [J]. Bulletin of Surveying and Mapping, 2022, 0(7): 12-17,53.
[2]	RAN Chongxian, LI Senlei. Tree canopy delineation using UAV multispectral imagery [J]. Bulletin of Surveying and Mapping, 2022, 0(7): 112-117.
[3]	LIU Yuxian, RUAN Minghao, YAN Zhen. A method for accurate extraction of gated electric towers based on airborne laser point cloud [J]. Bulletin of Surveying and Mapping, 2022, 0(7): 129-133.
[4]	ZHOU Ye, LIU Yunbo, ZHENG Libo, LONG Yangjun. Precision analysis of single tree parameter extraction for multi-platform point cloud data [J]. Bulletin of Surveying and Mapping, 2022, 0(7): 168-172.
[5]	HU Yiqiang, YANG Ji, JING Wenlong, YANG Chuanxun, SHU Sijing, LI Yong. Review of coastal ecological environment monitoring based on unmanned aerial vehicle remote sensing [J]. Bulletin of Surveying and Mapping, 2022, 0(6): 18-24.
[6]	ZHOU Jianguo, LUO Chao, PENG Duo. Trigonometric leveling method assisted by micro air vehicle [J]. Bulletin of Surveying and Mapping, 2022, 0(6): 71-75.
[7]	LIU Yaohui, YU Xianghui, FAN Jiejie, ZHOU Jie, CHENG Hao, YAO Guobiao, MENG Fei, JIN Fengxiang. Rapid estimation of rural homestead area in Western China based on UAV imagery and object-oriented method [J]. Bulletin of Surveying and Mapping, 2022, 0(6): 125-129.
[8]	WAN Zhongming, WANG Yawen, FAN Ziyi. Application of UAV tilt photography technology in slope monitoring [J]. Bulletin of Surveying and Mapping, 2022, 0(6): 170-172.
[9]	WANG Guangshuai. High-precision automatic reconstruction of railway line with UAV oblique photography [J]. Bulletin of Surveying and Mapping, 2022, 0(5): 133-139,156.
[10]	BI Rui, GAN Shu, YUAN Xiping, LI Raobo, GAO Sha. UAV route planning and 3D modeling analysis in different terrain environment [J]. Bulletin of Surveying and Mapping, 2022, 0(4): 83-89,129.
[11]	PU Dongdong, DING Haiyong. LiDAR point cloud segmentation algorithm based on supervoxel and pairwise linkage clustering [J]. Bulletin of Surveying and Mapping, 2022, 0(3): 65-69.
[12]	REN Xubin, KANG Jianfeng, YU Donghai. Application of UAV tilt photogrammetry in building area measurement of housing construction area [J]. Bulletin of Surveying and Mapping, 2022, 0(3): 116-120,126.
[13]	CAI Jialun, JIA Hongguo, LIU Guoxiang, ZHANG Bo, LIU Qiao, WU Renzhe, XIANG Wei, MAO Wenfei, ZHANG Rui. Accuracy evaluation of UAV tilt photogrammetry compared with traditional low altitude aerial photogrammetry [J]. Bulletin of Surveying and Mapping, 2022, 0(2): 31-36.
[14]	JIA Yu, WANG Hong, CAI Hong, ZHANG Lei. Unmanned image classification in karst area combining topographic factors and stratification strategy [J]. Bulletin of Surveying and Mapping, 2022, 0(2): 121-127.
[15]	GAO Sha, YUAN Xiping, GAN Shu, YANG Minglong, YUAN Xinyue, LUO Weidong. Fusion of UAV image and LiDAR point cloud to study the detection technology of mountain surface cover landscape characteristics [J]. Bulletin of Surveying and Mapping, 2022, 0(1): 110-115.