Fixed yaw, relying on tags for good yaw now!
Figure Flying Version 1