Merge pull request #115 from robotics-in-concert/opp

latch topic solves the racing condition.
bugfix a used variable before definition.
put the shutdown hook in the initialisation.
merging with hydro-devel