Update matrix.hpp