calibrate IMU

When the motor/sensor controller starts, on the stationary platform read the sensordata for eg. a second and use the mean as constant offset