adding JointState republish
Merge branch 'hydro-devel' of https://github.com/Jailander/scitos_3d_mapping into hydro-devel