Almost reworked to Matrix4 and Vector3.