Fixed a problem related to the headers of the published topics. Now, we can see them in rviz w/o any problems.