Added first version of Kalman Library