Merge pull request #58 from mlosch/master

publish compass direction under /pose/compass. Implements
untested tsp
Merge remote-tracking branch 'upstream/master'
remove testcase from graph