Kalman_work_small