Merge pull request #50 from mlosch/master

Make graph less susceptible to spam and noisy data
publish compass direction under /pose/compass