Switched IMU library to use Madgwick's AHRS algorithm.

API is now IMU_GetData(), IMU_normalizeData(), IMU_Update, and one of the IMU_Get*() functions.