changed the astar path to a full path of waypoints instead of shortened path