Matrix.hpp: fixed minor bug
EntityMap.hpp: Added submat(xy pos, xy sz) function
EntityMap: Using submat instead of archaic looping