Ask Your Question

Revision history [back]

click to hide/show revision 1
initial version

You can use the costmap_2d layered architecture. The costmap gets built by multiple layers, you can add a new one. In this new layer after you do IPM on the image you place the traffic line in the using cost values that show how occupied is each individual layer cell. This way even the built in navigation stack can do path planning on top of the new layer.costmap_2d wiki