From e7327374922f44ef5d9cc82b596a5a57632b5295 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?=D0=90=D1=80=D1=82=D1=91=D0=BC=20=D0=97=D0=B0=D0=BF=D0=B5?= =?UTF-8?q?=D0=B2=D0=B0=D0=BB=D0=BE=D0=B2?= Date: Thu, 22 Jun 2023 08:32:39 +0000 Subject: [PATCH] =?UTF-8?q?=D0=93=D0=BE=D1=82=D0=BE=D0=B2=D1=8B=D0=B9=20?= =?UTF-8?q?=D0=B8=D0=B7=D0=BC=D0=B5=D0=BD=D1=91=D0=BD=D0=BD=D1=8B=D0=B9=20?= =?UTF-8?q?modbus?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- modbus/modbus.c | 437 +++++++++++++++++------------------------------- 1 file changed, 153 insertions(+), 284 deletions(-) diff --git a/modbus/modbus.c b/modbus/modbus.c index e716db8..e415f6f 100644 --- a/modbus/modbus.c +++ b/modbus/modbus.c @@ -1,284 +1,153 @@ -#include - -unsigned int CRC16_Modbus(unsigned char* buf, int len) -{ - unsigned int crc = 0xFFFF; - for (int pos = 0; pos < len; pos++) - { - crc ^= (unsigned int)buf[pos]; // XOR-байт в наименьший sig. байт crc - for (int i = 8; i != 0; i--) // Повторите цикл над каждым битом - { - if ((crc & 0x0001) != 0) // Если установлен LSB - { - crc >>= 1; // Сдвиг вправо и XOR 0xA001 - crc ^= 0xA001; - } - else // В противном случае LSB не установлен - { - crc >>= 1; // Сдвиг вправо - } - } - } - crc = ((crc & 0x00ff) << 8) | ((crc & 0xff00) >> 8); // преобразование младших байтов - return crc; -} - -size_t read_coil_status(uint8_t address, uint16_t discret_input, unint8_t* buf, size_t buf_len) -{ - int i = 0; - buf[i] = address; - i++; - buf[i] = 0x01; - i++; - buf[i] = (discret_input >> 8) & 0xFF; - i++; - buf[i] = discret_input & 0xFF; - i++; - buf[i] = 0x00; - i++; - buf[i] = 0x01; - i++; - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} - -size_t read_coil_status_ans(unit8_t address, uint8_t meaning, unint8_t* buf, size_t buf_len) -{ - n = 0; - buf[n] = address; - n++; - buf[n] = 0x01; - n++; - buf[n] = 0x01; - n++; - buf[n] = meaning; - n++; - crc_otv = CRC16_Modbus(buf, n); - buf[n] = crc_otv & 0xFF; - i++; - buf[n] = (crc_otv >> 8) & 0xFF; - i++; - return n; -} - -size_t read_input_status(uint8_t address, uint16_t discret_input, unint8_t* buf, size_t buf_len) -{ - int i=0; - buf[i] = address; - i++; - buf[i] = 0x02; - i++; - buf[i] = (discret_input >>8)&0xFF; - i++; - buf[i] = discret_input&0xFF; - i++; - buf[i] = 0x00; - i++; - buf[i] = 0x01; - i++; - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} - -size_t read_input_status_ans(unit8_t address, uint8_t meaning, unint8_t* buf, size_t buf_len) -{ - n = 0; - buf[n] = address; - n++; - buf[n] = 0x02; - n++; - buf[n] = 0x01; - n++; - buf[n] = meaning; - n++; - crc_otv = CRC16_Modbus(buf, n); - buf[n] = crc_otv & 0xFF; - i++; - buf[n] = (crc_otv >> 8) & 0xFF; - i++; - return n; -} - -size_t read_holding_register(uint8_t address, uint16_t holding_reg, unint8_t* buf, size_t buf_len) -{ - int i = 0; - buf[i] = address; - i++; - buf[i] = 0x03; - i++; - buf[i] = (holding_reg >> 8) & 0xFF; - i++; - buf[i] = holding_reg & 0xFF; - i++; - buf[i] = 0x00; - i++; - buf[i] = 0x01; - i++; - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} - -size_t read_holding_register_ans(unit8_t address, uint8_t meaning, unint8_t* buf, size_t buf_len) -{ - n = 0; - buf[n] = address; - n++; - buf[n] = 0x03; - n++; - buf[n] = 0x01; - n++; - buf[n] = meaning; - n++; - crc_otv = CRC16_Modbus(buf, n); - buf[n] = crc_otv & 0xFF; - i++; - buf[n] = (crc_otv >> 8) & 0xFF; - i++; - return n; -} - -size_t read_input_register(uint8_t address, uint16_t input_reg, unint8_t* buf, size_t buf_len) -{ - int i = 0; - buf[i] = address; - i++; - buf[i] = 0x04; - i++; - buf[i] = (input_reg >> 8) & 0xFF; - i++; - buf[i] = input_reg & 0xFF; - i++; - buf[i] = 0x00; - i++; - buf[i] = 0x01; - i++; - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} - -size_t read_input_register_ans(unit8_t address, uint8_t meaning, unint8_t* buf, size_t buf_len) -{ - n = 0; - buf[n] = address; - n++; - buf[n] = 0x04; - n++; - buf[n] = 0x01; - n++; - buf[n] = meaning; - n++; - crc_otv = CRC16_Modbus(buf, n); - buf[n] = crc_otv & 0xFF; - i++; - buf[n] = (crc_otv >> 8) & 0xFF; - i++; - return n; -} - -size_t forse_single_coil(unit8_t address, uint16_t address_input, int on, unint8_t* buf, size_t buf_len) -{ - int i = 0; - buf[i] = address; - i++; - buf[i] = 0x05; - i++; - buf[i] = (address_input >> 8)&0xFF; - i++; - buf[i] = address_input & 0xFF; - i++; - buf[i] = on ? 0xFF : 0x00; - i++; - buf[i] = 0x00; - i++ - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} - -size_t forse_single_coil_ans(unit8_t address, uint16_t address_input, int on, unint8_t* buf, size_t buf_len) -{ - int i = 0; - buf[i] = address; - i++; - buf[i] = 0x05; - i++; - buf[i] = (address_input >> 8) & 0xFF; - i++; - buf[i] = address_input & 0xFF; - i++; - buf[i] = on ? 0xFF : 0x00; - i++; - buf[i] = 0x00; - i++ - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} - -size_t preset_single_register(unit8_t address, uint16_t address_input, uint16_t recorded_value, unint8_t* buf, size_t buf_len) -{ - int i = 0; - buf[i] = address; - i++; - buf[i] = 0x06; - i++; - buf[i] = (address_input >> 8) & 0xFF; - i++; - buf[i] = address_input & 0xFF; - i++; - buf[i] = (recorded_value >> 8) & 0xFF; - i++; - buf[i] = recorded_value & 0xFF; - i++; - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} - -size_t preset_single_register_ans(unit8_t address, uint16_t address_input, uint16_t recorded_value, unint8_t* buf, size_t buf_len) -{ - int i = 0; - buf[i] = address; - i++; - buf[i] = 0x06; - i++; - buf[i] = (address_input >> 8) & 0xFF; - i++; - buf[i] = address_input & 0xFF; - i++; - buf[i] = (recorded_value >> 8) & 0xFF; - i++; - buf[i] = recorded_value & 0xFF; - i++; - crc = CRC16_Modbus(buf, i); - buf[i] = crc & 0xFF; - i++; - buf[i] = (crc >> 8) & 0xFF; - i++; - return i; -} \ No newline at end of file +#include +#include + +unsigned int CRC16_Modbus(unsigned char* buf, int len) +{ + unsigned int crc = 0xFFFF; + for (int pos = 0; pos < len; pos++) + { + crc ^= (unsigned int)buf[pos]; // XOR-байт в наименьший sig. байт crc + for (int i = 8; i != 0; i--) // Повторите цикл над каждым битом + { + if ((crc & 0x0001) != 0) // Если установлен LSB + { + crc >>= 1; // Сдвиг вправо и XOR 0xA001 + crc ^= 0xA001; + } + else // В противном случае LSB не установлен + { + crc >>= 1; // Сдвиг вправо + } + } + } + crc = ((crc & 0x00ff) << 8) | ((crc & 0xff00) >> 8); // преобразование младших байтов + return crc; +} + +size_t read_input_status(uint8_t address, uint16_t discret_input, uint16_t quantity_reg, uint8_t* buf, size_t buf_len) +{ + int i=0; + buf[i] = address; + i++; + buf[i] = 0x02; + i++; + buf[i] = (discret_input >>8)&0xFF; + i++; + buf[i] = discret_input&0xFF; + i++; + buf[i] = (quantity_reg >> 8) & 0xFF; + i++; + buf[i] = quantity_reg & 0xFF; + i++; + uint16_t crc = CRC16_Modbus(buf, i); + buf[i] = crc & 0xFF; + i++; + buf[i] = (crc >> 8) & 0xFF; + i++; + return i; +} + +int read_input_status_parse(uint8_t* buf, size_t buf_len, uint8_t* meaning) +{ + if (buf_len < 8) { + // Недостаточная длина ответа + return 0; + } + // Проверка контрольной суммы + uint16_t crc = CRC16_Modbus(buf, buf_len - 2); + uint16_t received_crc = buf[buf_len - 2] + (buf[buf_len - 1] << 8); + + if (crc != received_crc) { + // Контрольная сумма не совпадает + return 0; + } + + *meaning = buf[buf_len - 5]; + return 1; +} + +size_t read_input_register(uint8_t address, uint16_t input_reg, uint8_t* buf, size_t buf_len) +{ + int i = 0; + buf[i] = address; + i++; + buf[i] = 0x04; + i++; + buf[i] = (input_reg >> 8) & 0xFF; + i++; + buf[i] = input_reg & 0xFF; + i++; + buf[i] = 0x00; + i++; + buf[i] = 0x01; + i++; + uint16_t crc = CRC16_Modbus(buf, i); + buf[i] = crc & 0xFF; + i++; + buf[i] = (crc >> 8) & 0xFF; + i++; + return i; +} + +int read_input_register_parse(uint8_t* buf, size_t buf_len , uint16_t* meaning) +{ + if (buf_len < 5) { + // Недостаточная длина ответа + return 0; + } + + // Проверка контрольной суммы + uint16_t crc = CRC16_Modbus(buf, buf_len - 2); + uint16_t received_crc = buf[buf_len - 2] + (buf[buf_len - 1] << 8); + + if (crc != received_crc) { + // Контрольная сумма не совпадает + return 0; + } + + *meaning = buf[buf_len - 3] + (buf[buf_len - 4] << 8); + return 1; +} + +size_t forse_single_coil(uint8_t address, uint16_t address_input, int on, uint8_t* buf, size_t buf_len) +{ + int i = 0; + buf[i] = address; + i++; + buf[i] = 0x05; + i++; + buf[i] = (address_input >> 8)&0xFF; + i++; + buf[i] = address_input & 0xFF; + i++; + buf[i] = on ? 0xFF : 0x00; + i++; + buf[i] = 0x00; + i++; + uint16_t crc = CRC16_Modbus(buf, i); + buf[i] = crc & 0xFF; + i++; + buf[i] = (crc >> 8) & 0xFF; + i++; + return i; +} + +int forse_single_coil_parse(uint8_t* buf, size_t buf_len) +{ + if (buf_len < 8) { + // Недостаточная длина ответа + return 0; + } + + // Проверка контрольной суммы + uint16_t crc = CRC16_Modbus(buf, buf_len - 2); + uint16_t received_crc = buf[buf_len - 2] + (buf[buf_len - 1] << 8); + + if (crc != received_crc) { + // Контрольная сумма не совпадает + return 0; + } + + + return 1; +}