Multi-Vehicle Trajectory optimisation On Road Networks
- Resource Type
- Conference
- Authors
- Gun, Philip; Hill, Andrew; Vujanic, Robin
- Source
- 2019 International Conference on Robotics and Automation (ICRA) Robotics and Automation (ICRA), 2019 International Conference on. :2025-2031 May, 2019
- Subject
- Robotics and Control Systems
Roads
Trajectory
Planning
Automation
Optimization
Iterative methods
Mixed integer linear programming
- Language
- ISSN
- 2577-087X
This paper addresses the problem of planning time-optimal trajectories for multiple cooperative agents along specified paths through a static road network. Vehicle interactions at intersections create non-trivial decisions, with complex flow-on effects for subsequent interactions. A globally optimal, minimum time trajectory is found for all vehicles using Mixed Integer Linear Programming (MILP). Computational performance is improved by minimising binary variables using iteratively applied targeted collision constraints, and efficient goal constraints. Simulation results in an open-pit mining scenario compare the proposed method against a fast heuristic method and a reactive approach based on site practices. The heuristic is found to scale better with problem size while the MILP is able to avoid local minima.