Kalman 1st tuning pass