added goal existance checks
Merge branch 'groovy-devel' of https://github.com/ros-planning/moveit_ros into groovy-devel