/// <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]);
}
