Matrix now just does the dumping but I need to make this more formal I think.

matrix.hpp

@@ -1,5 +1,6 @@
 #pragma once
 #include <vector>
+#include <string>
 
 typedef std::vector<int> MatrixRow;
 typedef std::vector<MatrixRow> Matrix;
@@ -12,3 +13,5 @@ inline void matrix_assign(Matrix &out, int new_value) {
     row.assign(row.size(), new_value);
   }
 }
+
+void matrix_dump(const std::string &msg, Matrix &map, int show_x=-1, int show_y=-1);