changed underlying data structure to nav_msg::OccupancyGrid and added functionality to store and show objects in map