Back to Y lying in the plane that contains the aircraft's roll and yaw axes

Also reworked all the math part.