INTERLACED KALMAN FILTERING OF 3-D ANGULAR MOTION BASED ON EULER NONLINEAR EQUATIONS

A novel Kalman filtering technique is presented that reduces the mean-square-error (MSE) between three-dimensional (3-D) actual angular velocity values and estimated ones by an order of magnitude (when compared with the MSE resulting from direct measurements) even under extremely low signal-to-noise ratio conditions. The filtering problem is nonlinear in nature because the dynamics of 3-D angular motion are described by Euler's equations. This nonlinear set of differential equations state that the angular acceleration in one axis is proportional to the torque applied to that axis, and to the products of angular velocity components in the other two axes of rotation. Instead of using extended Kalman filtering techniques to solve this complex problem, the authors developed a new approach where the nonlinear Euler's model is decomposed into two pseudolinear models (primary and secondary). The first model describes the time progression of the state vector containing the linear terms, while the other characterizes the propagation of the state vector containing the nonlinearities. This makes it possible to run two interlaced discrete-linear Kalman filters simultaneously. One filter estimates the values of the state vector containing the linear terms, while the other estimates the values of the state vector containing the nonlinear terms in the system. These estimates are then recombined, solving the nonlinear estimation process without linearizing the system. Thus, the new approach takes advantage of the simplicity, computational efficiency and higher convergence speed of the linear Kalman filter form, and it overcomes many of the drawbacks typical of conventional extended Kalman filtering techniques. The high performance and effectiveness of this method is demonstrated through a computer simulation case study.