Some work on accel calibration, almost working :(
Merge pull request #64 from Kenny9999/master

Some work on accel calibration, almost working :(