pmiping the teleop pimp.
pimp done, but needs testing with the interaction.
Merge branch 'indigo' into hydro-devel