Fixed bug in body to inertial transformation
Made stable flight (pitch variation only)