Added velocity kalman filter.