华南理工大学学报(自然科学版) ›› 2019, Vol. 47 ›› Issue (4): 53-60.doi: 10.12141/j.issn.1000-565X.180476
王丹丹1,2 谭开拓2 高素玲2 袁赣南1†
WANG Dandan1,2 TAN Kaituo2 GAO Suling1,2 YUAN Gannan1†
摘要: 针对目标跟踪估计算法中,利用传感器离散观测建模并估计目标连续状态,进行 导航解算时滤波精度低,及传统四元数扩展卡尔曼滤波算法无法满足目标姿态测量精度 要求等问题,文中提出一种基于模糊逻辑四元数的平方根 UKF 姿态估计算法. 该算法将 四元数作为模糊逻辑 UKF 滤波器状态,应用测量的角速率完成滤波器的时间更新及量测 更新,采用模糊逻辑的平方根协方差形式作为更新参数,既降低了算法的计算量和复杂 度,又保证了数值的稳定性. 文中还以近地卫星为例,在 Matlab 和 C + + 软件上进行了仿 真实验. 实验结果表明:文中所提算法可保证对机器人和特征的姿态控制估计精度;可对 目标实时跟踪定位并进行量测更新,抑制了姿态误差发散问题.
中图分类号: