A method includes inputting a source into a weighted and undirected graph having a plurality of nodes and edges, inputting a target, inputting a plurality of objectives, searching the graph using a rapidly exploring random tree algorithm to determine a solution path that meets an existence constraint and an order constraint, determining a plurality of paths between the source and the target that intersects with each one of the plurality of objectives at least once that conforms with the existence constraint, assigning a travel cost for each of the determined plurality of paths, determining a visiting order of the plurality of objectives that reduces the assigned travel cost by the RRT* algorithm asymptotically decreasing with an allocated computation time by rewiring each one of the plurality of objectives and outputting the solution path to form a connected graph having the plurality of nodes.