Fix MatrixMathUtils not setting all fields correctly