Update Matrix3d