Update Matrix3D.hpp