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

added velocity and position controllers