We'll need a node that generates a mesh graph from an occupancy grid map using a voronoi graph approach. Each goal must be reachable by the robot and have some padding around it to allow for rotation.
The generated grid then needs to be integrated into the ezmap so it can then be adjusted for edge cases by a human operator.
I've assigned you here @JanezCim since you found some pre-existing code that we should take a look at and I can't recall what/where it was exactly, so if you still have those links it would be helpful to post them here as a reply.
We'll need a node that generates a mesh graph from an occupancy grid map using a voronoi graph approach. Each goal must be reachable by the robot and have some padding around it to allow for rotation.
The generated grid then needs to be integrated into the ezmap so it can then be adjusted for edge cases by a human operator.
I've assigned you here @JanezCim since you found some pre-existing code that we should take a look at and I can't recall what/where it was exactly, so if you still have those links it would be helpful to post them here as a reply.