first functional kalman filter demo