Add check for planning scene monitor connection, with 5 sec delay
Improved error messages
Merge branch 'get_planning_scene_check' of github.com:davetcoleman/moveit_ros into get_planning_scene_check