This paper considers the problem of obtaining good attitude estimates from measurements obtained from typical low cost inertial measurement units. The outputs of such systems are characterized by high noise levels and time varying additive biases. We formulate the filtering problem as deterministic observer kinematics posed directly on the special orthogonal group SO (3) driven by reconstructed attitude and angular velocity measurements. Lyapunov analysis results for the proposed observers are derived that ensure almost global stability of the observer error. The approach taken leads to an observer that we term the direct complementary filter. By exploiting the geometry of the special orthogonal group a related observer, termed the passive complementary filter, is derived that decouples the gyro measurements from the reconstructed attitude in the observer inputs. Both the direct and passive filters can be extended to estimate gyro bias online. The passive filter is further developed to provide a formulation in terms of the measurement error that avoids any algebraic reconstruction of the attitude. This leads to an observer on SO(3), termed the explicit complementary filter, that requires only accelerometer and gyro outputs; is suitable for implementation on embedded hardware; and provides good attitude estimates as well as estimating the gyro biases online. The performance of the observers are demonstrated with a set of experiments performed on a robotic test-bed and a radio controlled unmanned aerial vehicle.

/pdf/nonlinear-complementary-filters-on-the-special-orthogonal-ysp0zzaoar.pdf

Nonlinear Complementary Filters on the Special Orthogonal Group

This paper provides a survey of modern nonlinear filtering methods for attitude estimation. Early applications relied mostly on the extended Kalman filter for attitude estimation. Since these applications, several new approaches have been developed that have proven to be superior to the extended Kalman filter. Several of these approaches maintain the basic structure of the extended Kalman filter, but employ various modifications in order to provide better convergence or improve other performance characteristics. Examples of such approaches include: filter QUEST, extended QUEST and the backwards-smoothing extended Kalman filter. Filters that propagate and update a discrete set of sigma points rather than using linearized equations for the mean and covariance are also reviewed. A twostep approach is discussed with a first-step state that linearizes the measurement model and an iterative second step to recover the desired attitude states. These approaches are all based on the Gaussian assumption that the probability density function is adequately specified by its mean and covariance. Other approaches that do not require this assumption are reviewed, Associate Professor, Department of Mechanical & Aerospace Engineering. Email: johnc@eng.buffalo.edu. Associate Fellow AIAA. Aerospace Engineer, Guidance, Navigation and Control Systems Engineering Branch. Email: Landis.Markley@nasa.gov. Fellow AIAA. Postdoctoral Research Fellow, Department of Mechanical & Aerospace Engineering. Email: cheng3@eng.buffalo.edu. Member AIAA.

/pdf/survey-of-nonlinear-attitude-estimation-methods-4tcu9nk5p8.pdf

Survey of nonlinear attitude estimation methods

A new spacecraft attitude estimation approach based on the unscented filter is derived. For nonlinear systems the unscented filter uses a carefully selected set of sample points to map the probability distribution more accurately than the linearization of the standard extended Kalman filter, leading to faster convergence from inaccurate initial conditions in attitude estimation problems. The filter formulation is based on standard attitude-vector measurements using a gyro-based model for attitude propagation. The global attitude parameterization is given by a quaternion, whereas a generalized three-dimensional attitude representation is used to define the local attitude error. A multiplicative quaternion-error approach is derived from the local attitude error, which guarantees that quaternion normalization is maintained in the filter. Simulation results indicate that the unscented filter is more robust than the extended Kalman filter under realistic initial attitude-error conditions.

https://www.acsu.buffalo.edu/~johnc/uf_att.pdf

Unscented Filtering for Spacecraft Attitude Estimation

The quaternion has the lowest dimensionality possible for a globally nonsingular attitude representation. The quaternion must obey a unit norm constraint, though, which has led to the development of an extended Kalman filter using a quaternion for the global attitude estimate and a three-component representation for attitude errors. We consider various attitude error representations for this Multiplicative Extended Kalman Filter and its second-order extension.

/pdf/attitude-error-representations-for-kalman-filtering-4qpw2v1th8.pdf

Attitude Error Representations for Kalman Filtering

Autonomous helicopter flight is widely regarded to be a highly challenging control problem. Despite this fact, human experts can reliably fly helicopters through a wide range of maneuvers, including aerobatic maneuvers at the edge of the helicopterâs capabilities. We present apprenticeship learning algorithms, which leverage expert demonstrations to efficiently learn good controllers for tasks being demonstrated by an expert. These apprenticeship learning algorithms have enabled us to significantly extend the state of the art in autonomous helicopter aerobatics. Our experimental results include the first autonomous execution of a wide range of maneuvers, including but not limited to in-place flips, in-place rolls, loops and hurricanes, and even auto-rotation landings, chaos and tic-tocs, which only exceptional human pilots can perform. Our results also include complete airshows, which require autonomous transitions between many of these maneuvers. Our controllers perform as well as, and often even better than, our expert pilot.

/pdf/autonomous-helicopter-aerobatics-through-apprenticeship-275kvd1oi2.pdf

Autonomous Helicopter Aerobatics through Apprenticeship Learning

HIS report reviews the methods of Kalman filtering in attitude estimation and their development over the last two decades. This review is not intended to be complete but is limited to algorithms suitable for spacecraft equipped with three-axis gyros as well as attitude sensors. These are the systems to which we feel that Kalman filtering is most ap- plicable. The Kalman filter uses a dynamical model for the time development of the system and a model of the sensor measurements to obtain the most accurate estimate possible of the system state using a linear estimator based on present and past measurements. It is, thus, ideally suited to both ground-based and on-board attitude determination. However, the applicability of the Kalman filtering technique rests on the availability of an accurate dynamical model. The dynamic equations for the spacecraft attitude pose many difficulties in the filter modeling. In particular, the external torques and the distribution of momentum internally due to the use of rotating or rastering instruments lead to significant uncertainties in the modeling. For autonomous spacecraft the use of inertial reference units as a model replacement permits the circumvention of these problems. In this representation the angular velocity of the spacecraft is obtained from the gyro data. The kinematic equations are used to obtain the attitude state and this is augmented by means of additional state-vector components for the gyro biases. Thus, gyro data are not treated as observations and the gyro noise appears as state noise rather than as observation noise. It is theoretically possible that a spacecraft is three-axis stabilized with such rigidity that the time development of the system can be described accurately without gyro information, or that it is one-axis stabilized so that only a single gyro is needed to provide information on the time history of the system. The modification of the algorithms presented here in order to apply to those cases is slight. However, this is of little practical importance because a control system capable of such

Kalman Filtering for Spacecraft Attitude Estimation

Several schemes in current use for sequential estimation of spacecraft attitude using Kalman filters are examined. These differ according to their treatment of the attitude error, namely: using the complete four-component quaternion; using a truncated quaternion in which one of the components has been eliminated; or using a quaternion referred to approximate body-fixed axes. These schemes are examined for the case of a spacecraft carrying line-of-sight attitude sensors and three-axis gyros whose measurements are corrupted by noise on both the drift rate and the drift-rate ramp. The analysis of the covariance is carried out in detail. The historical development of Kalman filtering of attitude is reviewed.

E. J. Lefferts

Papers

Kalman Filtering for Spacecraft Attitude Estimation

Kalman filtering for spacecraft attitude estimation