Kalman filter to combine GPS and accelerometer data