Add speed calculation from accelerometer, which slowly corrects itself to 0 to counteract measuring errors