diff --git a/libraries/AP_Math/quaternion.h b/libraries/AP_Math/quaternion.h index 881a41a1c0..4874ffbc24 100644 --- a/libraries/AP_Math/quaternion.h +++ b/libraries/AP_Math/quaternion.h @@ -98,6 +98,9 @@ public: float length(void) const; void normalize(); + // initialise the quaternion to no rotation + void initialise() { q1 = 1.0f; q2 = q3 = q4 = 0.0f; } + Quaternion inverse(void) const; // allow a quaternion to be used as an array, 0 indexed