Swarm path planner system for vehicles

Abstract

A system for determining optimal paths without collision through a travel volume for a swarm of vehicles is disclosed. The system determines a travel path for the swarm leader vehicle using a minimal cost path derived from various measures of environmental cost for avoiding objects in traveling from leader location to target location. The system also determines, for each empty neighbor location of each follower vehicle, relational costs for follower vehicle travel relative to leader vehicle travel. The various measures of relational cost seek to maintain a prescribed positional relationship between each follower vehicle and the leader vehicle given the leader vehicle travel path. Based on various measures of environmental and relational cost, the system determines the best travel path for the each follower vehicle relative to the leader vehicle.