Reverted the QuatToMat conversion functions to their original state as they no longer converted properly.