Adding Kalman filter implementation as submodule