Add cone and road images
Fix image_publisher to wait for connections