An official website of the United States government
This paper presents a nonlinear finite-time stable attitude estimation scheme for a rigid body with unknown dynamics. Attitude is estimated from a minimum of two linearly independent known vectors measured in the body-fixed frame, and the angular velocity vector is assumed to have a constant bias in addition to measurement errors. Estimated attitude evolves directly on the special Euclidean group SO(3), avoiding any ambiguities. The constant bias in angular velocity measurements is also estimated. The estimation scheme is proven to be almost globally finite time stable in the absence of measurement errors using a Lyapunov analysis. For digital implementation, the estimation scheme is discretized as a geometric integrator. Numerical simulations demonstrate the robustness and convergence capabilities of the estimation scheme.
more »
« less
This content will become publicly available on July 8, 2026
Geometric extended state observer on TSO(3) in the presence of bias in angular velocity measurements
This article presents an estimation scheme for a rotating rigid body in the presence of unknown disturbance torque and unknown bias in angular velocity measurements. The attitude, angular velocity and disturbance torque are estimated from on-board control inputs, landmark vector measurements, and angular velocity measurements. The estimated attitude evolves directly on the special orthogonal group SO(3) of rigid body rotations. A Lyapunov analysis is given to prove that the proposed estimation scheme is almost globally Lyapunov stable in the absence of measurement noise and dynamic disturbance. The estimation scheme is discretized as a geometric integrator for practical implementation. The geometry-preserving properties of this numerical integrator preserve the Lie group structure of the configuration space, and give long time numerical stability. Numerical simulations demonstrate the stability and robustness properties of the proposed scheme.
more »
« less
- PAR ID:
- 10657081
- Publisher / Repository:
- IEEE
- Date Published:
- Page Range / eLocation ID:
- 5111 to 5116
- Format(s):
- Medium: X
- Location:
- Denver, Colorado
- Sponsoring Org:
- National Science Foundation
More Like this
-
-
This article proposes a novel integral geometric control attitude tracking scheme, utilizing a coordinate-free representation of attitude on the Lie group of rigid body rotations, SO(3). This scheme exhibits almost global asymptotic stability in tracking a reference attitude profile. The stability and robustness properties of this integral tracking control scheme are shown using Lyapunov stability analysis. A numerical simulation study, utilizing a Lie Group Variational Integrator (LGVI), verifies the stability of this tracking control scheme, as well as its robustness to a disturbance torque. In addition, a numerical comparison study shows the effectiveness of the proposed geometric integral term, when compared to other state-of-the-art attitude controllers. In addition, software-in-the-loop (SITL) simulations show the advantages of utilizing the proposed attitude controller in PX4 autopilot compared to using PX4’s original attitude controller.more » « less
-
The rigid body attitude estimation problem is treated using the discrete-time Lagrange-d'Alembert principle. Three different possibilities are considered for the multi-rate relation between angular velocity measurements and direction vector measurements for attitude: 1) integer relation between sampling rates, 2) time-varying sampling rates, 3) non-integer relation between sampling rates. In all cases, it is assumed that angular velocity measurements are sampled at a higher rate compared to the inertial vectors. The attitude determination problem from two or more vector measurements in the body-fixed frame is formulated as Wahba's problem. At instants when direction vector measurements are absent, a discrete-time model for attitude kinematics is used to propagate past measurements. A discrete-time Lagrangian is constructed as the difference between a kinetic energy-like term that is quadratic in the angular velocity estimation error and an artificial potential energy-like term obtained from Wahba's cost function. An additional dissipation term is introduced and the discrete-time Lagrange-d'Alembert principle is applied to the Lagrangian with this dissipation to obtain an optimal filtering scheme. A discrete-time Lyapunov analysis is carried out to show that the optimal filtering scheme is asymptotically stable in the absence of measurement noise and the domain of convergence is almost global. For a realistic evaluation of the scheme, numerical experiments are conducted with inputs corrupted by bounded measurement noise. These numerical simulations exhibit convergence of the estimated states to a bounded neighborhood of the actual states.more » « less
-
In this paper, an anti-windup compensation scheme is proposed for the manual mode of a rigid body attitude control system to make the angular velocity dynamics globally asymptotically stable despite actuator saturation. The addressed anti-windup design problem is challenging since the nominal control law includes a nonlinear dynamic inversion element to cancel the nonlinearity in the angular velocity dynamics. The stability of the compensated closed-loop system is proved via the Lyapunov stability criterion appropriately. Moreover, the superiority of the compensated system versus the uncompensated one is demonstrated by simulation.more » « less
-
This article presents an attitude tracking control scheme with Hölder continuity and finite-time stability. The first part of this article discusses and compares the features of first-order multivariable Hölder-continuous systems with coupled-scalar sliding-mode systems. The advantages of Hölder-continuous systems over sliding-mode systems are presented from the perspectives of control continuity and noise robustness. Thereafter, a Hölder-continuous second-order differentiator is presented with its stability and robustness properties. This is followed by its use in an attitude tracking control scheme, which is covered in the second part of the article. The proposed tracking control scheme is designed directly on the state-space of rigid-body rotational motion, which is the tangent bundle of the Lie group of 3D rotations. The control scheme design, its stability, and its robustness properties are obtained through Lyapunov stability analyses. The proposed Hölder-continuous design is compared with three comparable sliding-mode designs. Numerical simulations on a simulated CubeSat demonstrate the performance of the proposed control scheme and compare it with the sliding-mode control schemes. The numerical simulations also compare the proposed control scheme with other state-of-the-art sliding-mode control approaches in existing research publications. The comparison results demonstrate that the proposed Hölder-continuous attitude control scheme exhibits lower control efforts and tracking control errors over these sliding-mode control schemes in simulations that incorporate actuator dynamics and measurement uncertainties.more » « less
