Improved quaternion IMU