Adds good IMU readings with KF and DMP. Compass Readings are possible.

No drift and good fusion. The magnetometer standard library is added. Have not gotten it working, but it does not seem to necessary.