Added the marker detection to the image, pose and position

[NehilDanis]

Hey Marco, while I was using the repo, I needed to visualize the pose, position or the marker and also I visualized it on the image published. I thought it would be nice to add this into the code, this way people can directly subscribe to the topics from rviz. What do you think?