Initial implementation of a Kalman filtering