Update to setCtrlMode

The position control mode was not being handled correctly