Taking footprint into account: how to find best position near object?
Good evening folks,
I'm just thinking about how I can obtain the best position in the proximinty of an object that takes obstacles and the robot's footprint into account.
The idea that I have is to simulate every (discrete) position on a circle around the object by placing the footprint in that location, facing the object, to aggregate the values of the occupancy grid in every location and to eventually evaluate all positions by the added up occupancy values, the distance to the current position of the robot and - if possible - the accessibility of the determined position.
So the question in the first place is: how do I get the values of an occupancy grid within the footprint of the robot at a given position? Are there any tools yet to do that?
Once more, thanks a lot!
