add kalman source to package
implemented simple 2x2 matrix functionality as private functions in kalman module
kalman functions implemented (private interface)