kalman filter test added