Fixed mat4 bugs