Formation Control for Mixed-Order UAVs–USVs–UUVs Systems under Cooperative and Optimal Control