add getCollisionRobotUnpaddedNonConst

add getCollisionRobotUnpaddedNonConst, https://github.com/ros-planning/moveit_ros/issues/341 need this interface.