added velocity and position controllers
Merge pull request #118 from ipa-nhg/indigo_dev

added velocity and position controllers