Trajectory Tracking and Formation Flight of Autonomous UAV