fix teleop for 3DOF torso
Merge pull request #32 from ipa-cob3-3/groovy_dev

fix teleop for 3DOF torso