Приложение для управления устройством по modbus RTU

 public class TModBus
    {
        List<byte> buff;
        public const ushort myPolinom = 0xA001;
 
        public TModBus()
        {
            buff = new List<byte>();
        }
 
        public byte[] getFirmCommand(byte com, byte[] data, byte adr)
        {
            ushort crcMdb;
            buff.Clear();
            buff.Add(adr);
            buff.Add(0x42);
            buff.Add(com);
            if (data != null)
                for (int i = 0; i < data.Length; i++)
                    buff.Add(data[i]);
            crcMdb = getCrc(buff.ToArray());
            buff.Add((byte)(crcMdb & 0xFF));
            buff.Add((byte)((crcMdb >> 8) & 0xFF));
            return buff.ToArray();
        }
 
        ushort getCrc(byte[] mdbBuf)
        {
            ushort crc;
            byte tmpB;
            crc = 0xFFFF;
            for (int i = 0; i < mdbBuf.Length; i++)
            {
                tmpB = mdbBuf[i];
                for (int j = 0; j < 8; j++)
                {
                    crc = (ushort)(crc ^ (tmpB & 1));
                    if ((crc & 1) != 0)
                        crc = (ushort)((crc >> 1) ^ myPolinom);
                    else
                        crc = (ushort)(crc >> 1);
                    tmpB = (byte)(tmpB >> 1);
                }
            }
            return crc;
        }
    }

 // sp это у меня SerialPort sp = new SerialPort
 
 private void BuildMessage(byte address, byte type, ushort start, ushort registers, ref byte[] message)
 {
            // Массив для CRC bytes:
            byte[] CRC = new byte[2];
 
            message[0] = address;
            message[1] = type;
            message[2] = (byte)(start >> 8);
            message[3] = (byte)start;
            message[4] = (byte)(registers >> 8);
            message[5] = (byte)registers;
            
            // Функция подсчета CRC
            GetCRC(message, ref CRC);
            message[message.Length - 2] = CRC[0];
            message[message.Length - 1] = CRC[1];
 }
 
 public bool SendFc16(byte address, ushort start, ushort registers, short[] values)
        {
                // Проверяю открыт ли порт
                if (sp.IsOpen)
                {
                    //Очишаю буфер
                    sp.DiscardOutBuffer();
                    sp.DiscardInBuffer();
                    //Сообщение 1 адрес + 1 функция + 2 старт + 2 регистр + 1 счетчик + 2 * значение регистров + 2 CRC
                    byte[] message = new byte[9 + 2 * registers];
                    //ответ 16 функции фиксированный и занимает 8 байт
                    byte[] response = new byte[8];
 
                    // Счетчик байт в сообщении:
                    message[6] = (byte)(registers * 2);
                    // Пишем:
                    for (int i = 0; i < registers; i++)
                    {
                        message[7 + 2 * i] = (byte)(values[i] >> 8);
                        message[8 + 2 * i] = (byte)(values[i]);
                    }
                    //Наше сообщение:
                    BuildMessage(address, (byte)16, start, registers, ref message);
                }
                
                if (ну тут организация проверки записи)
                {
                    // Запись успешна;
                    return true;
                }
                else
                {
                    // Ошибка CRC;
                    return false;
                }
        }

 BuildMessage(address, (byte)16, start, registers, ref message);

 BuildMessage(address, (byte)6, start, registers, ref message);

 // Счетчик байт в сообщении:
                    message[6] = (byte)(registers * 2);
                    // Пишем:
                    for (int i = 0; i < registers; i++)
                    {
                        message[7 + 2 * i] = (byte)(values[i] >> 8);
                        message[8 + 2 * i] = (byte)(values[i]);
                    }