Fixing matrix4 operations