Removed leadings slash from rosparam for robot padding

If you have "/robot_description" as your robot_description_ the padding feature does not work because of the slash.

Also added some debug output.

Redo of https://github.com/ros-planning/moveit_ros/pull/507