Majorly cleaned up. See new MPU lib.

https://github.com/nixpulvis/MPU9150