add Matrix3D and Vector4D