Refactor grid generating class

Right now I'm using an old [Grid3d](https://github.com/robotics-upo/Heuristic_path_planners/blob/master/include/Grid3D/grid3d.hpp) class to generate Grid Distance Maps (for futur cost aware algorithms implementations). I would like to refactor it in a modern way in order to improve the integration with the rest of the classes 