Started working on a package for handling occupancy grid maps