State Estimation, Control, And Planning For A Quadrotor Team