Change Kalman handler struc to try fixing runtime failure