Provably Safe Trajectory Generation for Manipulators Under Motion and Environmental Uncertainties PubID: pubid: 0000–0000/00$00.00 © 2021 IEEE
Fei Meng, Zijiang Yang, Xinyu Mao, Haobo Liang, Max Q.-H. Meng · 2026
Read Provably Safe Trajectory Generation for Manipulators Under Motion and Environmental Uncertainties PubID: pubid: 0000–0000/00$00.00 © 2021 IEEE by Fei Meng, Zijiang Yang, Xinyu Mao, Haobo Liang, Max Q.-H. Meng (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-09083.txt.
Introduction
Fei Meng and colleagues plan provably safe paths for robot arms under motion and world unknowns. Old methods struggle to give efficient, certified crash risk pledges for complex shapes and non-Gaussian unknowns. Their tool pairs a rigid arm Koopman model for state spread forecast with layered checks combining physics sims and sum-of-squares math as a safety filter. The method runs inside a path controller using binary crash signals.
Catalog record
| CREATOR | Fei Meng, Zijiang Yang, Xinyu Mao, Haobo Liang, Max Q.-H. Meng |
|---|---|
| YEAR | 2026 |
| COLLECTION | PAPERS |
| FORMAT | TXT |
| FILE SIZE | 42354 |
| LICENSE | http://creativecommons.org/licenses/by/4.0/ |
| RIGHTS | CC BY |
| SOURCE | arXiv |
Source: https://arxiv.org/abs/2603.09083
Browse the full library · About the Tower of Babel
Full text
The opening of the work, from the library's hosted text:
Provably Safe Trajectory Generation for Manipulators Under Motion and Environmental Uncertainties PubID: pubid: 0000–0000/00$00.00 © 2021 IEEE Fei Meng, Zijiang Yang, Xinyu Mao, Haobo Liang, Max Q.-H. Meng Abstract Robot manipulators operating in uncertain and non-convex environments present significant challenges for safe and optimal motion planning. Existing methods often struggle to provide efficient and formally certified collision risk guarantees, particularly when dealing with complex geometries and non-Gaussian uncertainties. This article proposes a novel risk-bounded motion planning framework to address this unmet need. Our approach integrates a rigid manipulator deep stochastic Koopman operator (RM-DeSKO) model to robustly predict the robot’s state distribution under motion uncertainty. We then introduce an efficient, hierarchical verification method that combines parallelizable physics simulations with sum-of-squares (SOS) programming as a filter for fine-grained, formal certification of collision risk. This method is embedded within a Model Predictive Path Integral (MPPI) controller that uniquely utilizes binary collision information from SOS decomposition to improve its policy. The effectiveness of the proposed framework is validated on two typical robot manipulators through extensive simulations and real-world experiments, including a challenging human-robot collaboration scenario, demonstrating sim-to-real transfer of the learned model and its ability to generate safe and efficient trajectories in complex, uncertain settings. I Introduction Robot manipulators are increasingly deployed to address challenges such as labor shortages, worker fatigue, and the need for operation in diverse and hazardous conditions. However, their practical application is often hindered by imperfect perception and significant tracking errors, which pose considerable challenges to their safe and efficient operation. A long-standing problem in robotics is the motion planning of high-dimensional robots, which involves quickly finding a safe and optimal trajectory [ 15 , 31 , 16 ] . To address uncertainty, chance-constrained motion planners have been developed to ensure that constraints are satisfied with a high probability. These planners have been applied to robots with both simplified [ 2 , 19 , 12 , 32 ] and more complex [ 4 ] geometric models. For instance, Dawson et al. proposed a chance-constrained trajectory generation approach for high-dimensional robots that accounts for observation and motion uncertainty [ 5 ] . However, this method is limited by its assumptions of Gaussian uncertainty and convex obstacles. While techniques exist to convexify non-convex obstacles, they can negatively impact the feasibility of the resulting solution. Much of the existing literature focuses on either uncertain obstacles [ 12 , 6 , 25 ] or uncertainty in the robot’s state [ 18 , 27 , 19 , 4 ] . While some recent works have begun to consider non-Gaussian uncertainties and non-convex obstacles [ 8 , 9 , 17 ] , these studies are often restricted to mobile robots approximated as a single convex rigid body and involve computationally demanding collision risk checks. Novel neural networks are proposed to generate risk bounded paths quickly in challenging uncertain nonconvex environments [ 20 , 22 ] . However, the generated paths are geometric and require many successful expert paths to learn. Time-informed set can be built as heuristics based on the deep Koopman operator to accelerate finding the optimal kinodynamic solution; however, it is hard to transfer to robotic manipulators [ 21 ] . Model Predictive Path Integral (MPPI) control has emerged as a sampling-based stochastic control algorithm for motion planning of high-dimensional robot arms [ 3 ] . While effective for the example manipulators [ 24 ] , its performance degrades when significant tracking errors in joint space are present. Although some works have been developed to handle system dynamics with neural networks [ 29 ] , propagate uncertainty [ 23 ] , or address parameter uncertainty [ 1 ] , they often focus on deterministic systems with noisy inputs or are limited to mobile robots in deterministic environments [ 10 , 30 ] . In this article, we address the unmet need for risk-bounded trajectory generation for uncertain robot manipulators operating in uncertain, non-convex environments. The proposed workflow is illustrated in Fig. 1 . Our approach builds upon the success of deep stochastic Koopman operator (DeSKO) in soft manipulator end-effector control [ 7 ] , adapting it to the unique motion planning challenges of rigid manipulators where the state space, objectives, and constraints are fundamentally different. Notably, without collecting real data, our neural network trained in simulation generalizes well to real-world scenarios. Our primary contribution is a novel framework that integrates a rigid manipulator DeSKO (RM-DeSKO) model for robust state prediction with a hierarchical verification method for efficient and formally certified collision risk assessment. The RM-DeSKO model propagates the distribution of observables in a lifted linear space to predict future states over a planning horizon. We leverage the inferred state distribution and contact force tensors from IsaacGym [ 24 ] to efficiently compute stable collision costs. To ensure both planning efficiency and formal certification, our hierarchical method uses sum-of-squares (SOS) programming to filter control signals, guaranteeing a bounded collision probability in a risk contours map. Our MPPI-based controller reuses the binary collision results from failed controls to update its policy, leveraging the gradient-free nature of the algorithm. Our main contributions are summarized as follows: • We formulate and solve, for the first time to our knowledge, the risk-bounded motion planning problem for uncertain robot manipulators facing nonconvex obstacles with probabilistic geometry, size, and location. • We develop a Koopman operator neural network model to predict the states of high-dimensional robot arms under motion uncertainty and develop an efficient, hierarchical collision risk verification method that combines risk contours with formal certification. • We demonstrate the efficiency of our framework through extensive experiments. We further successfully transfer the policy from simulation to the real robot in a challenging human-robot collaboration scenario. Fig. 1 : Risk-bounded motion planning framework for a manipulator under environmental and motion uncertainties. It combines a RM-DeSKO neural network model predicting states X_{N,H} and costs \hat{C}_{N,H} , with a MPPI refining control inputs u^{*} . A supervisory logic enforces environment safety by computing contact force-based collision costs in simulation and checking bounded collision risk for the next predicted state before execution. Noisy state x_{t} closes the perception-action loop. The new cost function \hat{c}(x_{t},u^{*}) quickly guides stochastic optimization while ensuring risk constraints. II Preliminaries and Problem Statement II-A Risk Contours Map We denote W\subset\mathbb{R}^{3} as the robot workspace. A set of static but uncertain 3D obstacles in the workspace are denoted by \mathcal{O}=\{\mathcal{O}_{1},\dots,\mathcal{O}_{n_{o}}\}\subset W , and each one has a polynomial representation in coordinate positions \bm{p} \mathcal{O}_{i}\left(\omega_{i}\right)=\left\{\bm{p}\in W:o_{i}\left(\bm{p},\omega_{i}\right)\leq 0\right\},i=1,\cdots,n_{o}, (1) where o_{i}\in\mathbb{R}^{4}\rightarrow\mathbb{R} is the polynomial and {\omega}_{i} is a random variable with an arbitrary probability distribution provided, not necessarily Gaussian. Eq. ( 1 ) can describe convex and nonconvex probabilistic obstacles with uncertain size, location, or geometry. For instance, a spherical uncertain obstacle is {o(\bm{p},\omega)\leq 0}:\{(x,y,z):\,x^{2}+y^{2}+z^{2}-\omega^{2}\leq 0,\,\omega\sim U(1,2)\} . Its radius \omega is uncertain and follows a uniform distribution. Inflating nonconvex obstacles influences solutions’ feasibility in cluttered unstructured environments. We use the risk contours map \mathcal{M} to describe the continuous acceptable safe subspace [ 14 ] . Risk contours enable analytical moment computation and Cantelli-based hard risk bounds that are valid for any uncertainty distribution. Given a predefined risk tolerance \Delta\in[0,1] , the sets of all relatively safe positions where the probability of collision with