Cleaned up the AT an navdata packets. Also added state of the ardrone, to reset when in emergency mode.