Welcome to Acta Armamentarii ! Today is

Acta Armamentarii ›› 2012, Vol. 33 ›› Issue (9): 1070-1075.doi: 10.3969/j.issn.1000-1093.2012.09.009

• Paper • Previous Articles     Next Articles

Study on Aerial Vehicle Attitude Estimation Based on Quaternion Particle Filter Algorithm

QIAO Xiang-wei, ZHOU Wei-dong, JI Yu-ren   

  1. (Department of Automation,Harbin Engineering University, Harbin 150001, Heilongjiang, China)
  • Received:2010-10-13 Revised:2010-10-13 Online:2014-03-04
  • Contact: QIAO Xiang-wei E-mail:qiaoxiangwei@126.com

Abstract: A quaternion particle filter algorithm was proposed to solve the aerial vehicle nonlinear attitude determination problem. To reduce computational burden, the state vector was divided into linear part and nonlinear part. Aiming at quaternion weighting sum normalization problem, a Lagrange cost function was derived to compute the predicted quaternion by minimizing the cost function, and the normalization of disturbed quaternion was ensured by calculating the square root of diagonal elements of the quaternion error covariance matrix, the multiplicative quaternion error was used for predicted covariance computation of the quaternion, since it represented the distance between quaternion points and the predicted mean quaternion. The simulation results show that, compared to traditional extended Kalman filter(EKF) and unscented Kalman filter(UKF)algorithms, the proposed algorithm has higher estimation precision and better stability.

CLC Number: