Continuous Time Estimation of Attitude Using B Splines on Lie Groups
Filtering algorithms are the workhorse of spacecraft attitude estimation, but recent research has shown that the use of batch estimation techniques can result in higher accuracy per unit of computational cost. This paper presents an approach for singularity free batch estimation of attitude in continuous time using B Spline curves on unit length quaternions. It extends existing theory of unit length quaternion B splines to general Lie groups and arbitrary B spline order. It is shown how to use these curves for continuous time batch estimation using Gauss Newton or Levenberg Marquardt, including efficient curve initialization, a parameter update step that preserves the Lie group constraint within an unconstrained optimization framework, and the derivation of Jacobians of the B spline's value and its time derivatives with respect to an update of its parameters. For unit length quaternion splines, the equations for angular velocity and angular acceleration are derived. An implementation of this algorithm is