Beginning object oriented refactor.
Finishing cleaning up IMU class.