Fixed ground speed and added accelerometer