Checking whether a particular position in the map has any obstacle

asked 2016-01-28 00:01:04 -0600

mayank_m
115 ●18 ●20 ●23

How to check whether a particular position in the map has any obstacle. I want to check if at any particular location (x,y) the corresponding cell has any obstacle or not. How to do that using costmap in ros ?

Comments

did you find a solution for this?

aarontan ( 2018-07-05 15:25:39 -0600 )edit

Hello, have found a solution to this. i am searching for he same thing

samir menaa ( 2020-06-03 06:56:11 -0600 )edit

add a comment

answered 2016-01-28 01:29:44 -0600

mgruhler

12390 ●32 ●193 ●173 https://github.com/mgruhler

Depends on where you want to do the check, seperate node (probably subscriber), node that has the costmap as a member.

I guess it is straight forward if the costmap is member, than translate the coordinate to the relevant cell (e.g. using the worldToMap function), check the costs (e.g. using the getCost function) and then compare against the cost values).

Maybe there is a more direct way, but I don't know.

If it is a seperate node where you subscribe to, the way should be the same...

edit flag offensive delete link

Comments

Thank You....what if we need to take the footprint of the robot into account, i.e., not to consider the robot as a point object ?

mayank_m ( 2016-01-28 02:55:55 -0600 )edit

This is what the costs are for. So you need to use the inflation_layer which gets inflated depending on the robot footprint. There are costs for "definitely in collision" and "maybe in collision", as they use the inscribed and curcumscribed radius, repsecitvely.

mgruhler ( 2016-01-28 03:32:28 -0600 )edit

Check out http://wiki.ros.org/costmap_2d for more information on the cost calculation and how the footprints are used.

mgruhler ( 2016-01-28 03:32:50 -0600 )edit

Do I need to create another costmap object exactly similar to what is already running in the nav stack, and then add my custom function? Or, is there a simpler way to instantiate a costmap object with the latest costmap information (including current information from all the layers)?