Obstacle Avoidance and Formation regrouping Strategy and Control for UAV Formation Flight