Add some comments
bug inside matrix.hpp fixed