Parameterize Kalman convergence test by speed
Parameterize Kalman convergence test by speed

Parameterize Kalman convergence test by speed, from 0.5 m/s to 9.0 m/s.
Allow each state vector element different tolerances.

oliverlee/bicycle,oliverlee/bicycle