Big internal rework

Reworked a lot of code inside Matrix class and other function for better performance. The result is 5x faster QR decomposition and 1.5x faster SVD. Fixed memory leaks