first attempt to decrease odometry drift by adding ir sensors
first revision of graph implementation with a service node. added necessary messages and serives. graph structure tested.
Merge pull request #34 from mlosch/master

first revision of graph implementation with a service node