/// <summary> /// Writes SD20 mode into proper registry /// </summary> /// <param name="offset"></param> /// <param name="variation"></param> private void SetMode(int offset, byte variation) { Endianity.GetBytes(offset, _dataBuffer, ByteOrder.BigEndian); _slave.WriteRegister(SD20ServoDriver.REG_EXTENDED_MODE_CTRL, variation); _slave.WriteRegister(SD20ServoDriver.REG_EXTENDED_MODE_HIGH, _dataBuffer[0]); _slave.WriteRegister(SD20ServoDriver.REG_EXTENDED_MODE_LOW, _dataBuffer[1]); }