A geometric estimator is proposed for the rigid body attitude under multi-rate measurements using discrete-time Lyapunov stability analysis in this work. The angular velocity measurements are assumed to be sampled at a higher rate compared to the attitude. The attitude determination problem from two or more vector measurements in the body-fixed frame is formulated as Wahba's problem. In the case when measurements are absent, a discrete-time model for attitude kinematics is assumed in order to propagate the measurements. A discrete-time Lyapunov function is constructed as the sum of 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. A filtering scheme is obtained by discrete-time stability analysis using a suitable Lyapunov function. The analysis shows that the filtering scheme is exponentially 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. Simulation results exhibit convergence of the estimated states to a bounded neighborhood of the actual states.
In this paper, anti-unwinding attitude maneuver control for rigid spacecraft is considered. First, in order to avoid the unwinding phenomenon when the system states are restricted to the switching surface, a novel switching function is constructed by hyperbolic sine functions such that the switching surface contains two equilibriums. Then, a sliding mode attitude maneuver controller is designed based on the constructed switching function to ensure the robustness of the closed-loop attitude maneuver control system to disturbance. Another important feature of the developed attitude control law i…
In this paper, attitude maneuver control without unwinding phenomenon is investigated for rigid spacecraft. First, a novel switching function is constructed by a hyperbolic sine function. It is shown that the spacecraft system possesses the unwinding-free performance when the system states are on the sliding surface. Based on the designed switching function, a sliding mode controller is developed to ensure the robustness of the attitude maneuver control system. Another essential feature of the presented attitude control law is that a dynamic parameter is introduced to guarantee the unwinding-f…
The rigid-body attitude tracking using vector and biased gyro measurements with unknown inertia matrix is studied in this note. First, a gyro-bias observer with global exponential stability is designed. Then, an attitude tracking controller based on this observer is devised, ensuring almost global asymptotic stability and almost semiglobal exponential stability. A separation property of the combined observer-controller is proved. Lastly, an adaptive attitude tracking controller relying on a modified gyro-bias observer and with no over-parametrization is developed to deal with the unknown inert…
This paper introduces two novel nonlinear stochastic attitude estimators developed on the Special Orthogonal Group \mathbb{SO}\left(3\right) with the tracking error of the normalized Euclidean distance meeting predefined transient and steady-state characteristics. The tracking error is confined to initially start within a predetermined large set such that the transient performance is guaranteed to obey dynamically reducing boundaries and decrease smoothly and asymptotically to the origin in probability from almost any initial condition. The proposed estimators produce accurate attitude estimat…
This paper presents a novel Lagrangian approach to attitude tracking for rigid spacecraft using unit quaternions, where the motion equations of a spacecraft are described by a four degrees of freedom Lagrangian dynamics subject to a holonomic constraint imposed by the norm of a unit quaternion. The basic energy-conservation property as well as some additional useful properties of the Lagrangian dynamics are explored, enabling to develop quaternion-based attitude tracking controllers by taking full advantage of a broad class of tracking control designs for mechanical systems based on energy-sha…
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 bod…
This article develops and proposes a geometric nonlinear proportional-integral-derivative (PID) type tracking control scheme on the Lie group of rigid body rotations, SO(3). Like PD-type attitude tracking control schemes that have been proposed in the past, this PID-type control scheme exhibits almost global asymptotic stability in tracking a desired attitude profile. The stability of this PID-type tracking control scheme is shown using a Lyapunov analysis. A numerical simulation study demonstrates the stability of this tracking control scheme, as well as its robustness to a disturbance torque…
The paper addresses the problem of attitude estimation for rigid bodies using (possibly time-varying) vector measurements, for which we provide a necessary and sufficient condition of distinguishability. Such a condition is shown to be strictly weaker than those previously used for attitude observer design. Thereafter, we show that even for the single vector case the resulting condition is sufficient to design almost globally convergent attitude observers, and two explicit designs are obtained. To overcome the weak excitation issue, the first design employs to make full use of historical infor…
Accurate state estimation using low-cost MEMS (Micro Electro- Mechanical Systems) sensors present on Commercial-off-the-shelf (COTS) drones is a challenging problem. Most UAV systems use a combination of a gyroscope, an accelerometer, and a magnetometer to obtain measurements and estimate attitude. Under this paradigm of sensor fusion, the Extended Kalman Filter (EKF) is the most popular algorithm for attitude estimation in UAVs. In this work, we propose a novel estimation technique called extended H2 filter that can overcome the limitations of the EKF, specifically with respect to computation…
This paper presents a method to control a manipulator system grasping a rigid-body payload so that the motion of the combined system in consequence of externally applied forces to be the same as another free-floating rigid-body (with different inertial properties). This allows zero-g emulation of a scaled spacecraft prototype under the test in a 1-g laboratory environment. The controller consisting of motion feedback and force/moment feedback adjusts the motion of the test spacecraft so as to match that of the flight spacecraft, even if the latter has flexible appendages (such as solar panels)…
Two novel robust nonlinear stochastic full pose (i.e, attitude and position) estimators on the Special Euclidean Group SE(3) are proposed using the available uncertain measurements. The resulting estimators utilize the basic structure of the deterministic pose estimators adopting it to the stochastic sense. The proposed estimators for six degrees of freedom (DOF) pose estimations consider the group velocity vectors to be contaminated with constant bias and Gaussian random noise, unlike nonlinear deterministic pose estimators which disregard the noise component in the estimator derivations. The…
Strapdown inertial navigation research involves the parameterization and computation of the attitude, velocity and position of a rigid body in a chosen reference frame. The community has long devoted to finding the most concise and efficient representation for the strapdown inertial navigation system (INS). The current work is motivated by simplifying the existing dual quaternion representation of the kinematic model. This paper proposes a compact and elegant representation of the body's attitude, velocity and position, with the aid of a devised trident quaternion tool in which the position is…
This paper proposes a real-time neural network (NN) stochastic filter-based controller on the Lie Group of the Special Orthogonal Group $SO(3)$ as a novel approach to the attitude tracking problem. The introduced solution consists of two parts: a filter and a controller. Firstly, an adaptive NN-based stochastic filter is proposed that estimates attitude components and dynamics using measurements supplied by onboard sensors directly. The filter design accounts for measurement uncertainties inherent to the attitude dynamics, namely unknown bias and noise corrupting angular velocity measurements.…
Successful control of a rigid-body rotating in three dimensional space requires accurate estimation of its attitude. The attitude dynamics are highly nonlinear and are posed on the Special Orthogonal Group $SO(3)$. In addition, measurements supplied by low-cost sensing units pose a challenge for the estimation process. This paper proposes a novel stochastic nonlinear neural-adaptive-based filter on $SO(3)$ for the attitude estimation problem. The proposed filter produces good results given measurements extracted from low-cost sensing units (e.g., IMU or MARG sensor modules). The filter is guar…
Successful navigation of a rigid-body traveling with six degrees of freedom (6 DoF) requires accurate estimation of attitude , position, and linear velocity. The true navigation dynamics are highly nonlinear and are modeled on the matrix Lie group of SE2(3). This paper presents novel geometric nonlinear continuous stochastic navigation observers on SE2(3) capturing the true nonlinearity of the problem. The proposed observers combines IMU and landmark measurements. It efficiently handles the IMU measurement noise. The proposed observers are guaranteed to be almost semi-globally uniformly ultima…
This work proposes a quaternion-based sliding variable that describes exponentially convergent error dynamics for any forward complete desired attitude trajectory. The proposed sliding variable directly operates on the non-Euclidean space formed by quaternions and explicitly handles the double covering property to enable global attitude tracking when used in feedback. In-depth analysis of the sliding variable is provided and compared to others in the literature. Several feedback controllers including nonlinear PD, robust, and adaptive sliding control are then derived. Simulation results of a r…
The general objective of this Ph.D. thesis is to study the dynamics and control of rigid and flexible spacecraft supported by a high-fidelity numerical simulation environment. The demand for greater attitude pointing precision, attitude maneuvering or recovery with the increased use of lightweight and flexible materials necessitates the consideration of flexible dynamics in the control strategy. These highly nonlinear dynamics which increase the order of the system are extremely difficult to model with high degree of accuracy. A general model for attitude and flexible dynamics for a class of s…
This paper addresses the global exponential attitude tracking of a spacecraft when gyro measurements are corrupted by bias. Based on contraction analysis, an exponentially convergent nonlinear observer is designed first to estimate the gyro bias. Relying on this bias estimator and the quaternion logarithm representation of the tracking error, an exponentially globally convergent controller is devised. This controller stabilizes the unique equilibrium of the closed-loop system, where the tracking error is the unit quaternion. For more energy-efficiency and enhancing the robustness in the presen…
Technische Universität Berlin（柏林工业大学）；Friedrich-Alexander-Universität Erlangen-Nürnberg（埃尔朗根-纽伦堡弗里德里希-亚历山大大学）
Inertial-sensor-based attitude estimation is a crucial technology in various applications, from human motion tracking to autonomous aerial and ground vehicles. Application scenarios differ in characteristics of the performed motion, presence of disturbances, and environmental conditions. Since state-of-the-art attitude estimators do not generalize well over these characteristics, their parameters must be tuned for the individual motion characteristics and circumstances. We propose RIANN, a ready-to-use, neural network-based, parameter-free, real-time-capable inertial attitude estimator, which …
This report proposes a discrete time observer for the continuous time rigid body kinematics on the rotation group $\mathbb{S}\mathbb{O}(3)$. The work draws on two research schools - one by Chang based on feedback integrators for systems evolving on manifolds,and the other by Mahony, who proposed an observer for attitude dynamics. The discrete time observer is based on the modified dynamics of the Mahony observer for attitude dynamics, where the modification of the vector field enables numerical integration based on Euclidean schemes.
The problem of estimating the angular speed of a solid body from attitude measurements is addressed. To solve this problem, we propose an observer whose dynamics are not constrained to evolve on any specific manifold. This drastically simplifies the analysis of the proposed observer. Using Lyapunov analysis, sufficient conditions for global asymptotic stability of a set wherein the estimation error is equal to zero are established. In addition, the proposed methodology is adapted to deal with angular speed estimation for systems evolving on the unit circle. The approach is illustrated through …
Simultaneous Localization and Mapping (SLAM) is one of the key robotics tasks as it tackles simultaneous mapping of the unknown environment defined by multiple landmark positions and localization of the unknown pose (i.e., attitude and position) of the robot in three-dimensional (3D) space. The true SLAM problem is modeled on the Lie group of $\mathbb{SLAM}_{n}\left(3\right)$, and its true dynamics rely on angular and translational velocities. This paper proposes a novel geometric nonlinear stochastic estimator algorithm for SLAM on $\mathbb{SLAM}_{n}\left(3\right)$ that precisely mimics the n…
This letter studies a distributed collision avoidance control problem for a group of rigid bodies on a sphere. A rigid body network, consisting of multiple rigid bodies constrained to a spherical surface and an interconnection topology, is first formulated. In this formulation, it is shown that motion coordination on a sphere is equivalent to attitude coordination on the 3-dimensional Special Orthogonal group. Then, an angle-based control barrier function that can handle a geodesic distance constraint on a spherical surface is presented. The proposed control barrier function is then extended t…
A General Nonlinear Observer Design for Inertial Navigation Systems with Almost Global Stability Guarantees
Capgemini Engineering（凯捷工程）；University of Quebec in Outaouais（渥太华大学）；I3S-UniCA-CNRS, University Cote d’Azur（尼斯大学）；Institut Universitaire de France（法国高等研究院）
This paper presents the design of a geometric trajectory tracking controller for the cooperative task of two quadrotor UAVs (unmanned aerial vehicles) carrying and transporting a rigid bar, which is attached to the quadrotors via inflexible elastic cables. The elasticity of the cables together with techniques of singular perturbation allows a reduction in the model to that of a similar model with inelastic cables. In this reduced model, we design a controller such that the rod exponentially tracks a given desired trajectory for its position and attitude, under some assumptions on initial error…
