Adding preliminary kalman filter class