ICS-Microprocessor-2020/Modbus_master_2
3
0
Fork 1
Code Issues 6 Pull Requests Projects Releases Wiki Activity

Готовый изменённый modbus

Browse Source
This commit is contained in:
Артём Запевалов 2023-06-22 08:32:39 +00:00
parent 8d93309a9a
commit e732737492
1 changed files with 153 additions and 284 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

249
modbus/modbus.c
View File

@ -1,4 +1,5 @@
#include <stdint.h> #include <stdint.h>
#include <string.h>
unsigned int CRC16_Modbus(unsigned char* buf, int len) unsigned int CRC16_Modbus(unsigned char* buf, int len)
{ {
@ -23,49 +24,7 @@ unsigned int CRC16_Modbus(unsigned char* buf, int len)
return crc; return crc;
} }
size_t read_coil_status(uint8_t address, uint16_t discret_input, unint8_t* buf, size_t buf_len) 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] = 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; int i=0;
buf[i] = address; buf[i] = address;
@ -76,11 +35,11 @@ size_t read_input_status(uint8_t address, uint16_t discret_input, unint8_t* buf,
i++; i++;
buf[i] = discret_input&0xFF; buf[i] = discret_input&0xFF;
i++; i++;
buf[i] = 0x00; buf[i] = (quantity_reg >> 8) & 0xFF;
i++;
buf[i] = 0x01;
i++; i++;
crc = CRC16_Modbus(buf, i); buf[i] = quantity_reg & 0xFF;
i++;
uint16_t crc = CRC16_Modbus(buf, i);
buf[i] = crc & 0xFF; buf[i] = crc & 0xFF;
i++; i++;
buf[i] = (crc >> 8) & 0xFF; buf[i] = (crc >> 8) & 0xFF;
@ -88,68 +47,26 @@ size_t read_input_status(uint8_t address, uint16_t discret_input, unint8_t* buf,
return i; return i;
} }
size_t read_input_status_ans(unit8_t address, uint8_t meaning, unint8_t* buf, size_t buf_len) int read_input_status_parse(uint8_t* buf, size_t buf_len, uint8_t* meaning)
{ {
n = 0; if (buf_len < 8) {
buf[n] = address; // Недостаточная длина ответа
n++; return 0;
buf[n] = 0x02; }
n++; // Проверка контрольной суммы
buf[n] = 0x01; uint16_t crc = CRC16_Modbus(buf, buf_len - 2);
n++; uint16_t received_crc = buf[buf_len - 2] + (buf[buf_len - 1] << 8);
buf[n] = meaning;
n++; if (crc != received_crc) {
crc_otv = CRC16_Modbus(buf, n); // Контрольная сумма не совпадает
buf[n] = crc_otv & 0xFF; return 0;
i++; }
buf[n] = (crc_otv >> 8) & 0xFF;
i++; *meaning = buf[buf_len - 5];
return n; return 1;
} }
size_t read_holding_register(uint8_t address, uint16_t holding_reg, unint8_t* buf, size_t buf_len) 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] = 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; int i = 0;
buf[i] = address; buf[i] = address;
@ -164,7 +81,7 @@ size_t read_input_register(uint8_t address, uint16_t input_reg, unint8_t* buf, s
i++; i++;
buf[i] = 0x01; buf[i] = 0x01;
i++; i++;
crc = CRC16_Modbus(buf, i); uint16_t crc = CRC16_Modbus(buf, i);
buf[i] = crc & 0xFF; buf[i] = crc & 0xFF;
i++; i++;
buf[i] = (crc >> 8) & 0xFF; buf[i] = (crc >> 8) & 0xFF;
@ -172,26 +89,27 @@ size_t read_input_register(uint8_t address, uint16_t input_reg, unint8_t* buf, s
return i; return i;
} }
size_t read_input_register_ans(unit8_t address, uint8_t meaning, unint8_t* buf, size_t buf_len) int read_input_register_parse(uint8_t* buf, size_t buf_len , uint16_t* meaning)
{ {
n = 0; if (buf_len < 5) {
buf[n] = address; // Недостаточная длина ответа
n++; return 0;
buf[n] = 0x04; }
n++;
buf[n] = 0x01; // Проверка контрольной суммы
n++; uint16_t crc = CRC16_Modbus(buf, buf_len - 2);
buf[n] = meaning; uint16_t received_crc = buf[buf_len - 2] + (buf[buf_len - 1] << 8);
n++;
crc_otv = CRC16_Modbus(buf, n); if (crc != received_crc) {
buf[n] = crc_otv & 0xFF; // Контрольная сумма не совпадает
i++; return 0;
buf[n] = (crc_otv >> 8) & 0xFF; }
i++;
return n; *meaning = buf[buf_len - 3] + (buf[buf_len - 4] << 8);
return 1;
} }
size_t forse_single_coil(unit8_t address, uint16_t address_input, int on, unint8_t* buf, size_t buf_len) size_t forse_single_coil(uint8_t address, uint16_t address_input, int on, uint8_t* buf, size_t buf_len)
{ {
int i = 0; int i = 0;
buf[i] = address; buf[i] = address;
@ -205,8 +123,8 @@ size_t forse_single_coil(unit8_t address, uint16_t address_input, int on, unint8
buf[i] = on ? 0xFF : 0x00; buf[i] = on ? 0xFF : 0x00;
i++; i++;
buf[i] = 0x00; buf[i] = 0x00;
i++ i++;
crc = CRC16_Modbus(buf, i); uint16_t crc = CRC16_Modbus(buf, i);
buf[i] = crc & 0xFF; buf[i] = crc & 0xFF;
i++; i++;
buf[i] = (crc >> 8) & 0xFF; buf[i] = (crc >> 8) & 0xFF;
@ -214,71 +132,22 @@ size_t forse_single_coil(unit8_t address, uint16_t address_input, int on, unint8
return 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 forse_single_coil_parse(uint8_t* buf, size_t buf_len)
{ {
int i = 0; if (buf_len < 8) {
buf[i] = address; // Недостаточная длина ответа
i++; return 0;
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) // Проверка контрольной суммы
{ uint16_t crc = CRC16_Modbus(buf, buf_len - 2);
int i = 0; uint16_t received_crc = buf[buf_len - 2] + (buf[buf_len - 1] << 8);
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) if (crc != received_crc) {
{ // Контрольная сумма не совпадает
int i = 0; return 0;
buf[i] = address; }
i++;
buf[i] = 0x06;
i++; return 1;
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;
} }