Costmaps, directly analogous to ethz-asl's grid_map library. - View it on GitHub