Reachability-Guaranteed Optimal Control for the Interception of Dynamic Targets under Uncertainty

Tommaso Faraci 1, Roberto Lampariello · 2025

Read Reachability-Guaranteed Optimal Control for the Interception of Dynamic Targets under Uncertainty by Tommaso Faraci 1, Roberto Lampariello (2025) 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-2503-16935.txt.

Introduction

Tommaso Faraci and Roberto Lampariello present a control method that guarantees a robot can intercept a moving target even when the target's motion is uncertain. Robots that catch or dock with moving objects usually trust their best estimate of the motion. If that estimate is off, the plan can fail with no warning.

Their approach starts from reachability analysis for rigid bodies, working out every state the target could truly reach within known bounds. The control problem is then set up so that interception is guaranteed for all those possibilities, while still optimizing a cost. A tumbling object in space serves as the test case. Guaranteed interception matters when a miss is costly or dangerous.

Catalog record

CREATORTommaso Faraci 1, Roberto Lampariello
YEAR2025
COLLECTIONPAPERS
FORMATTXT
FILE SIZE36 KB
VERSION1.0
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2503-16935

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Reachability-Guaranteed Optimal Control for the Interception of Dynamic Targets under Uncertainty Tommaso Faraci 1, Roberto Lampariello Abstract Intercepting dynamic objects in uncertain environments involves a significant unresolved challenge in modern robotic systems. Current control approaches rely solely on estimated information, and results lack guarantees of robustness and feasibility. In this work, we introduce a novel method to tackle the interception of targets whose motion is affected by known and bounded uncertainty. Our approach introduces new techniques of reachability analysis for rigid bodies, leveraged to guarantee feasibility of interception under uncertain conditions. We then propose a Reachability-Guaranteed Optimal Control Problem, ensuring robustness and guaranteed reachability to a target set of configurations. We demonstrate the methodology in the case study of an interception maneuver of a tumbling target in space. \textsuperscript{1} \textsuperscript{1} footnotetext: Tommaso Faraci is a PhD student at the University of Trento. I Introduction Intercepting dynamic uncooperative targets is a major challenge in the current robotic landscape. Most techniques rely on static scenes or assume perfect knowledge of the scene’s development in time. Only under these assumptions the approaches deliver trajectories guaranteeing obstacle avoidance and feasibility [ 1 ] . In real scenarios, however, it is often the case that other object’s properties are either unknown or derive from measurements affected by uncertainty. In most cases, this information is obtained from estimation procedures which deliver uncertain values [ 2 ] . Robust motion planning with reachability guarantees with respect to a designated target set thus remains an open problem. Current methodologies are not able to robustly perform in real life applications which require achieving close proximity, grasping and interacting with moving targets in 3D -space (e.g. spacecrafts [ 2 ] and free-flying robots [ 3 ] ). In this work, we address the problem of trajectory optimization for a rigid body in 3D -space to guarantee the approach to and interception of a dynamic target, the Guaranteed Reachability Problem (GRP) . The target’s motion parameters are affected by a known and bounded uncertainty, which we leverage to conservatively enclose all of its reachable trajectories. We then propose a nonlinear trajectory optimization method leveraging this enclosure, to deliver optimal trajectories with robustness and reachability guarantees. Fig. 1 : Visualization of reachable sets on SO(3) for different realizations of simulated motion on NASA Astrobee robot [ 4 ] . All possible orientations are enclosed in a set, projected here on the unit-sphere for the robot’s body-frame. Contributions: We formalize the GRP , which relies on the introduction of techniques of Reachability Analysis (RA) on SE(3) . Furthermore, we propose a formulation of a Reachable Temporal Coverage (RTC) to bound reachable trajectories in time. Finally, we introduce an OCP to solve the GRP . Organization: In Section II we introduce the current state-of-the-art methods for robust control and RA . In Section III we introduce mathematical concepts and formulate the notion of GRP . Section IV introduces the notion of sets on SE(3) and conservative convex enclosures on curved manifolds. Section V describes derivation of the RTC . In Section VI we develop the Reachability-Guaranteed OCP (OCP) , which is applied in experiments in Section VII . Finally, Section VIII concludes this work by summarizing the results and introducing future work. II Related Work Motion planning under uncertainty extends planning problems to account for aleatoric (e.g., additive disturbances with no correlation in time) and epistemic (e.g., parametric uncertainty on the system’s parameters) uncertainty. When probability distributions over uncertain quantities are available, chance-constrained motion planning computes plans satisfying probabilistic constraints [ 5 , 6 ] . However, in many applications, uncertainty is conservatively described as a bound rather than probability distributions [ 7 , 8 ] , requiring to guarantee safe operation for all uncertainty realizations within these bounds. This task is referred to as robust motion planning . Robust motion planning algorithms deliver plans while satisfying constraints for all possible uncertain quantities within known bounded sets. Often, methods rely on error bounds computed offline and enforced during online planning [ 9 , 10 , 11 ] . Such methods are conservative and apply only to stabilizable systems. Sample-based methodologies are proposed in [ 12 , 13 , 14 ] , deriving error bounds on the reconstruction of reachable sets. These methods exploit properties of convex hulls of forward dynamic rollouts to constrain reachable sets at prescribed times. These methods are efficient and easily applicable to a variety of cases. However, discrete forward propagation only delivers reachable sets at sampled times, introducing a lack of inter-sample guarantees between sets. Moreover, tasks such as target interception [ 15 , 16 ] and space debris removal [ 17 ] require methods applicable on SE(3) . In this work, we propose a sampling-based temporal coverage for forward propagated dynamics, the RTC , guaranteeing robustness by relying on general assumptions on the system’s flow. The method allows to perform reachability analysis on SE(3) , enabling to actuate a guaranteed target approach . Guaranteed Target Approach integrates techniques of RA in a robust optimal control framework. Methods in [ 13 , 14 ] are used to robustly plan for systems affected by epistemic uncertainty, formulating constraint satisfaction on reachable sets leveraging properties of convex hulls on \mathbb{R}^{n} . However, the approach does not resolve the problem of guaranteeing reachability of all states in a target set. We address the aforementioned limitations by tightly integrating sampling-based forward reachability analysis and an optimal control framework. The method guarantees the feasibility of all control trajectories, in order to ensure reachability of all the target’s configurations. To the best of the authors’ knowledge, RA has never been employed to robustly plan an approach maneuver guaranteeing full reachability with respect to a target. First, we design a forward reachability method to estimate reachable sets of a dynamic target affected by aleatoric uncertainty on SO(3) . Then, we expand the methods in [ 13 , 18 ] to factor robustness and reachability guarantees within an OCP for a rigid body trajectory in \mathbb{R}^{n} . We finally obtain the RG-OCP , an efficient control methodology leveraging RA to plan safely and robustly. We also argue that the method applies to a wide class of robotic systems. III Background and Problem Definition Differential geometry . Let \mathcal{M}\subseteq\mathbb{R}^{n} be a k -dimensional manifold without boundary. Equipped with the induced metric from the ambient Euclidean norm \|\cdot\| , (\mathcal{M},\|\cdot\|) is a Riemannian manifold [ 19 ] . The geodesic distance on \mathcal{M} between p,q\in\mathcal{M} is denoted by d^{\mathcal{M}}(p,q) . Geodesics are curves \gamma:I\subseteq\mathbb{R}\to\mathcal{M} satisfying the geodesic equation \nabla_{\gamma^{\prime}}\gamma^{\prime}=0 with respect to the Levi-Civita connection. From [ 20 , Theorem 6.12] , all geodesics \gamma are locally minimizing with respect to the energy functional E(\gamma)=\frac{1}{2}\int_{a}^{b}\|\gamma^{\prime}\|^{2} . For any p\in\mathcal{M} , T_{p}\mathcal{M} and N_{p}\mathcal{M} denote the tangent and normal spaces of \mathcal{M} [ 21 , 19 ] . These are viewed as linear subspaces of \mathbb{R}^{n} . (\mathcal{M},\|\cdot\|) is obtained from its tangent space through the exponential map \exp():E\subset T_{p}\mathcal{M}\to\mathcal{M} with E defined in [ 22 ] , \exp_{p}(v)=\gamma_{v}(1) . Convexity on Riemanninan Manifolds ties to the definition of a distance metric and geodesics. We report the following definition from Riemannian geometry: Definition III.1 (Strong Convexity [ 19 ] ). A

Read the complete text