fix twist_control dimensions for any-DoF
Merge pull request #7 from ipa-fxm/indigo_new_structure

fix twist_control dimensions for any-DoF