Control improvement. Avoid movement with stops.
Merge branch 'hydro_devel' of https://github.com/penalvea/irs-ros-pkg into hydro_devel