adds grapher tests
adds test_grapher to catkins rostest