Journal of South China University of Technology(Natural Science Edition) ›› 2019, Vol. 47 ›› Issue (4): 53-60.doi: 10.12141/j.issn.1000-565X.180476

• Electronics, Communication & Automation Technology • Previous Articles     Next Articles

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)

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

CLC Number: