Create Kalman Filter - First Implementation