Second-Order-Optimal Filter on Lie Groups for Planar Rigid Bodies

• Published in: IEEE transactions on automatic control Vol. 67; no. 9; pp. 4971 - 4977
• Main Authors: Rigo, Damiano, Segala, Chiara, Sansonetto, Nicola, Muradore, Riccardo
• Format: Journal Article
• Language: English
• Published: New York IEEE 01-09-2022; The Institute of Electrical and Electronics Engineers, Inc. (IEEE)
• Subjects: Algebra; Antenna measurements; Cost function; Error analysis; Filtering theory; Geometric modeling; Inertial platforms; Kalman filters; Lie groups; Mathematical analysis; Mathematical models; nonlinear dynamical systems; nonlinear filters; Optimization; Position measurement; Rigid structures; Transmission line matrix methods
• ISSN: 0018-9286; 1558-2523
• DOI: 10.1109/TAC.2022.3179988

Attitude estimation is a core problem in many mobile robotic systems, such as unmanned aerial and ground vehicles. The configuration space of these systems is properly modeled by exploiting the theory of Lie groups. In this article, we propose a second-order-optimal minimum-energy filter on the matrix Lie group TSE(2), the tangent bundle of the special Euclidean group SE(2), where the optimality is with respect to a cost function in the unknown input and output error measurements. In this article, the measurement equation consists of a global positioning system-like device with two antennas attached to the planar rigid body and an inertial measurement unit-like device. Even though the mathematics is quite complicated, the accuracy of the filter justifies this approach. Simulations show the effectiveness of the proposed filter.