Refactor Matrix from float[16] to float[4][4]