Abstract:Safety is crucial for robotic missions within an uncertain environment. Common safety requirements such as collision avoidance are only state-dependent, which can be restrictive for complex missions. In this work, we address a more general formulation as safe-return constraints, which require the existence of a return-policy to drive the system back to a set of safe states with high probability. The robot motion is modeled as a Markov Decision Process (MDP) with probabilistic labels, which can be highly non-ergodic. The robotic task is specified as Linear Temporal Logic (LTL) formulas over these labels, such as surveillance and transportation. We first provide theoretical guarantees on the re-formulation of such safe-return constraints, and a baseline solution based on computing two complete product automata. Furthermore, to tackle the computational complexity, we propose a hierarchical planning algorithm that combines the feature-based symbolic and temporal abstraction with constrained optimization. It synthesizes simultaneously two dependent motion policies: the outbound policy minimizes the overall cost of satisfying the task with a high probability, while the return policy ensures the safe-return constraints. The problem formulation is versatile regarding the robot model, task specifications and safety constraints. The proposed hierarchical algorithm is more efficient and can solve much larger problems than the baseline solution, with only a slight loss of optimality. Numerical validations include simulations and hardware experiments of a search-and-rescue mission and a planetary exploration mission over various system sizes.

Hierarchical Real-time Motion Planning for Safe Multi-robot Manipulation in Dynamic Environments*

Hierarchical Motion Planning Framework for Cooperative Transportation of Multiple Mobile Manipulators

Whole-Body Real-Time Motion Planning for Multicopters

Research on multi-robot cooperative motion planning

Real-Time Path Planning for Mobile Robots

Distributed Cooperative Motion Planning for Multiple Articulated Robots

A Real-Time and Fully Distributed Approach to Motion Planning for Multirobot Systems

Optimal Multilayered Motion Planning for Multiple Differential Drive Mobile Robots with Hierarchical Prioritization (OM-MP)

Online Trajectory Generation with Local Replanning for 7-Dof Serial Manipulator in Unforeseen Dynamic Environments

A Hierarchical Motion Planning Method for Mobile Manipulator

Hierarchical Adaptive Motion Planning with Nonlinear Model Predictive Control for Safety-Critical Collaborative Loco-Manipulation

Real-time Whole-body Motion Planning for Mobile Manipulators Using Environment-adaptive Search and Spatial-temporal Optimization

Scalable Multi-robot Motion Planning for Congested Environments With Topological Guidance

Hierarchical Search-Based Cooperative Motion Planning

Collaborative motion planning for multi-manipulator systems through Reinforcement Learning and Dynamic Movement Primitives

Hierarchical Motion Planning Under Probabilistic Temporal Tasks and Safe-Return Constraints

Scalable and Safe Multi-Agent Motion Planning with Nonlinear Dynamics and Bounded Disturbances

Hierarchical Large Scale Multirobot Path (Re)Planning

Trust-based Multi-Robot Symbolic Motion Planning with a Human-in-the-Loop

Multi-Layered Safety of Redundant Robot Manipulators via Task-Oriented Planning and Control