Abstract:We propose a numerical algorithm for multiple-vehicle motion planning that explicitly takes into account the vehicle dynamics, temporal and spatial specifications, and energy-related requirements. As a motivating example, we consider the case where a group of vehicles is tasked to reach a number of target points at the same time (simultaneous arrival problem) without colliding among themselves and with obstacles, subject to the requirement that the overall energy required for vehicle motion be minimized. With the theoretical setup adopted, the vehicle dynamics are explicitly taken into account at the planning level. This paper formulates the problem of multiple-vehicle motion planning in a rigorous mathematical setting, describes the optimization algorithm used to solve it, and discusses the key implementation details. The efficacy of the method is illustrated through numerical examples for the simultaneous arrival problem. The initial guess to start the optimization procedure is obtained from simple geometrical considerations, e.g., by joining the desired initial and final positions of the vehicles via straight lines. Even though the initial trajectories thus obtained may result in intervehicle and vehicle/obstacle collisions, we show that the optimization procedure that we employ in this paper will generate collision-free trajectories that also minimize the overall energy spent by each vehicle and meet the required temporal and spatial constraints. The method developed applies to a very general class of vehicles; however, for clarity of exposition, we adopt as an illustrative example the case of wheeled robots.

Decentralized Velocity-Aware Motion Planning for Multi-agent Coordination

3D Multi-Uav Cooperative Velocity-Aware Motion Planning.

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

Receding Horizon Motion Planning for Multi-Agent Systems: A Velocity Obstacle Based Probabilistic Method

Velocity Variation Space Based Multiple Agents Motion Planning for Mobile Robot

Velocity Planning for Multi-Vehicle Systems Via Distributed Optimization

Balancing Computation Speed and Quality: A Decentralized Motion Planning Method for Cooperative Lane Changes of Connected and Automated Vehicles.

Decentralized Motion Planning with Collision Avoidance for a Team of UAVs under High Level Goals

Decentralized Multi-Agent Trajectory Planning in Dynamic Environments with Spatiotemporal Occupancy Grid Maps

Hierarchical Search-Based Cooperative Motion Planning

VCS-based Motion Planning for Distributed Mobile Robots: Collision Avoidance and Formation

Multiagent Motion Planning Based on Deep Reinforcement Learning in Complex Environments

Finite-time Motion Planning of Multi-agent Systems with Collision Avoidance

Hierarchical Motion Planning at the Acceleration Level Based on Task Priority Matrix for Space Robot

Decentralized Navigation Of Multiple Agents Based On Orca And Model Predictive Control

Energy-Optimal Motion Planning for Multiple Robotic Vehicles With Collision Avoidance

Multi-Agent Motion Planning with Bézier Curve Optimization under Kinodynamic Constraints

Prioritized Multi-agent Path Finding for Differential Drive Robots

Asynchronous and Decentralized Multiagent Trajectory Planning in Dense Environments

Multi-Agent Coverage Path Planning via Proximity Interaction and Cooperation

Hybrid A∗ Based Motion Planning for Autonomous Vehicles in Unstructured Environment