Implemented the rest of the MARG filter
Implemented the rest of the MARG filter

Finished writing the update() function. Tested on an Arduino with an
LSM9DS0 MEMS sensor and it seems to work correctly.

JCube001/Fusion,JCube001/Fusion