Merge pull request #34 from mlosch/master

first revision of graph implementation with a service node
do not wait 3sec after turning
launch file that starts EVERYTHING
Merge remote-tracking branch 'upstream/master'
fix ir theta according to general direction
add constants to msg and srv