Fixes: added defines in math header files
Improvements: some new functions for working with matrixes