Added a no-go map to the 3d obstacle avoidance as well