3D Obstacle Avoidance Strategies for UASs Mission Planning and Re-planning