Work in progress for integration gyro/acc/mag

Looks like I have a problem in the quaternion <--> rotations functions,
which may or may not explain why the initial gyro calculations drift.