SCRAMPPI: Efficient Contingency Planning for Mobile Robot Navigation via Hamilton-Jacobi Reachability

TL;DR

SCRAMPPI introduces an efficient Hamilton-Jacobi reachability-based method for contingency planning in mobile robot navigation, ensuring safety constraints are met in real-time during adversarial scenarios.

Contribution

The paper presents a novel approach combining HJ reachability with sampling-based planning to efficiently generate contingency plans online.

Findings

Real-time contingency plans demonstrated on hardware robot.

Method guarantees safety constraints in adversarial environments.

Significant increase in sampling efficiency over previous methods.

Abstract

Autonomous robots commonly aim to complete a nominal behavior while minimizing a cost; this leaves them vulnerable to failure or unplanned scenarios, where a backup or contingency plan to a safe set is needed to avoid a total mission failure. This is formalized as a trajectory optimization problem over the nominal cost with a safety constraint: from any point along the nominal plan, a feasible trajectory to a designated safe set must exist. Previous methods either relax this hard constraint, or use an expensive sampling-based strategy to optimize for this constraint. Instead, we formalize this requirement as a reach-avoid problem and leverage Hamilton-Jacobi (HJ) reachability analysis to certify contingency feasibility. By computing the value function of our safe-set's backward reachable set online as the environment is revealed and integrating it with a sampling based planner (MPPI) via resampling based rollouts, we guarantee satisfaction of the hard constraint while greatly increasing sampling efficiency. Finally, we present simulated and hardware experiments demonstrating our algorithm generating nominal and contingency plans in real time on a mobile robot in an adversarial evasion task.