Created better test
Merge branch 'indigo-devel' of github.com:davetcoleman/moveit_visual_tools into indigo-devel