Abstract:As autonomous systems and robots are applied to more real world situations, they must reason about uncertainty when planning actions. Mission success oftentimes cannot be guaranteed and the planner must reason about the probability of failure. Unfortunately, computing a trajectory that satisfies mission goals while constraining the probability of failure is difficult because of the need to reason about complex, multidimensional probability distributions. Recent methods have seen success using chance-constrained, model-based planning. However, the majority of these methods can only handle simple environment and agent models. We argue that there are two main drawbacks of current approaches to goal-directed motion planning under uncertainty. First, current methods suffer from an inability to deal with expressive environment models such as 3D non-convex obstacles. Second, most planners rely on considerable simplifications when computing trajectory risk including approximating the agent’s dynamics, geometry, and uncertainty. In this article, we apply hybrid search to the risk-bound, goal-directed planning problem. The hybrid search consists of a region planner and a trajectory planner. The region planner makes discrete choices by reasoning about geometric regions that the autonomous agent should visit in order to accomplish its mission. In formulating the region planner, we propose landmark regions that help produce obstacle-free paths. The region planner passes paths through the environment to a trajectory planner; the task of the trajectory planner is to optimize trajectories that respect the agent’s dynamics and the user’s desired risk of mission failure. We discuss three approaches to modeling trajectory risk: a CDF-based approach, a sampling-based collocation method, and an algorithm named Shooting Method Monte Carlo. These models allow computation of trajectory risk with more complex environments, agent dynamics, geometries, and models of uncertainty than past approaches. A variety of 2D and 3D test cases are presented including a linear case, a Dubins car model, and an underwater autonomous vehicle. The method is shown to outperform other methods in terms of speed and utility of the solution. Additionally, the models of trajectory risk are shown to better approximate risk in simulation.

Decision-Time Postponing Motion Planning for Combinatorial Uncertain Maneuvering

Rollout-Based Interactive Motion Planning for Automated Vehicles *

Decision-theoretic MPC: Motion Planning with Weighted Maneuver Preferences Under Uncertainty

Efficient Optimization-Based Trajectory Planning for Unmanned Systems in Confined Environments

Shunted Collision Avoidance for Multi-UAV Motion Planning with Posture Constraints.

Spatiotemporal motion planning with combinatorial reasoning for autonomous driving

A Risk and Comfort Optimizing Motion Planning Scheme for Merging Scenarios

Time-optimal Point-to-point Motion Planning: A Two-stage Approach

Probabilistic Game Theory and Stochastic Model Predictive Control-Based Decision Making and Motion Planning in Uncontrolled Intersections for Autonomous Driving

Motion Planning under Uncertainty: Integrating Learning-Based Multi-Modal Predictors into Branch Model Predictive Control

Uncertainty-Aware Decision-Making and Planning for Autonomous Forced Merging

Scenario-Based Motion Planning with Bounded Probability of Collision

Motion Planning for Connected Automated Vehicles at Occluded Intersections With Infrastructure Sensors

A Real-Time Approach for Chance-Constrained Motion Planning with Dynamic Obstacles

SCTOMP: Spatially Constrained Time-Optimal Motion Planning

Motion Planning Under Uncertainty with Complex Agents and Environments via Hybrid Search

Long Horizon Risk-Averse Motion Planning: a Model-Predictive Approach

Predictive Collision Management for Time and Risk Dependent Path Planning

Safety-aware time-optimal motion planning with uncertain human state estimation

Combining temporal planning with probabilistic reasoning for autonomous surveillance missions

Probabilistic motion planning for non-Euclidean and multi-vehicle problems