Robust Global Position and Heading Tracking on SE ( 3 ) \mathrm{SE}(3) via Saturated Hybrid Feedback
Luís Martins, Carlos Cardeira, Paulo Oliveira · 2026
Read Robust Global Position and Heading Tracking on SE ( 3 ) \mathrm{SE}(3) via Saturated Hybrid Feedback by Luís Martins, Carlos Cardeira, Paulo Oliveira (2026) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2603-18069.txt.
Introduction
Martins, Cardeira, and Oliveira present a control law for global position and heading tracking on SE(3). It serves underactuated vehicles with single-axis thrust, full torque, and strict input limits. A saturated position controller with two filters yields bounded attitude references. The inner loop pairs a saturated Rodrigues-based law with a hybrid path-lifting step. Proofs give robust global tracking, and simulations confirm the design.
Catalog record
| CREATOR | Luís Martins, Carlos Cardeira, Paulo Oliveira |
|---|---|
| YEAR | 2026 |
| COLLECTION | PAPERS |
| FORMAT | TXT |
| FILE SIZE | 88664 |
| LICENSE | http://creativecommons.org/licenses/by/4.0/ |
| RIGHTS | CC BY |
| SOURCE | arXiv |
Source: https://arxiv.org/abs/2603.18069
Browse the full library · About the Tower of Babel
Full text
The opening of the work, from the library's hosted text:
Robust Global Position and Heading Tracking on SE ( 3 ) \mathrm{SE}(3) via Saturated Hybrid Feedback Luís Martins, Carlos Cardeira, Paulo Oliveira Abstract This letter presents a novel control solution to the robust global position and heading tracking problem for underactuated vehicles, equipped with single-axis thrust and full torque actuation, operating under strict, user-defined actuation limits. The architecture features a saturated position tracking controller augmented with two first-order filters. This formulation ensures the boundedness of the first and second derivatives, yielding less conservative bounds and systematically generating bounded attitude references whose limits are easily tuned via design parameters. To track these dynamic references, the inner loop comprises a saturated, modified Rodrigues parameter (MRP)-based controller paired with a hybrid dynamic path-lifting mechanism. This approach allows the attitude tracking law to be designed on a covering space of the configuration manifold. By leveraging a stability equivalence framework, the methodology establishes that the resulting interconnected system achieves robust global asymptotic and semi-global exponential tracking on SE ( 3 ) \mathrm{SE}(3) , while complying with user-defined input saturation bounds. Numerical simulations validate the proposed solution. I Introduction I-A Motivation and Literature Review Trajectory tracking for autonomous systems is a fundamental challenge in aerial, marine, and space domains. This problem is exceptionally demanding for underactuated vehicles, where the degrees of freedom outnumber the available control inputs [ 1 ] . Compounding this structural deficit, actuator saturation emerges as an inescapable physical nonlinearity that easily degrades performance or induces instability if ignored. Addressing the intersection of underactuation and strict input limits is therefore critical, driving the ongoing demand for robust, globally stable tracking architectures. The topology of the rigid-body motion configuration space, the special Euclidean group \mathrm{SE}(3) , fundamentally constrains the trajectory tracking problem. Inheriting the non-contractibility of the rotation group \mathrm{SO}(3) , \mathrm{SE}(3) is not homeomorphic to any Euclidean space [ 2 ] , precluding global stabilization via continuous feedback. Furthermore, discontinuous controllers fail to provide robust global stability, as arbitrarily small disturbances can trap the closed-loop solutions in undesired regions of the state space [ 3 ] . These fundamental obstructions motivate the adoption of hybrid control schemes [ 4 , 5 , 6 , 7 , 8 , 9 ] over traditional continuous [ 10 ] or discontinuous [ 1 ] approaches for tracking on \mathrm{SE}(3) . While existing hybrid architectures [ 4 , 5 , 6 , 7 , 8 ] achieve global asymptotic tracking for underactuated vehicles, these methodologies predominantly restrict saturation handling to the thrust input. Standard hierarchical structures encounter a fundamental singularity when the commanded thrust vanishes, losing control authority and precluding a well-defined attitude reference. Driven to avoid this singularity, the literature overwhelmingly prioritizes thrust constraints, frequently overlooking torque saturation and thus leaving a critical gap. To bridge this gap, the approach in [ 9 ] introduces a saturated hybrid control solution for quadrotors that enforces strict, a priori bounds on both inputs. Relying on nested saturation functions to generate bounded attitude references alongside a saturated MRP-based inner loop, the architecture guarantees global asymptotic tracking. I-B Contributions Motivated by this critical gap, this work proposes a novel control strategy for robust global position and heading tracking of underactuated vehicles driven by single-axis thrust and full torque inputs, subject to strict, user-defined bounds. The solution comprises a sufficiently smooth saturated outer-loop controller that globally asymptotically and semi-globally exponential stabilizes the position tracking dynamics. By replacing the nested saturation function approach of [ 9 ] with first-order filters augmentation, the proposed architecture yields significantly simpler expressions for the position control law derivatives. The design relies on a forward-projected coordinate transformation that geometrically decouples the filter dynamics, enabling the controller to be designed under the assumption of ideal, infinite-bandwidth. This augmentation ensures analytically tractable bounds that are easily adjustable via design parameters, directly facilitating the a priori verification of trajectory feasibility. Furthermore, adopting the attitude reference from [ 7 ] ensures unrestricted heading tracking, overcoming the inherent geometric coupling in [ 9 ] that restricted exact yaw tracking to zero roll and pitch conditions. These commands are tracked by a saturated inner loop developed in the MRP space, whose stability guarantees rigorously translate to the rotation group via a hybrid dynamic path-lifting algorithm and a stability equivalence framework. The strategy in [ 9 ] relies on small-gain arguments to establish the stability of the interconnected system, an approach that inherently complicates the attainment of an exponentially stable result. By replacing this methodology with exponentially decaying Lyapunov functions, this work establishes robust global asymptotic and semi-global exponential tracking under strict actuation limits. Furthermore, the resulting control scheme is nominally robust against perturbations, including external disturbances, parametric uncertainties, and measurement noise. To the best of the authors’ knowledge, this work introduces the first robust, semi-globally exponentially stable tracking solution for underactuated thrust-propelled vehicles subject to simultaneous thrust and torque saturation. I-C Organization The remainder of this letter is organized as follows. Section II establishes the notation and mathematical preliminaries. Section III defines the trajectory feasibility conditions under actuation bounds and formalizes the control problem. Section IV synthesizes the saturated position controller with bounded derivatives. Section V formulates the saturated hybrid attitude tracking scheme and proves robust global asymptotic and semi-global exponential tracking on \mathrm{SE}(3) for the resulting interconnected system by leveraging stability equivalence theorems. Section VI validates the architecture through simulations, and Section VII provides concluding remarks. II Notation and Preliminaries Standard notation is adopted throughout. Let K\mathbb{B}^{n}\subset\mathbb{R}^{n} denote the closed origin-centered ball of radius K>0 , and K\mathbb{B}_{\infty}^{n}\triangleq\{\mathbf{x}\in\mathbb{R}^{n}\colon\|\mathbf{x}\|_{\infty}\leq K\} the corresponding closed ball under the infinity norm. The set of n\times n positive definite matrices is denoted by \mathbb{R}^{n\times n}_{\succ 0} . The n -dimensional unit sphere is \mathbb{S}^{n}=\{\mathbf{x}\in\mathbb{R}^{n+1}\colon\mathbf{x}^{\!\top}\mathbf{x}=1\} , and \bar{\mathbb{R}}^{n}=\mathbb{R}^{n}\cup\{\boldsymbol{\infty}\} represents the Alexandroff compactification of \mathbb{R}^{n} [ 11 , p. 246] . Furthermore, \mathbf{I}_{n} is the n\times n identity matrix and \mathbf{e_{i}} the i^{\text{th}} standard basis vector. The skew-symmetric map [\cdot]_{\times}\colon\mathbb{R}^{3}\to\{\mathbf{S}\in\mathbb{R}^{3\times 3}\colon\mathbf{S}^{\top}=-\mathbf{S}\} satisfies [\boldsymbol{\omega}]_{\times}\mathbf{s}=\boldsymbol{\omega}\times\mathbf{s} [ 12 ] . For \mathbf{s}\in\mathbb{R}^{n} , \|\mathbf{s}\| is the Euclidean norm, \|\mathbf{s}\|_{\mathcal{L}_{2}}\coloneqq\left(\int_{0}^{\infty}\|\mathbf{s}(t)\|^{2}\mathrm{d}t\right)^{1/2}<\infty the \mathcal{L}_{2} -norm, and \diag(\mathbf{s})\triangleq\sum_{i=1}^{n}(\mathbf{e_{i}}\mathbf{e_{i}^{\!\top}})(\mathbf{e_{i}^{\!\top}}\mathbf{s}) . For a symmetric matrix \mathbf{A} , \lambda_{\min}(\mathbf{A}) and \lambda_{\max}(\mathbf{A}) denote, respectively, its minimum and maximum eigenvalues. The saturation function here considered is aligned with the following definition: Definition 1 The function \sigma:\mathbb{R}\mapsto\mathbb{R} is smooth, odd, strictly increasing, and verifies: (1) \sigma\left(0\right)=0 ; (2) s\sigma\left(s\right)>0\;\;\forall\;\;s\neq 0 ; (3) \lim_{s\to\pm\infty}\sigma\left(s\right)=\pm M , with M>0 ; (4) 0<\dot{\sigma}(s)\leq 1 ; (5) \ddot{\sigma}(s_{i})<0\;\;\forall\;\;s_{i}>0 . \square Each matrix \mathbf{R} within the attitude configuration manifold \mathrm{SO}(3)\coloneqq\{\mathbf{R}\in\mathbb{R}^{3\times 3}:\mathbf{R}^{\!\top}\mathbf{R}=\mathbf{I_{3}},\det(\mathbf{R})=1\} describes a rigid-body rotation from a body-fixed to an inertial frame. The rigid-body pose evolves on the Special Euclidean group \mathrm{SE}(3)\coloneqq\mathbb{R}^{3}\times\mathrm{SO}(3) . The attitude can equivalently be parameterized by a unit quaternion \mathbf{q}\coloneqq(q_{0},\mathbf{q_{1}})\in\mathbb{S}^{3} , comprising a scalar part q_{0}\in\mathbb{R} and a vector part \mathbf{q_{1}}\in\mathbb{R}^{3} . The map \mathcal{R}:\mathbb{S}^{3}\to\mathrm{SO}(3) , defined as \mathcal{R}(\mathbf{q})=\mathbf{I_{3}}+2q_{0}[\mathbf{q_{1}}]_{\times}+2[\mathbf{q_{1}}]_{\times}^{2} [ 12 , Eq. 5] , yields the corresponding rotation matrix and satisfies \mathcal{R}(\mathbf{q})=\mathcal{R}(-\mathbf{q}) . Its double-valued inverse \mathcal{Q}:\mathrm{SO}(3)\rightrightarrows\mathbb{S}^{3} is characterized by \mathcal{Q}(\mathbf{R})=\{\mathbf{q}\in\mathbb{S}^{3}:\mathcal{R}(\mathbf{q})=\mathbf{R}\} . The MRP representation consist of two vectors, \boldsymbol{\vartheta},\boldsymbol{\vartheta}^{s}\in\bar{\mathbb{R}}^{3} , derived via the stereographic projection of the unit quaternion [ 13 ] : \boldsymbol{\vartheta}=\boldsymbol{\varphi}(\mathbf{q})=\left\{\!\!\begin{array}[]{cl}\frac{\mathbf{q_{1}}}{(1+q_{0})}&\!\!\;\textrm{for}\;\mathbf{q}\in\mathbb{S}^{3}\setminus\{\mathbf{s}\}\\ \boldsymbol{\infty}&\!\!\;\textrm{for}\;\mathbf{q}=\mathbf{s}\end{array}\right.\!\!\!,\quad\boldsymbol{\vartheta}^{s}=\boldsymbol{\varphi}(-\mathbf{q}),\vskip-4.26773pt where \mathbf{s}=(-1,0,0,0) . The map \boldsymbol{\Upsilon}:\mathbb{\bar{R}}^{3}\to\mathbb{\bar{R}}^{3} , given by \boldsymbol{\vartheta^{s}}=\boldsymbol{\Upsilon}\!\left(\boldsymbol{\vartheta}\right)=\left\{\begin{array}[]{cl}-\boldsymbol{\vartheta}\|\boldsymbol{\vartheta}\|^{-2}&\!\!,\;\textrm{for}\;\boldsymbol{\vartheta}\in\mathbb{R}^{3}\setminus\{\boldsymbol{0}\}\\ \boldsymbol{\infty}&\!\!,\;\textrm{for}\;\boldsymbol{\vartheta}\in\{\boldsymbol{0}\}\\ \boldsymbol{0}&\!\!,\;\textrm{for}\;\boldsymbol{\vartheta}\in\{\boldsymbol{\infty}\}\end{array}\right.,\vskip-4.26773pt enables obtaining the shadow MRP from the original MRP. Both MRP triplets