Makes some small optimization

Only some minor stuffs for matrix, quat, ...