Change the visualization part (obstacles are sent in road coordinate)