New files for implementing Kalman filter and testing it