Added new method of inversion of matrices.
Kalman Filter finally working. Fixed a lot of problems in Matrix.