Add Quaternion fast resolution (madgwick & mahony)
Continuing LSM9DS0 driver