Quaternion filter Demo with with algorithm from http://www.x-io.co.uk/open-source-imu-and-ahrs-algorithms/.