Working example of Kalman filter implementation