shortest_path() in MotionPlanner was actually correctly named shortest_path()