Added functions for inverting 2x2, 3x3 and 4x4 matrices
Added tests for matrix inversion