This allows us to load up the I term with the vehicle's current
acceleration during mode transitions

pair programmed with Randy