Fixed yaw testing so it is the right direction.  Added flying LED status.