public void SetTargetPos(float pos)
{
if (_controlMode != ControlMode.MotionMagic)
{
SetupPositionServo();
}
_gearBox.Set(_controlMode, pos);
}
public void SetTargetPos(float pos)
{
if (_controlMode != ControlMode.kPosition)
{
SetupPositionServo();
}
_gearBox.Set(pos, _controlMode);
}