Removed Kalman functions. All logic is in Agent.kalman_update.