Accelerometer calibration bugfix

Just now found a bug, sorry! Now tested and works.