Fixed bug in sensor read + calibration
ChibiOS had wrong systick since upgrade to 3.0.0 - now fixed