Multi-Stage Formation Flight Planning