add check-state-validity service and fix minor bug
Merge pull request #78 from YoheiKakiuchi/fix_pr2eus_moveit

add check-state-validity service and fix minor bug