A deterministic attitude estimator for a rigid body under an attitude dependent potential is studied. This estimator requires only a single direction measurement to a known reference point at each measurement instant. The measurement cannot completely determine the attitude, but an attitude estimation scheme based on this measurement is developed; a feasible set compatible with the measurement is described and it is combined with an attitude dynamics model to obtain an attitude estimate. The attitude is globally represented by a rotation matrix, and the uncertainties are described by ellipsoidal sets. A numerical example for a spacecraft in a circular orbit is presented.
There are several attitude estimation algorithms in existence, all of which use local coordinate representations for the group of rigid body orientations. All local coordinate representations of the group of orientations have associated problems. While minimal coordinate representations exhibit kinematic singularities for large rotations, the quaternion representation requires satisfaction of an extra constraint. This paper treats the attitude estimation and filtering problem as an optimization problem, without using any local coordinates for the group of rotations. An attitude determination a…
A deterministic attitude estimation problem for a rigid body in an attitude dependent potential field with bounded measurement errors is studied. An attitude estimation scheme that does not use generalized coordinate representations of the attitude is presented here. Assuming that the initial attitude, angular velocity and measurement noise lie within given ellipsoidal bounds, an uncertainty ellipsoid that bounds the attitude and the angular velocity of the rigid body is obtained. The center of the uncertainty ellipsoid provides point estimates, and its size gives the accuracy of the estimates…
A deterministic attitude estimation problem for a rigid body in a potential field, with bounded attitude and angular velocity measurement errors is considered. An attitude estimation algorithm that globally minimizes the attitude estimation error is obtained. Assuming that the initial attitude, the initial angular velocity and measurement noise lie within given ellipsoidal bounds, an uncertainty ellipsoid that bounds the attitude and the angular velocity of the rigid body is obtained. The center of the uncertainty ellipsoid provides point estimates, and the size of the uncertainty ellipsoid me…
We propose an attitude and gyro-bias estimation scheme for accelerated rigid body systems using an inertial measurement unit (IMU) and a global positioning system (GPS). The proposed scheme allows to obtain attitude estimates directly on the Special Orthogonal group $SO(3)$ while estimating the gyro bias and the unknown apparent acceleration of the vehicle. We prove semi-global exponential stability of the estimation errors. Furthermore, a new switching technique for the attitude state is introduced which results in a velocity-aided hybrid attitude observer with proven global exponential stabi…
Attitude estimation is often a prerequisite for control of the attitude or orientation of mechanical systems. Current attitude estimation algorithms use coordinate representations for the group of rigid body orientations. All coordinate representations of the group of orientations have associated problems. While minimal coordinate representations exhibit kinematic singularities for large rotations, non-minimal coordinates like quaternions require satisfaction of extra constraints. A deterministic attitude estimation problem for a rigid body with bounded measurement errors is considered here. A…
This paper focuses on a stochastic formulation of Bayesian attitude estimation on the special orthogonal group. In particular, an exponential probability density model for random matrices, referred to as the matrix Fisher distribution is used to represent the uncertainties of attitude estimates and measurements in a global fashion. Various stochastic properties of the matrix Fisher distribution are derived on the special orthogonal group, and based on these, two types of intrinsic frameworks for Bayesian attitude estimation are constructed. These avoid complexities or singularities of the atti…
Two nonlinear observers for velocity-aided attitude estimation, relying on gyrometers, accelerometers, magnetometers, and velocity measured in the body-fixed frame, are proposed. As opposed to state-of-the-art body-fixed velocity-aided attitude observers endowed with local properties, both observers are (almost) globally asymptotically stable, with very simple and flexible tuning. Moreover, the roll and pitch estimates are globally decoupled from magnetometer measurements.
This paper is focused on probabilistic estimation for the attitude dynamics of a rigid body on the special orthogonal group. We select the matrix Fisher distribution to represent the uncertainties of attitude estimates and measurements in a global fashion without need for local coordinates. Several properties of the matrix Fisher distribution on the special orthogonal group are presented, and an unscented transform is proposed to approximate a matrix Fisher distribution by selected sigma points. Based on these, an intrinsic, global framework for Bayesian attitude estimation is developed. It is…
The attitude of a rigid body evolves on the three-dimensional special orthogonal group, and it is often estimated by measuring reference directions, such as gravity or magnetic field, using an onboard sensor. As a single direction measurement provides a two-dimensional constraint, it has been widely accepted that at least two non-parallel reference directions should be measured, or the reference direction should change over time, to determine the attitude completely. This paper uncovers an intriguing fact that the attitude can actually be estimated by using multiple measurements of a single, f…
In this article we introduce the use of recently developed min/max-plus techniques in order to solve the optimal attitude estimation problem in filtering for nonlinear systems on the special orthogonal (SO(3)) group. This work helps obtain computationally efficient methods for the synthesis of deterministic filters for nonlinear systems -- i.e. optimal filters which estimate the state using a related optimal control problem. The technique indicated herein is validated using a set of optimal attitude estimation example problems on SO(3).
This paper presents theory, application, and comparisons of the feedback particle filter (FPF) algorithm for the problem of attitude estimation. The paper builds upon our recent work on the exact FPF solution of the continuous-time nonlinear filtering problem on compact Lie groups. In this paper, the details of the FPF algorithm are presented for the problem of attitude estimation - a nonlinear filtering problem on SO(3). The quaternions are employed for computational purposes. The algorithm requires a numerical solution of the filter gain function, and two methods are applied for this purpose…
This paper introduces an advanced Lyapunov stability analysis for an attitude observer that has been developed on the special orthogonal group. In particular, when the attitude observer is constructed based on multiple direction measurements toward known reference points, a local exponential stability has been established by linearization, under the assumption that those reference points are fixed in the inertial frame. Several modifications have been proposed to deal with reference directions changing over time. Here, we present an alternative Lyapunov analysis to show that the attitude obser…
All quaternion methods for static attitude determination currently rely on either the spectral decomposition of a 4 x 4 matrix (q-Method) or finding the maximum eigenvalue of a 4th-order characteristic equation (QUEST). Using a spectral perturbation approach, we show it is possible to analytically estimate the attitude quaternion to high accuracy and recursively calculate the maximum-likelihood attitude quaternion to arbitrary numerical precision. Analytic or recursive estimation removes several numerical difficulties which are inherent to state-of-the-art algorithms, suggesting our results ma…
A continuous solution is proposed to the problem of uniform global exponential estimation of the angular velocity for rigid bodies by means of direct attitude measurements. The proposed observer is designed on $\mathbb{R}^3\times\mathbb{R}^3\times\mathbb{R}^3$, and not on the inherent geometry $\mathtt{SO}(3)\times\mathbb{R}^3$, which allows for a simple structure of the observer, being a copy of the system plus some correction terms, and a straightforward classical Lyapunov stability proof. The performances of the observer are illustrated by means of a simple simulation scenario.
We propose a simple nonlinear observer for estimating the attitude and velocity of a rigid body from the measurements of specific acceleration, angular velocity, magnetic field (in body axes), and linear velocity (in body axes). It is uniformly globally exponentially convergent, and also enjoys other nice properties: global decoupling of pitch and roll estimation from magnetic measurements, good local behavior, and easy tuning. The observer is "geometry-free", in the sense that it respects only asymptotically the rotational geometry. The good behavior of the observer, even when the measurement…
This paper proposes new algorithms for attitude estimation and control based on fused inertial vector measurements using linear complementary filters principle. First, n-order direct and passive complementary filters combined with TRIAD algorithm are proposed to give attitude estimation solutions. These solutions which are efficient with respect to noise include the gyro bias estimation. Thereafter, the same principle of data fusion is used to address the problem of attitude tracking based on inertial vector measurements. Thus, instead of using noisy raw measurements in the control law a new s…
Motivated by drone autonomous navigation applications we address a novel problem of velocity-aided attitude estimation by combining two linear velocity components measured in a body-fixed frame and a linear velocity component measured in an inertial frame with the measurements of an Inertial Measurement Unit (IMU). The main contributions of the present paper are the design of Riccati nonlinear observers, which may be viewed as deterministic versions of an Extended Kalman filter (EKF), and an analysis of observability conditions under which local exponential stability of the observer is achieve…
We consider the problem of jointly estimating the attitude and spin-rate of a spinning spacecraft. Psiaki (J. Astronautical Sci., 57(1-2):73--92, 2009) has formulated a family of optimization problems that generalize the classical least-squares attitude estimation problem, known as Wahba's problem, to the case of a spinning spacecraft. If the rotation axis is fixed and known, but the spin-rate is unknown (such as for nutation-damped spin-stabilized spacecraft) we show that Psiaki's problem can be reformulated exactly as a type of tractable convex optimization problem called a semidefinite opti…
This paper addresses the problem of estimating the attitude of a rigid body, which is subject to high accelerations and equipped with inertial measurement unit (IMU) and sensors providing the body velocity (expressed in the reference frame attached to the body). That issue can be treated differently depending on the level of confidence in the measurements of the magnetometer of the IMU, particularly with regard to the observation of the inclination component with respect to the vertical direction, rendering possible to describe the interaction with gravity. Two cases are then studied: either (…
In this paper, a new probability distribution, referred to as the matrix Fisher-Gaussian (MFG) distribution, is proposed on the nonlinear manifold $\mathrm{SO}(3)\times\mathbb{R}^n$. It is constructed by conditioning a (9+n)-variate Gaussian distribution from the ambient Euclidean space into $\mathrm{SO}(3)\times\mathbb{R}^n$, while imposing a certain geometric interpretation of the correlation terms to avoid over-parameterization. The unique feature is that it may represent large uncertainties in attitudes, linear variables of an arbitrary dimension, and angular-linear correlations between th…
Estimation of rigid body attitude motion is a long-standing problem of interest in several applications. This problem is challenging primarily because rigid body motion is described by nonlinear dynamics and the state space is nonlinear. The extended Kalman filter and its several variants have remained the standard and most commonly used schemes for attitude estimation over the last several decades. These schemes are obtained as approximate solutions to the nonlinear optimal filtering problem. However, these approximate or near optimal solutions may not give stable estimation schemes in genera…
Attitude estimation for small, low-cost unmanned aerial vehicles is often achieved using a relatively simple complementary filter that combines onboard accelerometers, gyroscopes, and magnetometer sensing. This paper explores the limits of performance of such attitude estimation, with a focus on performance in highly dynamic maneuvers. The complementary filter is derived along with the extended Kalman filter and unscented Kalman filter to evaluate the potential performance gains when using a more sophisticated estimator. Simulations are presented that compare performance across a range of test…
Among algorithms used for sensor fusion for attitude estimation in unmanned aerial vehicles, the Extended Kalman Filter (EKF) is the most commonly used for estimation. In this paper, we propose a new version of H2 estimation called extended H2 estimation that can overcome the limitations of the extended Kalman Filter, specifically with respect to computational speed, memory usage, and root mean squared error. We formulate a new attitude-estimation algorithm, where the filter gain is designed offline about a nominal operating point, but the filter dynamics is implemented using the nonlinear sys…
We revisit the gradient based nonlinear attitude complementary filters (observers) on the Special Orthogonal group SO(3) and provide explicit solutions of the norm of the attitude estimation error dynamics. One smooth and two non-smooth attitude observers are considered. The stability and performance properties of theses attitude observers can be easily deduced from the obtained explicit solutions. We show that the smooth complementary attitude filter, previously proposed in the literature, is not Input-to-State-Stable (ISS) with respect to bounded measurement disturbances while the non-smooth…
Western University（韦仕敦大学）；Lakehead University（湖首大学）
This paper investigates the problem of continuous attitude estimation on $SO(3)$ using continuous angular velocity and linear acceleration measurements as well as intermittent linear velocity and inertial vector measurements. First, we propose a nonlinear observer for the case where all the measurements are continuous and almost global asymptotic stability (AGAS) is shown using the notion of almost global input-to-state stability (ISS) on manifolds. Thereafter, a hybrid attitude observer, with AGAS guarantees, is proposed in terms of intermittent linear velocity and vector measurements. Numeri…
This paper addresses the leader-following attitude consensus problem for a group of spacecraft when at least one follower can access the leader's attitude and velocity relative to the inertial space. A nonlinear distributed observer is designed to estimate the leader's states for each follower. The observer possesses one important and novel feature of keeping attitude and angular velocity estimation errors on second-order sliding modes, and thus provides finite-time convergent estimates for each follower. Further, quaternion-based hybrid homogeneous controllers recently developed for single sp…
We revisit the nonlinear complimentary filter on $SO(3)$, previously proposed in the literature, and provide the (time-explicit) solution to the matrix ODE governing the attitude estimation error in the absence of measurement errors. The stability and performance properties of this filter can be easily deduced from the obtained closed-from solution. Thereafter, we consider two nonlinear complimentary filters (with state-dependent gains) which are shown to exhibit improved stability and performance proprieties compared to the traditional filter. We perform robustness analysis for the three disc…
An approach to the control of a VTOL vehicle equipped with complementary thrust-direction tilting capabilities that nominally yield full actuation of the vehicle's position and attitude is developed. The particularity and difficulty of the control problem are epitomized by the existence of a maximal thrust-tilting angle which forbids complete and decoupled control of the vehicle's position and attitude in all situations. This problem is here addressed via the formalism of primary and secondary objectives and by extending a solution previously derived in the fixed thrust-direction case. The pro…
Motivated by attitude control and attitude estimation problems for a rigid body, computational methods are proposed to propagate uncertainties in the angular velocity and the attitude. The nonlinear attitude flow is determined by Euler-Poincaré equations that describe the rotational dynamics of the rigid body acting under the influence of an attitude dependent potential and by a reconstruction equation that describes the kinematics expressed in terms of an orthogonal matrix representing the rigid body attitude. Uncertainties in the angular velocity and attitude are described in terms of ellips…
In this note an intrinsic version of the Cramér-Rao bound on estimation accuracy is established on the Special Orthogonal group $SO(3)$. It is intrinsic in the sense that it does not rely on a specific choice of coordinates on $SO(3)$: the result is derived using rotation matrices, but remains valid when using other parameterizations, such as quaternions. For any estimator $\hat R$ of $R\in SO(3)$ we give indeed a lower bound on the quantity $E(\log(R\hat R^T))$, that is, the estimation error expressed in terms of group multiplication, whereas the usual estimation error $E(\hat R-R)$ is meanin…
