chmod +x
updated sdp_ompl_ros