The problem of attitude tracking in the presence of disturbances is addressed by combining inverse optimality and disturbance attenuation. Conditions are provided which ensure that an inverse optimal nonlinear attitude control problem is solved and a meaningful cost function is minimized. The approach results in a PD-type attitude control law on the Special Orthogonal Group which guarantees that, for almost all initial conditions, the energy gain from an exogenous disturbance to a specified error signal respects a given upper bound. For numerical simulations, a satellite attitude tracking problem from literature is considered. The controller gains are tuned using a decoupled linearized single-axis model and the structured control synthesis method. Results indicate that the proposed controller has good tracking and disturbance attenuation capability. In particular, for the problem under consideration, the inverse optimal controller is seen to have better transient performance than its continuous-time quaternion counterpart. Moreover, for initial errors up to radians, it has comparable performance to the shortest-path quaternion PD controller.
This paper studies the problem of H∞ filtering for attitude estimation using rotation matrices and vector measurements. Starting from a storage function on the Special Orthogonal Group SO(3), a dissipation inequality is considered such that the energy gain from exogenous disturbances and initial estimation errors to a generalized estimation error respects a given upper bound, γ. Thereafter, an approximate deterministic nonlinear H∞ filter is derived which satisfies the dissipation inequality at least locally. The approach followed builds on earlier results on attitude estimation, in particular on nonlinear H∞ filtering using quaternions, and develops a robust filter directly on SO(3). The filter employs the same innovation term as the Multiplicative Extended Kalman Filter (MEKF), as well as a matrix gain updated in accordance with a Riccati-type gain update equation. However, in contrast to the MEKF, the filter has an additional tuning gain, γ, which enables it to be more aggressive during transients. Thus, the proposed H∞ filter can be seen as a robust counterpart of the MEKF.
The problem of nonlinear H ∞ filtering on the unit circle is considered, and a solution is provided, which respects a given upper bound on the energy gain from disturbances and initial conditions to the estimation error. The proposed filter is simulated for typical conditions and the results are compared with the Extended Kalman filter and the minimum energy filter.
This paper proposes a novel geometric nonlinear filter for attitude and bias estimation on the Special Orthogonal Group $SO(3)$ using matrix measurements. The structure of the proposed filter is similar to that of the continuous-time deterministic multiplicative extended Kalman filter (MEKF). The main difference with the MEKF is the inclusion of curvature correction terms in both the filter gain and gain update equations. These terms ensure that the proposed filter, named the Generalized $SO(3)$-MEKF, renders the desired equilibrium of the estimation error system to be almost globally uniformly asymptotically stable (AGUAS). More precisely, the attitude and bias estimation errors converge uniformly asymptotically to zero for almost all initial conditions except those where the initial angular estimation error equals $π$ radians. Moreover, in the case of small estimation errors, the proposed generalized $SO(3)$-MEKF simplifies to the standard $SO(3)$-MEKF with matrix measurements. Simulation results indicate that the proposed filter has similar performance compared to the latter. Thus, the main advantage of the proposed filter over the MEKF is the guarantee of (almost) global uniform asymptotic stability.