Added FreeIMU library
Switched to FreeIMU MPU driver
Removed old MPU driver
Removed own Quaternion
Trying to get IMU working