updated point data structure usage
added a separate map_utils header with transformation between the map and the occupancy grid/image