CS Paper Radar

Certified Zonotopic Reachability Analysis for Trajectory Tracking on Lie Groups

Yanliang Huang, Peng Xie, Zhen Zhang, Zhuoqi Zeng, Amr Alanwar

eess.SY cs.RO ·submitted 2026-11-09 17:40 UTC · v1

Abstract

Autonomous vehicles track planned trajectories close to obstacles. Unknown disturbances make them deviate from these trajectories. With a bound on the tracking error that disturbances can cause, a planned trajectory can be certified as safe before execution. Existing set-based methods bound the tracking error by one invariant ellipsoid for the whole trajectory or by intervals, which are both conservative. For aerial and space vehicles, the tracking error evolves on a matrix Lie group with nonlinear dynamics. However, for group-affine systems, the error dynamics are linear in Lie algebra coordinates when the vehicle receives the inputs of the reference. The control input and the disturbance enter through the inverse right Jacobian, a matrix that depends on the error. We propagate the linear part of the error dynamics with zonotopes and enclose the effect of the inverse right Jacobian on the disturbance in closed form. The resulting tubes are tight and provably contain all reachable tracking errors in continuous time. When some error components have no input, the inverse right Jacobian leaves unmatched nonlinear terms in the closed loop. None of the tested methods certifies such a closed loop. Hybrid coordinates make these terms matched, so that our controller cancels every nonlinear term that does not contain the disturbance. Our tubes give tighter bounds than the ellipsoid method in simulations of a planar aircraft and a fully actuated multirotor and in real flights of a quadrotor, where the tube contains every measured attitude error. Under larger disturbances and the same feedback gain, the ellipsoid method yields no valid ellipsoid, whereas our tubes remain valid.

Closest papers

Nearest neighbours by meaning across the whole index.

Learning Regions of Attraction for Transverse Feedback Linearization under Controller Singularities

cs.AI eess.SY ·2026-11-17 ·Abdullah Waqar Malik, Hamza Tariq, Adeel Akhtar
code/data similarity 0.58
Abstract · 27 pages (10 main + references + appendix), 1 figure, 8 tables

Transverse feedback linearization (TFL) achieves path following by exactly linearizing the error dynamics, but its controller is undefined on a singular set, such as zero speed for a unicycle or zero thrust for a quadrotor. The constrained region of attraction, the set of initial states from which the closed loop converges to the path without violating state or regularity constraints, determines where the controller can be safely activated. Exploiting the exact linear error dynamics, we show that this region is the largest forward invariant subset of the admissible set. We then decompose its state-constrained Zubov value function into an analytically known quadratic cost-to-go and a safety value function. We learn only the latter, by fitted value iteration without infinite-horizon trajectory labels. The resulting estimate combines an inner layer verified by interval branch and bound with a learned outer layer tested on samples. On a unicycle following a circle and a sinusoid and on a planar quadrotor, it covers on average 72.0%, 83.4% and 19.1% of the simulated region of attraction. In comparison, the quadratic cost-to-go and two physics-informed neural network (PINN) solvers of Zubov's equation cover at most 11.3%, 4.0% and 0.0% on average. Code and animations are available at https://gradslab.github.io/roa_tfl

0.47

Global Exponential Stabilization of a 3D Nonholonomic Vehicle in Spherical Coordinates

eess.SY math.OC ·2026-09-21 ·Kwang Hak Kim, Velimir Todorovski, Miroslav Krstic
published similarity 0.57
Abstract · Accepted to the 2026 IEEE Conference on Decision and Control (CDC)

Many spatial (3D) vehicles, including AUVs and fixed-wing aircraft, are effectively nonholonomic and subject to limited actuation, such that continuous time-invariant stabilization is fundamentally obstructed by Brockett's necessary condition. To overcome this obstruction, we exploit the geometric singularity of spherical coordinates to design a backstepping continuous, time-invariant feedback law that exponentially stabilizes a 3D nonholonomic vehicle actuated solely by forward surge velocity, pitch rate, and yaw rate. The resulting closed-loop region of attraction excludes only the coordinate singularity, codimension-two, measure-zero set of initial conditions in which the vehicle lies on the line through the target orthogonal to the target plane, thereby covering the largest possible domain. We further construct a strict control Lyapunov function to prove global exponential stability of the origin on this domain with a user-specified decay rate, while simultaneously preventing the system from approaching the singular set. Finally, we show that the closed-loop system is exponentially attractive to the origin in Cartesian coordinates. Numerical simulation examples in both spherical and Cartesian coordinates illustrate the effectiveness of the control law.

0.51

Reach-Stabilize Control of Control-Affine Systems with Unknown Affine Parameters

eess.SY math.OC ·2026-10-08 ·Alexander Dorsey, Kunal Garg, Ankit Goel
similarity 0.56
Abstract

This paper considers the reach-stabilize prob- lem for a class of nonlinear control-affine systems with unknown parametric uncertainties, where the system states must remain in a safe set at all times, or enter a safe set in finite time and then remain in it, and converge to a goal point. An estimator is designed that generates a parameter estimate and a computable, nonincreasing bound on the estimation error from a known initial error bound, without requiring persistence of excitation. The bound defines margins that are added to a control barrier and a control Lyapunov function condition, which are then enforced in a quadratic program for efficient control design. It is shown that, for the closed-loop system, the safe set is forward invariant when the system starts within the safe set and is finite-time reachable from outside the safe set with a recovery-time bound that does not depend on the unknown parameter, and that the goal point is exponentially stable. In two numerical examples, with the initial state outside and inside the safe set, the proposed control policy, a baseline oracle control policy that uses the true parameter, both recover or remain in the safe set and converge to the goal point, while another baseline control policy that uses a fixed, incorrect, parameter does not remain

0.18

Two-impulse Rendezvous Planning about Thrusting Spacecraft on SE2(3)

eess.SY ·2026-09-23 ·Micah Condie, Abigaile Woodbury, James Goppert
hot direction similarity 0.55
Abstract

The classical Hill--Clohessy--Wiltshire equations assume an unforced Keplerian reference trajectory, an assumption that is violated by missions requiring continuous thrust. We formulate spacecraft relative motion on the $\mathrm{SE}_2(3)$ Lie group, which encodes position, velocity, and attitude in a single geometric state, linearize the gravity and body-frame control mismatches between the two vehicles, and derive analytic bounds on every neglected term. Under circular coasting Keplerian assumptions the framework recovers the Hill--Clohessy--Wiltshire equations exactly. For thrusting references the state transition matrix acquires thrust-induced attitude--translation coupling blocks that, when the two vehicles share body-frame inputs, are exact in log coordinates and independent of the attitude error, and a mismatch between the vehicles' inputs re-centers the linearization at their mean. A two-impulse rendezvous planner follows directly. A scalar coupling ratio, computable before planning, separates two regimes. Where it exceeds unity, the planner reduces the terminal error of coupling-blind planners by more than an order of magnitude, and somewhat above unity it is also more accurate than a Cartesian planner of the same computational structure; well below unity, simpler planners are adequate or better. Simulations confirm the recovery to machine precision and validate every bound along the transfer.

0.33

Trajectory Bundle Method in SE(3) for Black-Box Fixed-Wing Aircraft Trajectory Optimization

cs.RO ·2026-09-10 ·Matthew D. Osburn, Cameron K. Peterson, John L. Salmon
similarity 0.55
Abstract · This work has been submitted to the IEEE for possible publication. Copyright may be transferred without notice, after which this version may…

Dynamically feasible trajectory optimization for rigid-body systems is naturally formulated on the special Euclidean group SE(3) but is challenging when dynamics are available only as black-box computations without derivatives. This paper formulates the Trajectory Bundle Method (TBM) for motion planning implicitly on SE(3). Bundles are constructed in the Lie algebra and propagated through nonlinear rigid-body dynamics using exponential and logarithmic maps, enabling derivative-free planning of non-Euclidean trajectories. We show that Euclidean TBM interpolation error is bounded quadratically by bundle diameter and extend this result to SE(3), where the bound additionally depends on a local Lipschitz constant of the Log map. Numerical experiments corroborate these bounds. Finally, we demonstrate SE(3) TBM by optimizing an acrobatic, collision-free fixed-wing maneuver through a rotated aperture without explicit models or derivatives of the vehicle dynamics, aerodynamics, or collision model.

0.36

Singularity-Free Guiding Vector Fields on SO(3) with Designer-Specified Progression Behavior

cs.RO ·2026-09-07 ·Jesus Bautista, Hector Garcia de Marina
similarity 0.54
Abstract · 12 pages, submitted to Automatica

This paper develops a singularity-free guiding vector field (SF-GVF) for path following on the special orthogonal group SO(3). First, we lift the Euclidean SF-GVF construction to SO(3), integrating the augmented-state approach with the intrinsic Lie-group geometry and obtaining a closed-form geometric guidance law whose integral curves converge to a designer-specified attitude path. The field is defined on a dense open subset of SO(3), excluding only the measure-zero antipodal set - a manifestation of the topological obstruction to continuous global stabilization on SO(3). The construction requires no per-step optimization and produces a control input intrinsically in so(3) as body angular rates. Second, we formalize the progression behavior along the path as a designer-supplied function ν(ξ), promoting the parametric speed from an implicitly resolved degree of freedom to a first-class design specification. In contrast to the Euclidean condition v = 0, which excludes vehicles with minimum-speed constraints, the corresponding condition ω= 0 on SO(3) is physically admissible for most platforms with active attitude control, making the progression behavior a design freedom structurally available on SO(3) but absent in the Euclidean setting. The framework's structural results are established under a bi-invariant Riemannian metric and hold uniformly across choices of path, progression, and Lyapunov gain. The framework is illustrated in simulation on self-intersecting paths under both constant and point-convergence progression behaviors.

0.53

Globally Certified Invariant-Ellipsoid Control from Data

eess.SY ·2026-09-30 ·Ngoc Tuan Dinh, Egor Dogadin, Alexey Peregudin
theory similarity 0.54
Abstract · 6 pages, 2 figures. Submitted jointly to IEEE Control Systems Letters (L-CSS) and the American Control Conference (ACC)

This letter develops a data-based method for designing state feedback for a discrete-time linear system under bounded disturbances. For each admissible feedback gain and scalar design parameter, a Lyapunov equation determines an invariant ellipsoid: a region that the state cannot leave under the permitted disturbances. We optimise the gain and parameter to minimise a trace-based measure of the resulting output enclosure. At each parameter value, value iteration gives a lower cost bound, while separate controller evaluation gives an achievable upper bound. These bounds also let us assess whole parameter intervals without evaluating every point. We prove that the search stops after finitely many evaluations with a stabilising state-feedback gain whose objective is within any prescribed absolute tolerance of the infimum over the chosen ellipsoid family. Neither an initially stabilising gain nor attainment of the infimum is assumed. The guarantee assumes exact arithmetic and a sufficiently informative batch of exact measurements, including disturbances during data collection; the resulting feedback uses only the state. A position--velocity example illustrates the bounds, controller checks, and computational cost.

0.32

Quasi-Static Fault-Tolerant Feedback Control of a Quadrotor under Rotor Failure with Provable Safety Guarantees

eess.SY math.DSmath.OC ·2026-09-20 ·Mohamed Al Lawati, Adeel Akhtar
publishedcode/datahot direction similarity 0.54
Abstract · 7 pages, 3 figures (14 panels). Accepted for presentation at the 2026 IEEE Conference on Control Technology and Applications (CCTA)

This paper presents a nonlinear control law for a quadrotor unmanned aerial vehicle (UAV) under single-rotor failure that guarantees set stabilization via quasi-static feedback (QSF). Given a geometric curve in three-dimensional space, we characterize and stabilize the zero-dynamics manifold, also known as the path-following manifold, which represents all feasible motions along the path. Stabilizing this manifold ensures path-invariance: a UAV with a failed rotor initialized on the path with an appropriate orientation remains on the path for all future time. Furthermore, local exponential convergence to the manifold is guaranteed under certain conditions, implying that, under the stated assumptions, rotor failure during flight does not cause transverse deviation from the path. The proposed controller thus provides theoretical safety guarantees, which are validated through numerical experiments in the Drake physics-based simulation engine. The code is publicly available at https://gradslab.github.io/quasistatic-ftc/.

0.79