fix issue with mode switching between velociy and postion
Merge pull request #1 from rethink-cgindel/fix_mode_switching

fix issue with mode switching between velocity and position