Lowpass filter 42Hz. Added option for MAG (Compass) offset for orientation compensation.
Lowpass filter 42Hz fixed.