Tarek Hamel

Alessandro Melis, Tarek Bouazza, Hassan Alnahhal et al.

Attitude estimation methods typically rely on full vector measurements from inertial sensors such as accelerometers and magnetometers. This paper shows that reliable estimation can also be achieved using only scalar measurements, which naturally arise either as components of vector readings or as independent constraints from other sensing modalities. We propose nonlinear deterministic observers on $\mathbf{SO}(3)$ that incorporate gyroscope bias compensation and guarantee uniform local exponential stability under suitable observability conditions. A key feature of the framework is its robustness to partial sensing: accurate estimation is maintained even when only a subset of vector components is available. Experimental validation on the BROAD dataset confirms consistent performance across progressively reduced measurement configurations, with estimation errors remaining small even under severe information loss. To the best of our knowledge, this is the first work to establish fundamental observability results showing that two scalar measurements under suitable excitation suffice for attitude estimation, and that three are enough in the static case. These results position scalar-measurement-based observers as a practical and reliable alternative to conventional vector-based approaches.

Simone de Marco, Lorenzo Marconi, Tarek Hamel et al.

This paper deals with the problem of output regulation for systems defined on matrix Lie-Groups. Reference trajectories to be tracked are supposed to be generated by an exosystem, defined on the same Lie-Group of the controlled system, and only partial relative error measurements are supposed to be available. These measurements are assumed to be invariant and associated to a group action on a homogeneous space of the state space. In the spirit of the internal model principle the proposed control structure embeds a copy of the exosystem kinematic. This control problem is motivated by many real applications fields in aerospace, robotics, projective geometry, to name a few, in which systems are defined on matrix Lie-groups and references in the associated homogenous spaces.

Daniele Pucci, Tarek Hamel, Pascal Morin et al.

This paper participates in the development of a unified approach to the control of aerial vehicles with extended flight envelopes. More precisely, modeling for control purposes of a class of thrust-propelled aerial vehicles subjected to lift and drag aerodynamic forces is addressed assuming a rotational symmetry of the vehicle's shape about the thrust force axis. A condition upon aerodynamic characteristics that allows one to recast the control problem into the simpler case of a spherical vehicle is pointed out. Beside showing how to adapt nonlinear controllers developed for this latter case, the paper extends a previous work by the authors in two directions. First, the 3D case is addressed whereas only motions in a single vertical plane was considered. Secondly, the family of models of aerodynamic forces for which the aforementioned transformation holds is enlarged.

Giulio Delama, Martin Scheiber, Yixiao Ge et al.

Many Inertial Navigation Systems (INS) use Global Navigation Satellite System (GNSS) position as the primary measurement to drive filter performance and bound error growth. However, commercial-grade GNSS receivers introduce unknown measurement delays ranging from 50 ms to 300 ms depending on sensor quality and operating mode. Such time delays can significantly degrade INS performance unless they are explicitly compensated for. Existing algorithms commonly estimate this delay offline, run the filter concurrently with GNSS measurements using buffered Inertial Measurement Unit (IMU) data, and predict the current state by forward-integrating buffered inertial measurements via IMU preintegration. The state-of-the-art online method is an Extended Kalman Filter (EKF) that explicitly models the time delay as a state parameter, which defines the preintegration duration. This paper introduces a novel geometric framework for modeling time-delayed INS, in which Galilean symmetry is leveraged to provide a joint representation of space and time for consistent state estimation. An Equivariant Filter (EqF) is derived for the coupled estimation of navigation states and time delay. Validation is performed on two fixed-wing Uncrewed Aerial Vehicles (UAV) with GNSS time lags of 90 ms and 120 ms. The test flights last two to three minutes. Simulations further investigate delays up to 500 ms and provide a statistical comparison against the state-of-the-art EKF. Results show that the EqF preserves accuracy and consistency, while the EKF lacks consistency and its performance degrades significantly with increasing measurement delays.

Alessandro Melis, Tarek Bouazza, Soulaimane Berkane et al.

This paper addresses the problem of estimating the relative pose (position and orientation) and velocity of a vehicle with respect to a moving target, where both are equipped with Inertial Measurement Units (IMUs), assuming the availability of relative position or bearing measurements. The body-target relative dynamics are formulated on $\mathbf{SE}_2(3)$ and recast into a linear time-varying (LTV) model in the ambient space $\mathbb{R}^{15}$, on which a deterministic Riccati observer is designed. We analyze the uniform observability (UO) conditions required to guarantee global exponential convergence of the estimation error in the ambient space for both measurement cases. In the case of relative position measurements, UO requires only a persistence-of-excitation condition on the target acceleration, whereas for bearing measurements, additional conditions are required. Building on this, a nonlinear complementary filter on $\mathbf{SO}(3)$ is designed to provide a smooth estimate of the orientation component of the state with almost global asymptotic stability. Finally, simulation results are provided to validate the proposed solution.

Tarek Bouazza, Pieter van Goor, Robert Mahony et al.

This paper addresses the problem of homography estimation using a nonlinear observer designed on the Lie group $\mathbf{SL}(3)$ that exploits the full image information through direct image registration. Unlike traditional feature-based methods, which rely on extensive feature extraction and matching, the proposed approach formulates an observer that minimises a cost function defined directly in terms of image pixel intensities. Explicit conditions ensuring the non-degeneracy of the cost function are derived, and a comprehensive analysis is conducted to characterise and generate degenerate (unobservable) image configurations. Theoretical results demonstrate local exponential convergence of the observer. To improve local convergence properties, a second-order observer variant is introduced by incorporating the Hessian of the cost function into the correction term. Simulation results demonstrate the performance of the proposed solutions on real images.

Alessandro Melis, Soulaimane Berkane, Tarek Hamel

Attitude estimation using scalar measurements, corresponding to partial vectorial observations, arises naturally when inertial vectors are not fully observed but only measured along specific body-frame vectors. Such measurements arise in problems involving incomplete vector measurements or attitude constraints derived from heterogeneous sensor information. Building on the classical complementary filter on SO(3), we propose an observer with a modified innovation term tailored to this scalar-output structure. The main result shows that almost-global asymptotic stability is recovered, under suitable persistence of excitation conditions, when at least three inertial vectors are measured along a common body-frame vector, which is consistent with the three-dimensional structure of SO(3). For two-scalar configurations - corresponding either to one inertial vector measured along two body-frame vectors, or to two inertial vectors measured along a common body-frame vector - we further derive sufficient conditions guaranteeing convergence within a reduced basin of attraction. Different examples and numerical results demonstrate the effectiveness of the proposed scalar-based complementary filter for attitude estimation in challenging scenarios involving reduced sensing and/or novel sensing modalities.

Tarek Bouazza, Tarek Hamel, Claude Samson

This paper presents a simple algebraic method to estimate the pose of a camera relative to a planar target from $n \geq 4$ reference points with known coordinates in the target frame and their corresponding bearing measurements in the camera frame. The proposed approach follows a hierarchical structure; first, the unit vector normal to the target plane is determined, followed by the camera's position vector, its distance to the target plane, and finally, the full orientation. To improve the method's robustness to measurement noise, an averaging methodology is introduced to refine the estimation of the target's normal direction. The accuracy and robustness of the approach are validated through extensive experiments.

Pieter van Goor, Robert Mahony, Tarek Hamel et al.

Visual Simultaneous Localisation and Mapping (VSLAM) is a key enabling technology for small embedded robotic systems such as aerial vehicles. Recent advances in equivariant filter and observer design offer the potential of a new generation of highly robust algorithms with low memory and computation requirements for embedded system applications. This paper studies observer design on the symmetry group proposed in previous work by the authors, in the case where inverse depth measurements are available. Exploiting this symmetry leads to a simple fully non-linear gradient based observer with almost global asymptotic and local exponential stability properties. Simulation experiments verify the observer design, and demonstrate that the proposed observer achieves similar accuracy to the widely used Extended Kalman Filter with significant gains in processing time (linear verses quadratic bounds with respect to number of landmarks) and qualitative improvements in robustness.

Pieter van Goor, Robert Mahony, Tarek Hamel et al.

This paper builds on recent work on Simultaneous Localisation and Mapping (SLAM) in the non-linear observer community, by framing the visual localisation and mapping problem as a continuous-time equivariant observer design problem on the symmetry group of a kinematic system. The state-space is a quotient of the robot pose expressed on SE(3) and multiple copies of real projective space, used to represent both points in space and bearings in a single unified framework. An observer with decoupled Riccati-gains for each landmark is derived and we show that its error system is almost globally asymptotically stable and exponentially stable in-the-large.

Minh-Duc Hua, Jochen Trumpf, Tarek Hamel et al.

This paper presents a new algorithm for online estimation of a sequence of homographies applicable to image sequences obtained from robotic vehicles equipped with vision sensors. The approach taken exploits the underlying Special Linear group structure of the set of homographies along with gyroscope measurements and direct point-feature correspondences between images to develop temporal filter for the homography estimate. Theoretical analysis and experimental results are provided to demonstrate the robustness of the proposed algorithm. The experimental results show excellent performance even in the case of very fast camera motion (relative to frame rate), severe occlusion, and in the presence of specular reflections.

Tarek Hamel, Claude Samson

This paper revisits the problems of estimating the position of an object moving in $n$ ($\geq 2$)-dimensional Euclidean space using velocity measurements and either direction or range measurements of one or multiple source points. The proposed solutions exploit the Continuous Riccati Equation (CRE) to calculate observer gains yielding global exponential stability of zero estimation errors, even in the case where the measured velocity is biased by an unknown constant perturbation. These results are obtained under persistent excitation (p.e.) conditions depending on the number of source points and body motion that ensure both uniform observability and good conditioning of the CRE solutions. With respect to prior contributions on these subjects some of the proposed solutions are entirely novel while others are adapted from existing ones with the preoccupation of stating simpler and more explicit conditions under which uniform exponential stability is achieved. A complementary contribution, related to the delicate tuning of the observers gains, is the derivation of a lower-bound of the exponential rate of convergence specified as a function of the amount of persistent excitation. Simulation results illustrate the performance of the proposed observers.

Florent Le Bras, Tarek Hamel, Robert Mahony et al.

This paper addresses the problem of estimating the position of an object moving in $R^n$ from direction and velocity measurements. After addressing observability issues associated with this problem, a nonlinear observer is designed so as to encompass the case where the measured velocity is corrupted by a constant bias. Global exponential convergence of the estimation error is proved under a condition of persistent excitation upon the direction measurements. Simulation results illustrate the performance of the observer.