arXiv subjects

Tarek Hamel

Publications and source records attributed to Tarek Hamel.

At least 37 records · Page 2Linked to original sources

arXiv2025

A Geometric Approach For Pose and Velocity Estimation Using IMU and Inertial/Body-Frame Measurements

This paper addresses accurate pose estimation (position, velocity, and orientation) for a rigid body using a combination of generic inertial-frame and/or body-frame measurements along with an Inertial Measurement Unit (IMU). By embedding the original state space, $\so \times \R^3 \times \R^3$, within the higher-dimensional Lie group $\sefive$, we reformulate the vehicle dynamics and outputs within a structured, geometric framework. In particular, this embedding enables a decoupling of the resulting geometric error dynamics: the translational error dynamics follow a structure similar to the error dynamics of a continuous-time Kalman filter, which allows for a time-varying gain design using the Riccati equation. Under the condition of uniform observability, we establish that the proposed observer design on $\sefive$ guarantees almost global asymptotic stability. We validate the approach in simulations for two practical scenarios: stereo-aided inertial navigation systems (INS) and GPS-aided INS. The proposed method significantly simplifies the design of nonlinear geometric observers for INS, providing a generalized and robust approach to state estimation.

eess.SY↗

arXiv2025

Dissipative Avoidance Feedback for Reactive Navigation Under Second-Order Dynamics

This paper addresses the problem of autonomous robot navigation in unknown, obstacle-filled environments with second-order dynamics by proposing a Dissipative Avoidance Feedback (DAF). Compared to the Artificial Potential Field (APF), which primarily uses repulsive forces based on position, DAF employs a dissipative feedback mechanism that accounts for both position and velocity, contributing to smoother and more natural obstacle avoidance. The proposed continuously differentiable controller solves the motion-to-goal problem while guaranteeing collision-free navigation by using the robot's state and local obstacle distance information. We show that the controller guarantees safe navigation in generic $n$-dimensional environments and that all undesired $ω$-limit points are unstable under certain controlled curvature conditions. Designed for real-time implementation, DAF requires only locally measured data from limited-range sensors (e.g., LiDAR, depth cameras), making it particularly effective for robots navigating unknown workspaces. Simulations in 2D and 3D environments are conducted to validate the theoretical results and to showcase the effectiveness of our approach.

eess.SY↗

arXiv2024

Observer-Based Control of Second-Order Multi-vehicle Systems in Bearing-Persistently Exciting Formations

This paper proposes an observer-based formation tracking control approach for multi-vehicle systems with second-order motion dynamics, assuming that vehicles' relative or global position and velocity measurements are unavailable. It is assumed that all vehicles are equipped with sensors capable of sensing the bearings relative to neighboring vehicles and only one leader vehicle has access to its global position. Each vehicle estimates its absolute position and velocity using relative bearing measurements and the estimates of neighboring vehicles received over a communication network. A distributed observer-based controller is designed, relying only on bearing and acceleration measurements. This work further explores the concept of the \textit{Bearing Persistently Exciting} (BPE) formation by proposing new algorithms for bearing-based localization and state estimation of second-order systems in centralized and decentralized manners. It also examines conditions on the desired formation to guarantee the exponential stability of distributed observer-based formation tracking controllers. In support of our theoretical results, some simulation results are presented to illustrate the performance of the proposed observers as well as the observer-based tracking controllers.

eess.SY↗

arXiv2024

Exploiting polar symmetry in designing equivariant observers for vision-based motion estimation

Accurately estimating camera motion from image sequences poses a significant challenge in computer vision and robotics. Many computer vision methods first compute the essential matrix associated with a motion and then extract orientation and normalized translation as inputs to pose estimation, reconstructing the scene scale (that is unobservable in the epipolar construction) from separate information. In this paper, we design a continuous-time filter that exploits the same perspective by using the epipolar constraint to define pseudo-measurements. We propose a novel polar symmetry on the pose of the camera that makes these measurements equivariant. This allows us to apply recent results from equivariant systems theory to estimating pose. We provide a novel explicit persistence of excitation condition to characterize observability of the full pose, ensuring reconstruction of the scale parameter that is not directly observable in the epipolar construction.

eess.SY↗

arXiv2023

State Estimation for Linear Systems with Quadratic Outputs

This letter deals with the problem of state estimation for a class of systems involving linear dynamics with multiple quadratic output measurements. We propose a systematic approach to immerse the original system into a linear time-varying (LTV) system of a higher dimension. The methodology extends the original system by incorporating a minimum number of auxiliary states, ensuring that the resulting extended system exhibits both linear dynamics and linear output. Consequently, any Kalman-type observer can showcase global state estimation, provided the system is uniformly observable.

eess.SY↗

arXiv2023

Control of convertible UAV with vectorized thrust

This paper is an addition to an article previously published by three of the authors that addresses the control of convertible fixed-wing aircraft with vectorized thrust. The control solution here developed extends the one presented in the former paper by complementing it with a strategy for the hovering flight and a control policy to handle the transition phase between low and high airspeed. An estimator of the air velocity required in all flight phases is also proposed. Realistic simulation results on a tri-tilt rotor Unmanned Aerial Vehicle (UAV) illustrate and assess the methodology.

eess.SY↗

arXiv2023

Constructive barrier feedback for collision avoidance in leader-follower formation control

This paper proposes a novel constructive barrier feedback for reactive collision avoidance between two agents. It incorporates this feature in a formation tracking control strategy for a group of 2nd-order dynamic robots defined in three-dimensional space. Using only relative measurements between neighboring agents, we propose an elegant decentralized controller as the sum of a nominal tracking controller and the constructive barrier feedback for leader-follower formations under a directed single-spanning tree graph topology. The key ingredient is the use of divergent flow as a dissipative term, which slows down the relative velocity in the direction of the neighboring robots without compromising the nominal controller's performance. Compared to traditional barrier function-based optimization controllers, the proposed constructive barrier feedback avoids feasibility issues and results in more computationally efficient control algorithms with systematic equilibrium analysis.

eess.SY↗

arXiv2023

Nonlinear constructive observer design for direct homography estimation

Feature-based homography estimation approaches rely on extensive image processing for feature extraction and matching, and do not adequately account for the information provided by the image. Therefore, developing efficient direct techniques to extract the homography from images is essential. This paper presents a novel nonlinear direct homography observer that exploits the Lie group structure of $\mathbf{SL}(3)$ and its action on the space of image maps. Theoretical analysis demonstrates local asymptotic convergence of the observer. The observer design is also extended for partial measurements of velocity under the assumption that the unknown component is constant or slowly time-varying. Finally, simulation results demonstrate the performance of the proposed solutions on real images.

eess.SY↗

arXiv2023

Constructive Equivariant Observer Design for Inertial Navigation

Inertial Navigation Systems (INS) are algorithms that fuse inertial measurements of angular velocity and specific acceleration with supplementary sensors including GNSS and magnetometers to estimate the position, velocity and attitude, or extended pose, of a vehicle. The industry-standard extended Kalman filter (EKF) does not come with strong stability or robustness guarantees and can be subject to catastrophic failure. This paper exploits a Lie group symmetry of the INS dynamics to propose the first nonlinear observer for INS with error dynamics that are almost-globally asymptotically and locally exponentially stable, independently of the chosen gains. The observer is aided only by a GNSS measurement of position. As expected, the convergence guarantee depends on persistence of excitation of the vehicle's specific acceleration in the inertial frame. Simulation results demonstrate the observer's performance and its ability to converge from extreme errors in the initial state estimates.

eess.SY↗

arXiv2022

Exploiting Different Symmetries for Trajectory Tracking Control with Application to Quadrotors

High performance trajectory tracking control of quadrotor vehicles is an important challenge in aerial robotics. Symmetry is a fundamental property of physical systems and offers the potential to provide a tool to design high-performance control algorithms. We propose a design methodology that takes any given symmetry, linearises the associated error in a single set of coordinates, and uses LQR design to obtain a high performance control; an approach we term Equivariant Regulator design. We show that quadrotor vehicles admit several different symmetries: the direct product symmetry, the extended pose symmetry and the pose and velocity symmetry, and show that each symmetry can be used to define a global error. We compare the linearised systems via simulation and find that the extended pose and pose and velocity symmetries outperform the direct product symmetry in the presence of large disturbances. This suggests that choices of equivariant and group affine symmetries have improved linearisation error.

cs.RO↗

arXiv2022

Observer Design for Nonlinear Systems with Equivariance

Equivariance is a common and natural property of many nonlinear control systems, especially those associated with models of mechatronic and navigation systems. Such systems admit a symmetry, associated with the equivariance, that provides structure enabling the design of robust and high performance observers. A key insight is to pose the observer state to lie in the symmetry group rather than on the system state space. This allows one to define a globally defined intrinsic equivariant error but poses a challenge in defining internal dynamics for the observer. By choosing an equivariant lift of the system dynamics for the observer internal model we show that the error dynamics have a particularly nice form. Applying the methodology of Extended Kalman Filtering (EKF) to the equivariant error state yields the Equivariant Filter (EqF). The geometry of the state-space manifold appears naturally as a curvature modification to the classical EKF Riccati equation. The equivariant filter exploits the symmetry and respects the geometry of an equivariant system model and yields high performance robust filters for a wide range of mechatronic and navigation systems.

eess.SY↗

arXiv2021

Formation control of a leader-follower structure in three dimensional space using bearing measurements

This paper addresses the problem of bearing leader-follower formation control in three-dimensional space by exploring the persistence of excitation (PE) of the desired formation. Using only bearing and relative velocity measurements, distributed control laws are derived for a group of agents with double-integrator dynamics. The key contribution is that the exponential stabilization of the actual formation to the desired one in terms of both shape and scale is guaranteed as long as the PE conditions on the desired formation are satisfied. The approach generalizes stability results provided in prior work for leader-first follower (LFF) structures which are based on bearing rigidity and constraint consistency to ensure the exponential stabilization of the actual formation to a desired static geometric pattern up to a scale factor. Simulations results are provided to illustrate the performance of the proposed control method.

eess.SY↗

arXiv2021

Quadrotor going through a window and landing: An image-based visual servo control approach

This paper considers the problem of controlling a quadrotor to go through a window and land on a planar target, the landing pad, using an Image-Based Visual Servo (IBVS) controller that relies on sensing information from two on-board cameras and an IMU. The maneuver is divided into two stages: crossing the window and landing on the pad. For the first stage, a control law is proposed that guarantees that the vehicle will not collide with the wall containing the window and will go through the window with non-zero velocity along the direction orthogonal to the window, keeping at all times a safety distance with respect to the window edges. For the landing stage, the proposed control law ensures that the vehicle achieves a smooth touchdown, keeping at all time a positive height above the plane containing the landing pad. For control purposes, the centroid vectors provided by the combination of the spherical image measurements of a collection of landmarks (corners) for both the window and the landing pad are used as position measurement. The translational optical flow relative to the wall, window edges, and landing plane is used as velocity cue. To achieve the proposed objective, no direct measurements nor explicit estimate of position or velocity are required. Simulation and experimental results are provided to illustrate the performance of the presented controller.

eess.SY↗

arXiv2021

Relaxed bearing rigidity and bearing formation control under persistence of excitation

This paper addresses the problem of time-varying bearing formation control in $d$ $(d\ge 2)$-dimensional Euclidean space by exploring Persistence of Excitation (PE) of the desired bearing reference. A general concept of Bearing Persistently Exciting (BPE) formation defined in $d$-dimensional space is here fully developed. By providing a desired formation that is BPE, distributed control laws for multi-agent systems under both single- and double-integrator dynamics are proposed using bearing measurements (along with velocity measurements when the agents are described by double-integrator dynamics), which guarantee uniform exponential stabilization of the desired formation in terms of shape and scale. A key contribution of this work is to show that the classical bearing rigidity condition on the graph topology, required for achieving the stabilization of a formation up to a scaling factor, is relaxed and extended in a natural manner by exploring PE conditions imposed either on a specific set of desired bearing vectors or on the whole desired formation. Simulation results are provided to illustrate the performance of the proposed control method.

eess.SY↗

arXiv2021

Equivariant filter (EqF): A general filter design for systems on homogeneous spaces

The kinematics of many mechanical systems encountered in robotics and other fields, such as single-bearing attitude estimation and SLAM, are naturally posed on homogeneous spaces: That is, their state lies in a smooth manifold equipped with a transitive Lie-group symmetry. This paper shows that any system posed in a homogeneous space can be extended to a larger system that is equivariant under a symmetry action. The equivariant structure of the system is exploited to propose a novel new filter, the Equivariant Filter (EqF), based on linearisation of global error dynamics derived from the symmetry action. The EqF is applied to an example of estimating the positions of stationary landmarks relative to a moving monocular camera that is intractable for previously proposed symmetry based filter design methodologies.

eess.SY↗

arXiv2021

Equivariant Systems Theory and Observer Design for Second Order Kinematic Systems on Matrix Lie Groups

This paper presents the equivariant systems theory and observer design for second order kinematic systems on matrix Lie groups. The state of a second order kinematic system on a matrix Lie group is naturally posed on the tangent bundle of the group with the inputs lying in the tangent of the tangent bundle known as the double tangent bundle. We provide a simple parameterization of both the tangent bundle state space and the input space (the fiber space of the double tangent bundle) and then introduce a semi-direct product group and group actions onto both the state and input spaces. We show that with the proposed group actions the second order kinematics are equivariant. An equivariant lift of the kinematics onto the symmetry group is defined and used to design a nonlinear observer on the lifted state space using nonlinear constructive design techniques. A simple hovercraft simulation verifies the performance of our observer.

eess.SY↗

arXiv2021

Attitude Observation for Second Order Attitude Kinematics

This paper addresses the problem of estimating the attitude and angular velocity of a rigid object by exploiting its second order kinematic model. The approach is particularly useful in cases where angular velocity measurements are not available and the attitude and angular velocity of an object need to be estimated from accelerometers and magnetometers. We propose a novel sensor modality that uses multiple accelerometers to measure the angular acceleration of an object as well as using magnetometers to measure partial attitude. We extend the approach of equivariant observer design to second order attitude kinematics by demonstrating that the special Euclidean group acts as a symmetry group on the system considered. The observer design is based on the lifted kinematics and we prove almost global asymptotic stability and local uniform exponential stability of the estimation error. The performance of the observer is demonstrated in simulation.

eess.SY↗

arXiv2020

Correction to:"Position estimation from direction or range measurements"

This technical communiqué aims at correcting an erroneous statement (Lemma 2.4) in an earlier paper by the same authors concerning a sufficient condition of uniform observability for a Linear Time-Varying (LTV) system. In this earlier paper, the proofs of two other lemmas, about body-pose estimation from range measurements, relied on this erroneous statement. For the sake of conciseness, only a new proof of one of these lemmas is presented, the proof of the second lemma being a simpler version of it.

eess.SY↗