Готовый изменённый modbus
This commit is contained in:
parent
8d93309a9a
commit
e732737492
437
modbus/modbus.c
437
modbus/modbus.c
@ -1,284 +1,153 @@
|
||||
#include <stdint.h>
|
||||
|
||||
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;
|
||||
}
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
|
||||
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;
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue
Block a user