corrected rosparam name + some debug code
corrected rosparam name + some debug code

ENSTA-Bretagne-Shepherd/Shepherd-Ros-Structure,ENSTA-Bretagne-Shepherd/Shepherd-Ros-Structure,ENSTA-Bretagne-Shepherd/Shepherd-Ros-Structure