Added DriveTo command to drive a distane using encoders in position mode.