Kalman: remove dead code