华南理工大学学报(自然科学版) ›› 2019, Vol. 47 ›› Issue (4): 53-60.doi: 10.12141/j.issn.1000-565X.180476

• 电子、通信与自动控制 • 上一篇    下一篇

基于模糊逻辑四元数的平方根 UKF 算法

王丹丹1,2 谭开拓2 高素玲2 袁赣南1†   

  1. 1. 哈尔滨工程大学 自动化学院,黑龙江 哈尔滨 151000; 2. 安阳工学院 电子信息与电气工程学院,河南 安阳 455000
  • 收稿日期:2018-09-25 修回日期:2018-11-09 出版日期:2019-04-25 发布日期:2019-03-01
  • 通信作者: 袁赣南(1945-),男,教授,博士生导师,主要从事惯性导航、船舶运动控制等研究. E-mail:yuangannan@163.com
  • 作者简介:王丹丹(1987-),女,博士,讲师,主要从事 SLAM、组合导航、非线性滤波算法等研究. E-mail: lansejingling1988@ 126. com
  • 基金资助:
    国家自然科学基金资助项目(61201409,51709062);河南省科技攻关计划项目(182102110295);安阳市科技攻关 计划项目(121);河南省高校博士科研启动项目(BSJ2017006)

Square Root UKF Algorithm Based on Fuzzy Logical Quaternion

WANG Dandan1,2 TAN Kaituo2 GAO Suling1,2 YUAN Gannan1†   

  1.  1. College of Automation,Harbin Engineering University,Harbin 151000,Heilongjiang,China; 2. College of Electronic Information and Electrical Engineering,Anyang Institute of Technology,Anyang 455000,Henan,China
  • Received:2018-09-25 Revised:2018-11-09 Online:2019-04-25 Published:2019-03-01
  • Contact: 袁赣南(1945-),男,教授,博士生导师,主要从事惯性导航、船舶运动控制等研究. E-mail:yuangannan@163.com
  • About author:王丹丹(1987-),女,博士,讲师,主要从事 SLAM、组合导航、非线性滤波算法等研究. E-mail: lansejingling1988@ 126. com
  • Supported by:
    Supported by the National Natural Science Foundation of China(61201409,51709062) and the Key Science and Technology Program of Henan Province,China(182102110295)

摘要: 针对目标跟踪估计算法中,利用传感器离散观测建模并估计目标连续状态,进行 导航解算时滤波精度低,及传统四元数扩展卡尔曼滤波算法无法满足目标姿态测量精度 要求等问题,文中提出一种基于模糊逻辑四元数的平方根 UKF 姿态估计算法. 该算法将 四元数作为模糊逻辑 UKF 滤波器状态,应用测量的角速率完成滤波器的时间更新及量测 更新,采用模糊逻辑的平方根协方差形式作为更新参数,既降低了算法的计算量和复杂 度,又保证了数值的稳定性. 文中还以近地卫星为例,在 Matlab 和 C + + 软件上进行了仿 真实验. 实验结果表明:文中所提算法可保证对机器人和特征的姿态控制估计精度;可对 目标实时跟踪定位并进行量测更新,抑制了姿态误差发散问题.

关键词: 目标跟踪, 四元数, 模糊逻辑, 滤波估计

Abstract: An attitude estimation algorithm based on fuzzy logic square root quaternion UKF is proposed in order to solve the problems such as the filtering accuracy of target continuous state estimation by discrete sensors observation is too low for navigation solution and the traditional quaternion extended Kalman filtering algorithm can not meet the precision requirement of target attitude measurement. The algorithm takes quaternion as the state of fuzzy logic UKF filter,and the measured time rate is used to complete the time update and measurement update of the filter. The square root covariance form of fuzzy logic is used as the update parameter,which reduces the calculation amount and complexity of the algorithm,and ensures the stability of the value. Taking near-earth satellite as an example, simulation experiments were carried out on Matlab and C + + software. The experimental results show that the pro- posed algorithm could guarantee the accuracy of attitude control for robots and features. It can also track and locate the target in real time and update the measurement,which suppress the problem of attitude error divergence.

Key words: target tracking, quaternion, fuzzy logic, filter estimation

中图分类号: