TM 95%working version
Merge branch 'hydro-devel' of https://github.com/robotics-in-concert/rocon_taskcoordinator into hydro-devel