Small changes to Matrix4 and Vector3