Made temporary Quaternion a constant

Added const to Quaternion t in operator*=() because it should never be
mutated.
Implemented the IMU filter

Implemented the IMU filter according to Madgwick's 2010 article. Tested on a
Arduino Uno and it seems to work but there is some drift present.