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

Manuel Castillo-Lopez,Philippe Ludivig,Seyed Amin Sajadi-Alamdari,Jose Luis Sanchez-Lopez,Miguel A. Olivares-Mendez,Holger Voos

DOI: https://doi.org/10.1109/LRA.2020.2975759

2020-05-07

Abstract:Uncertain dynamic obstacles, such as pedestrians or vehicles, pose a major challenge for optimal robot navigation with safety guarantees. Previous work on motion planning has followed two main strategies to provide a safe bound on an obstacle's space: a polyhedron, such as a cuboid, or a nonlinear differentiable surface, such as an ellipsoid. The former approach relies on disjunctive programming, which has a relatively high computational cost that grows exponentially with the number of obstacles. The latter approach needs to be linearized locally to find a tractable evaluation of the chance constraints, which dramatically reduces the remaining free space and leads to over-conservative trajectories or even unfeasibility. In this work, we present a hybrid approach that eludes the pitfalls of both strategies while maintaining the original safety guarantees. The key idea consists in obtaining a safe differentiable approximation for the disjunctive chance constraints bounding the obstacles. The resulting nonlinear optimization problem is free of chance constraint linearization and disjunctive programming, and therefore, it can be efficiently solved to meet fast real-time requirements with multiple obstacles. We validate our approach through mathematical proof, simulation and real experiments with an aerial robot using nonlinear model predictive control to avoid pedestrians.

Robotics,Optimization and Control

What problem does this paper attempt to address?

The problem that this paper attempts to solve is how to handle uncertain dynamic obstacles, such as pedestrians or vehicles, when performing real - time motion planning in a dynamic environment, so as to ensure that the robot can safely avoid these obstacles while being highly efficient. Specifically, the paper proposes a new method to model uncertain dynamic obstacles for chance - constrained motion planning in fast real - time applications. This method aims to reduce the conservatism in existing real - time methods, while providing safety guarantees and being able to handle multiple obstacles with low computational cost.

### Background of the Paper
Uncertain dynamic obstacles are a major challenge in the navigation of autonomous robots (such as self - driving cars or drones). Existing optimal motion planning methods usually adopt two strategies to define the safety boundaries of obstacles:
1. **Polyhedral Representation**: Use polyhedra (such as cubes) to represent the space of obstacles. This method relies on discrete programming and has a high computational cost, which increases exponentially with the number of obstacles.
2. **Non - linear Differentiable Surface Representation**: Use a single differentiable surface (such as an ellipsoid) to represent the space of obstacles. This method requires local linearization to find a solvable form of chance - constrained, but it will significantly reduce the remaining free space, resulting in overly conservative trajectories or infeasibility.

### Contributions of the Paper
The paper proposes a hybrid method that combines the advantages of the above two strategies, avoids their disadvantages, and maintains the original safety guarantees. Specific contributions include:
1. **Theoretical Results**: Provide a tighter upper bound on the probability of collision and improve the chance - constrained of the polyhedral obstacle area through theoretical analysis.
2. **Real - Time Method**: Propose a new real - time chance - constrained motion planning method suitable for dynamic environments.
3. **Experimental Verification**: Verify the effectiveness of this method through mathematical proofs, simulations, and practical experiments (using non - linear model predictive control to avoid pedestrians on aerial robots).

### Method Overview
1. **Problem Modeling**: Model the motion planning problem as a non - linear optimization problem with chance - constraints.
2. **Safety Approximation**: Approximate the outer space of polyhedral obstacles by the minimum volume enclosing ellipsoid (MVEE) to obtain a deterministic non - linear programming problem.
3. **Optimization Solution**: Use existing non - linear programming solvers to efficiently solve this problem.

### Experimental Verification
1. **Benchmark Testing**: Compare with three existing advanced methods, showing the advantages of the new method in reducing conservatism.
2. **Practical Experiments**: Conduct pedestrian - avoidance experiments on drones to verify the effectiveness and safety of the method in practical applications.
3. **Simulation Experiments**: In software - in - the - loop simulations, simulate the obstacle - avoidance situation of robots in crowded environments to further verify the robustness and real - time performance of the method.

In conclusion, the paper proposes a new real - time chance - constrained motion planning method that can provide higher efficiency and safety when dealing with uncertain dynamic obstacles.