added kalman filter :)