A method for path planning for a plurality of vehicles in a mission space includes determining, with a processor, information indicative of a first local graph of a first vehicle; receiving, with the processor over a communication link, information indicative of a second local graph from a second vehicle; assembling, with the processor, information indicative of a global graph in response to the receiving of the second local graph; wherein the global graph includes information assembled from the first local graph and the second local graph; and wherein the global graph indicates connectivity of objectives for each vehicle of the plurality of vehicles in the mission space.