It works!
Just need some tests on more random matrixes