http://mbed.org/users/p3p/code/QuaternionMath/#3cc1a808d8c6