Showing 1–29 of 29 results for author: Tayebi, A

Nonlinear Observer Design for Landmark-Inertial Simultaneous Localization and Mapping

Authors: Mouaad Boughellaba, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: This paper addresses the problem of Simultaneous Localization and Mapping (SLAM) for rigid body systems in three-dimensional space. We introduce a new matrix Lie group SE_{3+n}(3), whose elements are composed of the pose, gravity, linear velocity and landmark positions, and propose an almost globally asymptotically stable nonlinear geometric observer that integrates Inertial Measurement Unit (IMU)… ▽ More This paper addresses the problem of Simultaneous Localization and Mapping (SLAM) for rigid body systems in three-dimensional space. We introduce a new matrix Lie group SE_{3+n}(3), whose elements are composed of the pose, gravity, linear velocity and landmark positions, and propose an almost globally asymptotically stable nonlinear geometric observer that integrates Inertial Measurement Unit (IMU) data with landmark measurements. The proposed observer estimates the pose and map up to a constant position and a constant rotation about the gravity direction. Numerical simulations are provided to validate the performance and effectiveness of the proposed observer, demonstrating its potential for robust SLAM applications. △ Less

Submitted 5 April, 2025; originally announced April 2025.

Attitude Synchronization for Multi-Agent Systems on SO(3) Using Vector Measurements

Authors: Mouaad Boughellaba, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: In this paper, we address the problem of leaderless attitude synchronization for a group of rigid body systems evolving on SO(3), relying on local measurements of some inertial (unit-length) vectors. The interaction graph among agents is assumed to be undirected, acyclic, and connected. We first present a distributed attitude synchronization scheme designed at the kinematic level of SO(3), followe… ▽ More In this paper, we address the problem of leaderless attitude synchronization for a group of rigid body systems evolving on SO(3), relying on local measurements of some inertial (unit-length) vectors. The interaction graph among agents is assumed to be undirected, acyclic, and connected. We first present a distributed attitude synchronization scheme designed at the kinematic level of SO(3), followed by an extended scheme designed at the dynamic level. Both schemes are supported by a rigorous stability analysis, which establishes their almost global asymptotic stability properties. Finally, numerical simulations demonstrate the effectiveness of both distributed attitude synchronization schemes. △ Less

Submitted 28 March, 2025; originally announced March 2025.

Extending First-order Motion Planners to Second-order Dynamics

Authors: Mayur Sawant, Abdelhamid Tayebi

Abstract: This paper extends first-order motion planners to robots governed by second-order dynamics. Two control schemes are proposed based on the knowledge of a scalar function whose negative gradient aligns with a given first-order motion planner. When such a function is known, the first-order motion planner is combined with a damping velocity vector with a dynamic gain to extend the safety and convergen… ▽ More This paper extends first-order motion planners to robots governed by second-order dynamics. Two control schemes are proposed based on the knowledge of a scalar function whose negative gradient aligns with a given first-order motion planner. When such a function is known, the first-order motion planner is combined with a damping velocity vector with a dynamic gain to extend the safety and convergence guarantees of the first-order motion planner to second-order systems. If no such function is available, we propose an alternative control scheme ensuring that the error between the robot's velocity and the first-order motion planner converges to zero. The theoretical developments are supported by simulation results demonstrating the effectiveness of the proposed approaches. △ Less

Submitted 21 March, 2025; originally announced March 2025.

Comments: 13 pages, 7 figures

Global Attitude Synchronization for Multi-agent Systems on SO(3)

Authors: Mouaad Boughellaba, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: In this paper, we address the problem of attitude synchronization for a group of rigid body systems evolving on SO(3). The interaction among these systems is modeled through an undirected, connected, and acyclic graph topology. First, we present an almost global continuous distributed attitude synchronization scheme with rigorously proven stability guarantees. Thereafter, we propose two global dis… ▽ More In this paper, we address the problem of attitude synchronization for a group of rigid body systems evolving on SO(3). The interaction among these systems is modeled through an undirected, connected, and acyclic graph topology. First, we present an almost global continuous distributed attitude synchronization scheme with rigorously proven stability guarantees. Thereafter, we propose two global distributed hybrid attitude synchronization schemes on SO(3). The first scheme is a hybrid control law that leverages angular velocities and relative orientations to achieve global alignment to a common orientation. The second scheme eliminates the dependence on angular velocities by introducing dynamic auxiliary variables, while ensuring global asymptotic attitude synchronization. This velocity-free control scheme relies exclusively on attitude information. Simulation results are provided to illustrate the effectiveness of the proposed distributed attitude synchronization schemes. △ Less

Submitted 19 January, 2025; originally announced January 2025.

Comments: arXiv admin note: text overlap with arXiv:2304.01928

Hybrid Feedback Control for Global Navigation with Locally Optimal Obstacle Avoidance in n-Dimensional Spaces

Authors: Ishak Cheniouni, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: We present a hybrid feedback control framework for autonomous robot navigation in n-dimensional Euclidean spaces cluttered with spherical obstacles. The proposed approach ensures safe navigation and global asymptotic stability (GAS) of the target location by dynamically switching between two operational modes: motion-to-destination and locally optimal obstacle-avoidance. It produces continuous vel… ▽ More We present a hybrid feedback control framework for autonomous robot navigation in n-dimensional Euclidean spaces cluttered with spherical obstacles. The proposed approach ensures safe navigation and global asymptotic stability (GAS) of the target location by dynamically switching between two operational modes: motion-to-destination and locally optimal obstacle-avoidance. It produces continuous velocity inputs, ensures collision-free trajectories and generates locally optimal obstacle avoidance maneuvers. Unlike existing methods, the proposed framework is compatible with range sensors, enabling navigation in both a priori known and unknown environments. Extensive simulations in 2D and 3D settings, complemented by experimental validation on a TurtleBot 4 platform, confirm the efficacy and robustness of the approach. Our results demonstrate shorter paths and smoother trajectories compared to state-of-the-art methods, while maintaining computational efficiency and real-world feasibility. △ Less

Submitted 13 April, 2025; v1 submitted 28 December, 2024; originally announced December 2024.

Pose, Velocity and Landmark Position Estimation Using IMU and Bearing Measurements

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: This paper investigates the estimation problem of the pose (orientation and position) and linear velocity of a rigid body, as well as the landmark positions, using an inertial measurement unit (IMU) and a monocular camera. First, we propose a globally exponentially stable (GES) linear time-varying (LTV) observer for the estimation of body-frame landmark positions and velocity, using IMU and monocu… ▽ More This paper investigates the estimation problem of the pose (orientation and position) and linear velocity of a rigid body, as well as the landmark positions, using an inertial measurement unit (IMU) and a monocular camera. First, we propose a globally exponentially stable (GES) linear time-varying (LTV) observer for the estimation of body-frame landmark positions and velocity, using IMU and monocular bearing measurements. Thereafter, using the gyro measurements, some landmarks known in the inertial frame and the estimates from the LTV observer, we propose a nonlinear pose observer on $\SO(3)\times \mathbb{R}^3$. The overall estimation system is shown to be almost globally asymptotically stable (AGAS) using the notion of almost global input-to-state stability (ISS). Interestingly, we show that with the knowledge (in the inertial frame) of a small number of landmarks, we can recover (under some conditions) the unknown positions (in the inertial frame) of a large number of landmarks. Numerical simulation results are presented to illustrate the performance of the proposed estimation scheme. △ Less

Submitted 25 July, 2024; originally announced July 2024.

Comments: 8 pages, 3 figures

N-dimensional Convex Obstacle Avoidance using Hybrid Feedback Control (Extended version)

Authors: Mayur Sawant, Ilia Polushin, Abdelhamid Tayebi

Abstract: This paper addresses the autonomous robot navigation problem in a priori unknown n-dimensional environments containing convex obstacles of arbitrary shapes and sizes. We propose a hybrid feedback control scheme that guarantees safe and global asymptotic convergence of the robot to a predefined target location. The proposed control strategy relies on a switching mechanism allowing the robot to oper… ▽ More This paper addresses the autonomous robot navigation problem in a priori unknown n-dimensional environments containing convex obstacles of arbitrary shapes and sizes. We propose a hybrid feedback control scheme that guarantees safe and global asymptotic convergence of the robot to a predefined target location. The proposed control strategy relies on a switching mechanism allowing the robot to operate either in the move-to-target mode or the obstacle-avoidance mode, based on its proximity to the obstacles and the availability of a clear straight path between the robot and the target. In the obstacle-avoidance mode, the robot is constrained to move within a two-dimensional plane that intersects the obstacle being avoided and the target, preventing it from retracing its path. The effectiveness of the proposed hybrid feedback controller is demonstrated through simulations in two-dimensional and three-dimensional environments. △ Less

Submitted 19 January, 2025; v1 submitted 17 March, 2024; originally announced March 2024.

Comments: 21 pages, 21 figures

Hybrid Feedback Control for Global and Optimal Safe Navigation

Authors: Ishak Cheniouni, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: We propose a hybrid feedback control strategy that safely steers a point-mass robot to a target location optimally from all initial conditions in the n-dimensional Euclidean space with a single spherical obstacle. The robot moves straight to the target when it has a clear line-of-sight to the target location. Otherwise, it engages in an optimal obstacle avoidance maneuver via the shortest path ins… ▽ More We propose a hybrid feedback control strategy that safely steers a point-mass robot to a target location optimally from all initial conditions in the n-dimensional Euclidean space with a single spherical obstacle. The robot moves straight to the target when it has a clear line-of-sight to the target location. Otherwise, it engages in an optimal obstacle avoidance maneuver via the shortest path inside the cone enclosing the obstacle and having the robot's position as a vertex. The switching strategy that avoids the undesired equilibria, leading to global asymptotic stability (GAS) of the target location, relies on using two appropriately designed virtual destinations, ensuring control continuity and shortest path generation. Simulation results illustrating the effectiveness of the proposed approach are presented. △ Less

Submitted 23 March, 2024; v1 submitted 26 February, 2024; originally announced February 2024.

State Feedback Control Design for Input-output Decoupling of Boolean Control Networks

Authors: Yiliang Li, Hongli Lyu, Jun-e Feng, Abdelhamid Tayebi

Abstract: A state feedback control strategy is proposed for input-output (IO) decoupling of a class of fully output controllable Boolean control networks (BCNs). Some necessary and sufficient conditions for BCN IO-decoupling are presented. As an instrumental tool in our design, we introduce a canonical form for IO-decoupled BCNs along with some conditions guaranteeing its existence. Finally, two numerical e… ▽ More A state feedback control strategy is proposed for input-output (IO) decoupling of a class of fully output controllable Boolean control networks (BCNs). Some necessary and sufficient conditions for BCN IO-decoupling are presented. As an instrumental tool in our design, we introduce a canonical form for IO-decoupled BCNs along with some conditions guaranteeing its existence. Finally, two numerical examples are provided to illustrate the effectiveness of the proposed approach. △ Less

Submitted 4 October, 2023; originally announced October 2023.

Safe and Quasi-Optimal Autonomous Navigation in Environments with Convex Obstacles

Authors: Ishak Cheniouni, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: We propose a continuous feedback control strategy that steers a point-mass vehicle safely to a destination, in a quasi-optimal manner, in sphere worlds. The main idea consists in avoiding each obstacle via the shortest path on the cone's surface enclosing the obstacle and moving straight toward the target when the vehicle has a clear line of sight to the target location. In particular, almost glob… ▽ More We propose a continuous feedback control strategy that steers a point-mass vehicle safely to a destination, in a quasi-optimal manner, in sphere worlds. The main idea consists in avoiding each obstacle via the shortest path on the cone's surface enclosing the obstacle and moving straight toward the target when the vehicle has a clear line of sight to the target location. In particular, almost global asymptotic stability of the target location is achieved in two-dimensional (2D) environments under a particular assumption on the obstacles configuration. We also propose a reactive (sensor-based) approach, suitable for real-time implementations in a priori unknown 2D environments with sufficiently curved convex obstacles, guaranteeing almost global asymptotic stability of the target location. Simulation results are presented to illustrate the effectiveness of the proposed approach. △ Less

Submitted 27 May, 2024; v1 submitted 25 August, 2023; originally announced August 2023.

Comments: arXiv admin note: substantial text overlap with arXiv:2302.12309

Hybrid Feedback for Affine Nonlinear Systems with Application to Global Obstacle Avoidance (Extended Version)

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: This paper explores the design of hybrid feedback for a class of affine nonlinear systems with topological constraints that prevent global asymptotic stability. A new hybrid control strategy is introduced, which differs conceptually from the commonly used synergistic hybrid approaches. The key idea involves the construction of a generalized synergistic Lyapunov function whose switching variable ca… ▽ More This paper explores the design of hybrid feedback for a class of affine nonlinear systems with topological constraints that prevent global asymptotic stability. A new hybrid control strategy is introduced, which differs conceptually from the commonly used synergistic hybrid approaches. The key idea involves the construction of a generalized synergistic Lyapunov function whose switching variable can either remain constant or dynamically change between jumps. Based on this new hybrid mechanism, a generalized synergistic hybrid feedback control scheme, endowed with global asymptotic stability guarantees, is proposed. This hybrid control scheme is then improved through a smoothing mechanism that eliminates discontinuities in the feedback term. Moreover, the smooth hybrid feedback is further extended to a larger class of systems through the integrator backstepping approach. The proposed hybrid feedback schemes are applied to solve the global obstacle avoidance problem using a new concept of synergistic navigation functions. Finally, numerical simulation results are presented to illustrate the performance of the proposed hybrid controllers. △ Less

Submitted 11 March, 2024; v1 submitted 6 May, 2023; originally announced May 2023.

Comments: 14 pages, 5 figures

Journal ref: IEEE Transactions on Automatic Control (2024) 1-8

Hybrid Feedback Control Design for Non-Convex Obstacle Avoidance

Authors: Mayur Sawant, Ilia Polushin, Abdelhamid Tayebi

Abstract: We develop an autonomous navigation algorithm for a robot operating in two-dimensional environments containing obstacles, with arbitrary non-convex shapes, which can be in close proximity with each other, as long as there exists at least one safe path connecting the initial and the target location. An instrumental transformation that modifies (virtually) the non-convex obstacles, in a non-conserva… ▽ More We develop an autonomous navigation algorithm for a robot operating in two-dimensional environments containing obstacles, with arbitrary non-convex shapes, which can be in close proximity with each other, as long as there exists at least one safe path connecting the initial and the target location. An instrumental transformation that modifies (virtually) the non-convex obstacles, in a non-conservative manner, is introduced to facilitate the design of the obstacle-avoidance strategy. The proposed navigation approach relies on a hybrid feedback that guarantees global asymptotic stabilization of a target location while ensuring the forward invariance of the modified obstacle-free workspace. The proposed hybrid feedback controller guarantees Zeno-free switching between the move-to-target mode and the obstacle-avoidance mode based on the proximity of the robot with respect to the modified obstacle-occupied workspace. Finally, we provide an algorithmic procedure for the sensor-based implementation of the proposed hybrid controller and validate its effectiveness via some numerical simulations. △ Less

Submitted 15 April, 2024; v1 submitted 20 April, 2023; originally announced April 2023.

Comments: 24 pages, 23 figures

Distributed Attitude Estimation for Multi-agent Systems on $SO(3)$

Authors: Mouaad Boughellaba, Abdelhamid Tayebi

Abstract: We consider the problem of distributed attitude estimation of multi-agent systems, evolving on $SO(3)$, relying on individual angular velocity and relative attitude measurements. The interaction graph topology is assumed to be an undirected tree. First, we propose a continuous nonlinear distributed attitude estimation scheme with almost global asymptotic stability guarantees. Thereafter, we procee… ▽ More We consider the problem of distributed attitude estimation of multi-agent systems, evolving on $SO(3)$, relying on individual angular velocity and relative attitude measurements. The interaction graph topology is assumed to be an undirected tree. First, we propose a continuous nonlinear distributed attitude estimation scheme with almost global asymptotic stability guarantees. Thereafter, we proceed with the \textit{hybridization} of the proposed estimation scheme to derive a new hybrid nonlinear distributed attitude estimation scheme enjoying global asymptotic stabilization of the attitude estimation errors to a common constant orientation. In addition, the proposed hybrid attitude estimation scheme is used to solve the problem of pose estimation of $N$-vehicles navigating in a three-dimensional space, with global asymptotic stability guarantees, where the only available measurements are the local relative bearings and the individual linear velocities. Simulation results are provided to illustrate the effectiveness of the proposed estimation schemes. △ Less

Submitted 16 May, 2024; v1 submitted 4 April, 2023; originally announced April 2023.

Bearing-based distributed pose estimation for multi-agent networks

Authors: Mouaad Boughellaba, Abdelhamid Tayebi

Abstract: In this paper, we address the distributed pose estimation problem for multi-agent systems, where the agents have unknown static positions and time-varying orientations. The interaction graph is assumed to be directed and acyclic with two leaders that have access to their position and orientation. We propose a nonlinear distributed pose estimation scheme relying on individual angular velocity measu… ▽ More In this paper, we address the distributed pose estimation problem for multi-agent systems, where the agents have unknown static positions and time-varying orientations. The interaction graph is assumed to be directed and acyclic with two leaders that have access to their position and orientation. We propose a nonlinear distributed pose estimation scheme relying on individual angular velocity measurements and local relative (time-varying) bearing measurements. The proposed estimation scheme consists of two cascaded distributed observers, an almost globally asymptotically stable (AGAS) attitude observer and an input-to-state stable (ISS) position observer, leading to an overall AGAS distributed localization scheme. Numerical simulation results are presented to illustrate the performance of our proposed distributed pose estimation scheme. △ Less

Submitted 4 April, 2023; originally announced April 2023.

Safe and Quasi-Optimal Autonomous Navigation in Sphere Worlds

Authors: Ishak Cheniouni, Abdelhamid Tayebi, Soulaimane Berkane

Abstract: We propose a continuous feedback control strategy that steers a point-mass vehicle safely to a desired destination, in a quasi-optimal manner, from almost all initial conditions in an n-dimensional Euclidean space cluttered with spherical obstacles. The main idea consists in avoiding each obstacle via the shortest path within the cone enclosing the obstacle, and moving straight towards the target… ▽ More We propose a continuous feedback control strategy that steers a point-mass vehicle safely to a desired destination, in a quasi-optimal manner, from almost all initial conditions in an n-dimensional Euclidean space cluttered with spherical obstacles. The main idea consists in avoiding each obstacle via the shortest path within the cone enclosing the obstacle, and moving straight towards the target when the vehicle has a clear line of sight to the target location. The proposed control strategy ensures safe navigation with almost global asymptotic stability of the equilibrium point at the target location. Simulation results, illustrating the effectiveness of the proposed approach, are presented. △ Less

Submitted 21 March, 2023; v1 submitted 23 February, 2023; originally announced February 2023.

Comments: Extended version of the paper from the American Control Conference ACC 2023

Modeling of Four-Winged Micro Ornithopters Inspired by Dragonflies

Authors: Oussama Sifour, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: In this paper, we present a full dynamical model of a four-winged micro ornithopter inspired by a dragonfly-type insect. The micro ornithopter is modeled as four articulated rigid body components (wings) connected to the main body via spherical joints. The dynamical model is derived using Lagrangian mechanics with intrinsic global coordinates, without relying on the common assumptions that neglect… ▽ More In this paper, we present a full dynamical model of a four-winged micro ornithopter inspired by a dragonfly-type insect. The micro ornithopter is modeled as four articulated rigid body components (wings) connected to the main body via spherical joints. The dynamical model is derived using Lagrangian mechanics with intrinsic global coordinates, without relying on the common assumptions that neglect the wings-body interactions. Furthermore, the aerodynamic forces are modeled under the quasi-steady motion assumption without restricting the flapping frequency to be relatively high. This provides a full and elegant four-winged micro ornithopter model that captures the interaction between the body and the wings while avoiding the complexities and singularities associated with other coordinate representations (e.g., Euler angles). Simulation studies of the inertial effects of the relative motion between the different parts of the multibody system show the importance of considering the forces and torques, resulting from the wings-body interaction, in motion generation of these insects. △ Less

Submitted 5 April, 2023; v1 submitted 9 January, 2023; originally announced January 2023.

Nonlinear Attitude Estimation Using Intermittent and Multi-Rate Vector Measurements

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: This paper considers the problem of nonlinear attitude estimation for a rigid body system using intermittent and multi-rate inertial vector measurements as well as continuous (high-rate) angular velocity measurements. Two types of hybrid attitude observers on Lie group $SO(3)$ are proposed. First, we propose a hybrid attitude observer where almost global asymptotic stability is guaranteed using th… ▽ More This paper considers the problem of nonlinear attitude estimation for a rigid body system using intermittent and multi-rate inertial vector measurements as well as continuous (high-rate) angular velocity measurements. Two types of hybrid attitude observers on Lie group $SO(3)$ are proposed. First, we propose a hybrid attitude observer where almost global asymptotic stability is guaranteed using the notion of almost global input-to-state stability on manifolds. Thereafter, this hybrid attitude observer is extended by introducing a switching mechanism to achieve global asymptotic stability. Both simulation and experimental results are presented to illustrate the performance of the proposed hybrid observers. △ Less

Submitted 20 December, 2023; v1 submitted 20 October, 2022; originally announced October 2022.

Comments: 14 pages, 7 figures, this work has been accepted for publication in IEEE TAC

Hybrid Feedback for Autonomous Navigation in Environments with Arbitrary Convex Obstacles

Authors: Mayur Sawant, Soulaimane Berkane, Ilia Polusin, Abdelhamid Tayebi

Abstract: We develop an autonomous navigation algorithm for a robot operating in two-dimensional environments cluttered with obstacles having arbitrary convex shapes. The proposed navigation approach relies on a hybrid feedback to guarantee global asymptotic stabilization of the robot towards a predefined target location while ensuring the forward invariance of the obstacle-free workspace. The main idea con… ▽ More We develop an autonomous navigation algorithm for a robot operating in two-dimensional environments cluttered with obstacles having arbitrary convex shapes. The proposed navigation approach relies on a hybrid feedback to guarantee global asymptotic stabilization of the robot towards a predefined target location while ensuring the forward invariance of the obstacle-free workspace. The main idea consists in designing an appropriate switching strategy between the move-to-target mode and the obstacle-avoidance mode based on the proximity of the robot with respect to the nearest obstacle. The proposed hybrid controller generates continuous velocity input trajectories when the robot is initialized away from the boundaries of the unsafe regions. Finally, we provide an algorithmic procedure for the sensor-based implementation of the proposed hybrid controller and validate its effectiveness through some simulation results. △ Less

Submitted 3 August, 2022; v1 submitted 17 November, 2021; originally announced November 2021.

Comments: 20 pages, 14 figures

Nonlinear Attitude Estimation Using Intermittent Linear Velocity and Vector Measurements

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: This paper investigates the problem of continuous attitude estimation on $SO(3)$ using continuous angular velocity and linear acceleration measurements as well as intermittent linear velocity and inertial vector measurements. First, we propose a nonlinear observer for the case where all the measurements are continuous and almost global asymptotic stability (AGAS) is shown using the notion of almos… ▽ More This paper investigates the problem of continuous attitude estimation on $SO(3)$ using continuous angular velocity and linear acceleration measurements as well as intermittent linear velocity and inertial vector measurements. First, we propose a nonlinear observer for the case where all the measurements are continuous and almost global asymptotic stability (AGAS) is shown using the notion of almost global input-to-state stability (ISS) on manifolds. Thereafter, a hybrid attitude observer, with AGAS guarantees, is proposed in terms of intermittent linear velocity and vector measurements. Numerical simulation results are presented to illustrate the performance of the proposed hybrid observer. △ Less

Submitted 22 September, 2021; originally announced September 2021.

Comments: Accepted to the IEEE 60th Conference on Decision and Control (CDC 2021), 8 pages, 3 figures

Nonlinear Estimation for Position-Aided Inertial Navigation Systems

Authors: Soulaimane Berkane, Abdelhamid Tayebi

Abstract: In this work we solve the position-aided 3D navigation problem using a nonlinear estimation scheme. More precisely, we propose a nonlinear observer to estimate the full state of the vehicle (position, velocity, orientation and gyro bias) from IMU and position measurements. The proposed observer does not introduce additional auxiliary states and is shown to guarantee semi-global exponential stabili… ▽ More In this work we solve the position-aided 3D navigation problem using a nonlinear estimation scheme. More precisely, we propose a nonlinear observer to estimate the full state of the vehicle (position, velocity, orientation and gyro bias) from IMU and position measurements. The proposed observer does not introduce additional auxiliary states and is shown to guarantee semi-global exponential stability without any assumption on the acceleration of the vehicle. The performance of the observer is shown, through simulation, to overcome the state-of-the-art approach that assumes negligible accelerations. △ Less

Submitted 25 March, 2021; originally announced March 2021.

Comments: arXiv admin note: text overlap with arXiv:2006.14056

Nonlinear Observers Design for Vision-Aided Inertial Navigation Systems

Authors: Miaomiao Wang, Soulaimane Berkane, Abdelhamid Tayebi

Abstract: This paper deals with the simultaneous estimation of the attitude, position and linear velocity for vision-aided inertial navigation systems. We propose a nonlinear observer on $SO(3)\times \mathbb{R}^{15}$ relying on body-frame acceleration, angular velocity and (stereo or monocular) bearing measurements of some landmarks that are constant and known in the inertial frame. Unlike the existing loca… ▽ More This paper deals with the simultaneous estimation of the attitude, position and linear velocity for vision-aided inertial navigation systems. We propose a nonlinear observer on $SO(3)\times \mathbb{R}^{15}$ relying on body-frame acceleration, angular velocity and (stereo or monocular) bearing measurements of some landmarks that are constant and known in the inertial frame. Unlike the existing local Kalman-type observers, our proposed nonlinear observer guarantees almost global asymptotic stability and local exponential stability. A detailed uniform observability analysis has been conducted and sufficient conditions are derived. Moreover, a hybrid version of the proposed observer is provided to handle the intermittent nature of the measurements in practical applications. Simulation and experimental results are provided to illustrate the effectiveness of the proposed state observer. △ Less

Submitted 1 June, 2021; v1 submitted 9 February, 2021; originally announced February 2021.

Comments: Accepted for publication in IEEE Transaction on Automatic Control. 16 pages, 6 figures

Hybrid Feedback for Global Tracking on Matrix Lie Groups $SO(3)$ and $SE(3)$

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: We introduce a new hybrid control strategy, which is conceptually different from the commonly used synergistic hybrid approaches, to efficiently deal with the problem of the undesired equilibria that precludes smooth vectors fields on $SO(3)$ from achieving global stability. The key idea consists in constructing a suitable potential function on $SO(3)\times \mathbb{R}$ involving an auxiliary scala… ▽ More We introduce a new hybrid control strategy, which is conceptually different from the commonly used synergistic hybrid approaches, to efficiently deal with the problem of the undesired equilibria that precludes smooth vectors fields on $SO(3)$ from achieving global stability. The key idea consists in constructing a suitable potential function on $SO(3)\times \mathbb{R}$ involving an auxiliary scalar variable, with flow and jump dynamics, which keeps the state away from the undesired critical points while, at the same time, guarantees a decrease of the potential function over the flows and jumps. Based on this new hybrid mechanism, a hybrid feedback control scheme for the attitude tracking problem on $SO(3)$, endowed with global asymptotic stability and semi-global exponential stability guarantees, is proposed. This control scheme is further improved through a smoothing mechanism that removes the discontinuities in the input torque. The third hybrid control scheme, proposed in this paper, removes the requirement of the angular velocity measurements, while preserving the strong stability guarantees of the first hybrid control scheme. This approach has also been applied to the tracking problem on $SE(3)$ to illustrate its advantages with respect to the existing synergistic hybrid approaches. Finally, some simulation results are presented to illustrate the performance of the proposed hybrid controllers. △ Less

Submitted 31 July, 2021; v1 submitted 22 December, 2020; originally announced December 2020.

Comments: Accepted for publication in IEEE Transaction on Automatic Control. 16 pages, 5 figures

Observers Design for Inertial Navigation Systems: A Brief Tutorial

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: The design of navigation observers able to simultaneously estimate the position, linear velocity and orientation of a vehicle in a three-dimensional space is crucial in many robotics and aerospace applications. This problem was mainly dealt with using the extended Kalman filter and its variants which proved to be instrumental in many practical applications. Although practically efficient, the lack… ▽ More The design of navigation observers able to simultaneously estimate the position, linear velocity and orientation of a vehicle in a three-dimensional space is crucial in many robotics and aerospace applications. This problem was mainly dealt with using the extended Kalman filter and its variants which proved to be instrumental in many practical applications. Although practically efficient, the lack of strong stability guarantees of these algorithms motivated the emergence of a new class of geometric navigation observers relying on Riemannian geometry tools, leading to provable strong stability properties. The objective of this brief tutorial is to provide an overview of the existing estimation schemes, as well as some recently developed geometric nonlinear observers, for autonomous navigation systems relying on inertial measurement unit (IMU) and landmark measurements. △ Less

Submitted 17 September, 2020; originally announced September 2020.

Comments: 8 pages, accepted by the IEEE 59th Conference on Decision and Control (CDC 2020)

A Nonlinear Navigation Observer Using IMU and Generic Position Information

Authors: Soulaimane Berkane, Abdelhamid Tayebi, Simone de Marco

Abstract: This paper deals with the problem of full state estimation for vehicles navigating in a three dimensional space. We assume that the vehicle is equipped with an Inertial Measurement Unit (IMU) providing body-frame measurements of the angular velocity, the specific force, and the Earth's magnetic field. Moreover, we consider available sensors that provide partial or full information about the positi… ▽ More This paper deals with the problem of full state estimation for vehicles navigating in a three dimensional space. We assume that the vehicle is equipped with an Inertial Measurement Unit (IMU) providing body-frame measurements of the angular velocity, the specific force, and the Earth's magnetic field. Moreover, we consider available sensors that provide partial or full information about the position of the vehicle. Examples of such sensors are those which provide full position measurements (e.g., GPS), range measurements (e.g., Ultra-Wide Band (UWB) sensors), inertial-frame bearing measurements (e.g., motion capture cameras), or altitude measurements (altimeter). We propose a generic semi-globally exponentially stable nonlinear observer that estimates the position, linear velocity, linear acceleration, and attitude of the vehicle, as well as the gyro bias. We also provide a detailed observability analysis for different types of measurements. Simulation and experimental results are provided to demonstrate the effectiveness of the proposed estimation scheme. △ Less

Submitted 28 January, 2021; v1 submitted 24 June, 2020; originally announced June 2020.

Comments: Accepted in Automatica

Nonlinear State Estimation for Inertial Navigation Systems With Intermittent Measurements

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: This paper considers the problem of simultaneous estimation of the attitude, position and linear velocity for vehicles navigating in a three-dimensional space. We propose two types of hybrid nonlinear observers using continuous angular velocity and linear acceleration measurements as well as intermittent landmark position measurements. The first type relies on a fixed-gain design approach based on… ▽ More This paper considers the problem of simultaneous estimation of the attitude, position and linear velocity for vehicles navigating in a three-dimensional space. We propose two types of hybrid nonlinear observers using continuous angular velocity and linear acceleration measurements as well as intermittent landmark position measurements. The first type relies on a fixed-gain design approach based on an infinite-dimensional optimization, while the second one relies on a variable-gain design approach based on a continuous-discrete Riccati equation. For each case, we provide two different observers with and without the estimation of the gravity vector. The proposed observers are shown to be exponentially stable with a large domain of attraction. Simulation and experimental results are presented to illustrate the performance of the proposed observers. △ Less

Submitted 20 July, 2020; v1 submitted 7 May, 2020; originally announced May 2020.

Comments: 15 pages, 4 figures, accepted by Automatica

Hybrid Nonlinear Observers for Inertial Navigation Using Landmark Measurements

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: This paper considers the problem of attitude, position and linear velocity estimation for rigid body systems relying on landmark measurements. We propose two hybrid nonlinear observers on the matrix Lie group $SE_2(3)$, leading to global exponential stability. The first observer relies on fixed gains, while the second one uses variable gains depending on the solution of a continuous Riccati equati… ▽ More This paper considers the problem of attitude, position and linear velocity estimation for rigid body systems relying on landmark measurements. We propose two hybrid nonlinear observers on the matrix Lie group $SE_2(3)$, leading to global exponential stability. The first observer relies on fixed gains, while the second one uses variable gains depending on the solution of a continuous Riccati equation (CRE). These observers are then extended to handle biased angular velocity measurements. Both simulation and experimental results are presented to illustrate the performance of the proposed observers. △ Less

Submitted 14 May, 2020; v1 submitted 11 June, 2019; originally announced June 2019.

Comments: 16 pages, 4 figures

On the Design of Hybrid Pose and Velocity-bias Observers on Lie Group SE(3)

Authors: Miaomiao Wang, Abdelhamid Tayebi

Abstract: This paper deals with the design of globally exponentially stable invariant observers on the Special Euclidian group SE(3). First, we propose a generic hybrid observer scheme (depending on a generic potential function) evolving on $SE(3)\times \mathbb{R}^6$ for pose (orientation and position) and velocity-bias estimation. Thereafter, the proposed observer is formulated explicitly in terms of inert… ▽ More This paper deals with the design of globally exponentially stable invariant observers on the Special Euclidian group SE(3). First, we propose a generic hybrid observer scheme (depending on a generic potential function) evolving on $SE(3)\times \mathbb{R}^6$ for pose (orientation and position) and velocity-bias estimation. Thereafter, the proposed observer is formulated explicitly in terms of inertial vectors and landmark measurements. Interestingly, the proposed observer leads to a decoupled rotational error dynamics from the translational dynamics, which is an interesting feature in practical applications with noisy measurements and disturbances. △ Less

Submitted 13 November, 2018; v1 submitted 2 May, 2018; originally announced May 2018.

Comments: 29 pages, 3 figures

Cooperative Output Regulation of Linear Multi-agent Systems with Communication Constraints

Authors: Abdelkader Abdessameud, Abdelhamid Tayebi

Abstract: In this paper, we consider the cooperative output regulation problem for heterogeneous linear multi-agent systems in the presence of communication constraints. Under standard assumptions on the agents dynamics, we propose a distributed control algorithm relying on intermittent and asynchronous discrete-time information exchange that can be subject to unknown time-varying delays and information los… ▽ More In this paper, we consider the cooperative output regulation problem for heterogeneous linear multi-agent systems in the presence of communication constraints. Under standard assumptions on the agents dynamics, we propose a distributed control algorithm relying on intermittent and asynchronous discrete-time information exchange that can be subject to unknown time-varying delays and information losses. We show that cooperative output regulation can be reached for arbitrary characteristics of the discrete-time communication process and under mild assumptions on the interconnection topology between agents. A numerical example is given to illustrate the effectiveness of our theoretical results. △ Less

Submitted 5 October, 2016; originally announced October 2016.

Comments: 13 pages, submitted for publication

A New Position Control Strategy for VTOL UAVs using IMU and GPS measurements

Authors: Andrew Roberts, Abdelhamid Tayebi

Abstract: We propose a new position control strategy for VTOL-UAVs using IMU and GPS measurements. Since there is no sensor that measures the attitude, our approach does not rely on the knowledge (or reconstruction) of the system orientation as usually done in the existing literature. Instead, IMU and GPS measurements are directly incorporated in the control law. An important feature of the proposed strateg… ▽ More We propose a new position control strategy for VTOL-UAVs using IMU and GPS measurements. Since there is no sensor that measures the attitude, our approach does not rely on the knowledge (or reconstruction) of the system orientation as usually done in the existing literature. Instead, IMU and GPS measurements are directly incorporated in the control law. An important feature of the proposed strategy, is that the accelerometer is used to measure the apparent acceleration of the vehicle, as opposed to only measuring the gravity vector, which would otherwise lead to unexpected performance when the vehicle is accelerating (i.e. not in a hover configuration). Simulation results are provided to demonstrate the performance of the proposed position control strategy in the presence of noise and disturbances. △ Less

Submitted 20 March, 2012; v1 submitted 31 May, 2011; originally announced June 2011.

Comments: Submitted to Automatica