Provably Safe Trajectory Generation for Manipulators Under Motion and Environmental Uncertainties
This addresses the problem of ensuring certified collision risk guarantees for robot manipulators in complex, uncertain settings, representing an incremental improvement over existing methods.
The paper tackled safe motion planning for robot manipulators in uncertain environments by proposing a risk-bounded framework that integrates a deep stochastic Koopman model and hierarchical verification, validated through simulations and real-world experiments to generate safe and efficient trajectories.
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.