Initialization maneuver
Initial localization
Merge branch 'hydro-devel' of https://github.com/robotics-in-concert/rocon_demos.git into hydro-devel