171 lines
5.8 KiB
C
171 lines
5.8 KiB
C
#include "w5500/modbusSlave.h"
|
|
#include "w5500/modbus_crc.h"
|
|
#include "usart.h"
|
|
#include "gpio.h"
|
|
#include "rtuMaster.h"
|
|
|
|
rtumST readST[10] = { { .slave_id = 0, .slave_address = 1, .plc_address = 2, .size = 3 }, { .slave_id = 4, .slave_address = 5, .plc_address = 6, .size = 7 }, {
|
|
.slave_id = 8, .slave_address = 9, .plc_address = 10, .size = 11 }, { .slave_id = 12, .slave_address = 13, .plc_address = 14, .size = 15 }, {
|
|
.slave_id = 16, .slave_address = 17, .plc_address = 18, .size = 19 }, { .slave_id = 20, .slave_address = 21, .plc_address = 22, .size = 23 }, {
|
|
.slave_id = 24, .slave_address = 25, .plc_address = 26, .size = 27 }, { .slave_id = 28, .slave_address = 29, .plc_address = 30, .size = 31 }, {
|
|
.slave_id = 32, .slave_address = 33, .plc_address = 34, .size = 35 }, { .slave_id = 36, .slave_address = 37, .plc_address = 38, .size = 39 } };
|
|
|
|
rtumST writeST[10] = { { .slave_id = 40, .slave_address = 41, .plc_address = 42, .size = 43 }, { .slave_id = 44, .slave_address = 45, .plc_address = 46, .size =
|
|
47 }, { .slave_id = 48, .slave_address = 49, .plc_address = 50, .size = 51 }, { .slave_id = 52, .slave_address = 53, .plc_address = 54, .size = 55 }, {
|
|
.slave_id = 56, .slave_address = 57, .plc_address = 58, .size = 59 }, { .slave_id = 60, .slave_address = 61, .plc_address = 62, .size = 63 }, {
|
|
.slave_id = 64, .slave_address = 65, .plc_address = 66, .size = 67 }, { .slave_id = 68, .slave_address = 69, .plc_address = 70, .size = 71 }, {
|
|
.slave_id = 72, .slave_address = 73, .plc_address = 74, .size = 75 }, { .slave_id = 76, .slave_address = 77, .plc_address = 78, .size = 79 } };
|
|
|
|
rtumST myRtumST[20];
|
|
|
|
RtuMaster master = { .localStartIdx = 1000 };
|
|
|
|
void initRtuMaster() {
|
|
for (int i = 0; i < 10; i++) {
|
|
myRtumST[i * 2] = readST[i];
|
|
myRtumST[i * 2 + 1] = writeST[i];
|
|
}
|
|
|
|
if (master.isMaster) {
|
|
RE_RESET;
|
|
HAL_UARTEx_ReceiveToIdle_DMA(&huart1, master.rxbuf, 255);
|
|
}
|
|
HAL_GPIO_WritePin(comm485_GPIO_Port, comm485_Pin, GPIO_PIN_SET);
|
|
}
|
|
|
|
typedef union {
|
|
uint16_t val16;
|
|
uint8_t bytes[2];
|
|
} Uint16To8;
|
|
Uint16To8 cvt;
|
|
|
|
static uint8_t idx = 0;
|
|
static uint16_t slave_id, slave_address, size;
|
|
|
|
void RTU_Master_Loop() {
|
|
if (master.isMaster) {
|
|
for (int j = 0; j < 20; j++) {
|
|
slave_id = get_register(myRtumST[j].slave_id);
|
|
slave_address = get_register(myRtumST[j].slave_address);
|
|
size = get_register(myRtumST[j].size);
|
|
if (slave_id == master.localSlaveId) {
|
|
set_register(120, j);
|
|
set_register(121, slave_id);
|
|
set_register(122, slave_address);
|
|
set_register(123, size);
|
|
if (j % 2 == 0) {
|
|
for (int i = 0; i < size; i++) {
|
|
set_register(j * 20 + master.localStartIdx + i, get_register(slave_address + i));
|
|
}
|
|
} else {
|
|
for (int i = 0; i < size; i++) {
|
|
set_register(slave_address + i, get_register(j * 20 + master.localStartIdx + i));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (master.timeout >= 1000) {
|
|
slave_id = get_register(myRtumST[idx].slave_id);
|
|
slave_address = get_register(myRtumST[idx].slave_address);
|
|
size = get_register(myRtumST[idx].size);
|
|
|
|
if (slave_id == 0 || slave_id >= 127 || size > 20 || size == 0 || slave_id != master.localSlaveId) {
|
|
master.txsize = 0;
|
|
} else {
|
|
if (idx % 2 == 0) {
|
|
master.txbuf[0] = slave_id;
|
|
master.txbuf[1] = 0x03;
|
|
cvt.val16 = slave_address;
|
|
master.txbuf[2] = cvt.bytes[1];
|
|
master.txbuf[3] = cvt.bytes[0];
|
|
cvt.val16 = size;
|
|
master.txbuf[4] = cvt.bytes[1];
|
|
master.txbuf[5] = cvt.bytes[0];
|
|
cvt.val16 = crc16(master.txbuf, 6);
|
|
master.txbuf[6] = cvt.bytes[0];
|
|
master.txbuf[7] = cvt.bytes[1];
|
|
master.txsize = 8;
|
|
} else {
|
|
master.txbuf[0] = slave_id;
|
|
master.txbuf[1] = 0x10;
|
|
cvt.val16 = slave_address;
|
|
master.txbuf[2] = cvt.bytes[1];
|
|
master.txbuf[3] = cvt.bytes[0];
|
|
cvt.val16 = size;
|
|
master.txbuf[4] = cvt.bytes[1];
|
|
master.txbuf[5] = cvt.bytes[0];
|
|
master.txbuf[6] = size * 2;
|
|
|
|
for (uint8_t i = 0; i < size; i++) {
|
|
cvt.val16 = get_register(idx * 20 + master.localStartIdx + i);
|
|
master.txbuf[2 * i + 7] = cvt.bytes[1];
|
|
master.txbuf[2 * i + 8] = cvt.bytes[0];
|
|
}
|
|
|
|
cvt.val16 = crc16(master.txbuf, size * 2 + 7);
|
|
master.txbuf[size * 2 + 7] = cvt.bytes[0];
|
|
master.txbuf[size * 2 + 8] = cvt.bytes[1];
|
|
master.txsize = 2 * size + 9;
|
|
}
|
|
}
|
|
|
|
if (master.txsize > 0) {
|
|
HAL_GPIO_WritePin(re485_GPIO_Port, re485_Pin, GPIO_PIN_SET);
|
|
HAL_UART_Transmit_DMA(&huart1, master.txbuf, master.txsize);
|
|
master.timeout = 1;
|
|
} else {
|
|
master.timeout = 1000;
|
|
}
|
|
|
|
idx = (idx + 1) % 20;
|
|
}
|
|
|
|
if (master.rxdone) {
|
|
cvt.bytes[0] = master.rxbuf[master.rxsize - 2];
|
|
cvt.bytes[1] = master.rxbuf[master.rxsize - 1];
|
|
if (crc16(master.rxbuf, master.rxsize - 2) != cvt.val16) {
|
|
return;
|
|
}
|
|
if (master.rxbuf[1] == 0x03) {
|
|
uint16_t size = master.rxbuf[2] / 2;
|
|
size = size >= 20 ? 20 : size;
|
|
for (int i = 0; i < size; i++) {
|
|
cvt.bytes[0] = master.rxbuf[2 * i + 4];
|
|
cvt.bytes[1] = master.rxbuf[2 * i + 3];
|
|
if (idx == 0) {
|
|
set_register(master.localStartIdx + i + (20 * 19), cvt.val16);
|
|
} else {
|
|
set_register(master.localStartIdx + i + (20 * (idx - 1)), cvt.val16);
|
|
}
|
|
|
|
}
|
|
}
|
|
master.rxdone = 0;
|
|
master.timeout = 950;
|
|
}
|
|
} else {
|
|
if (master.rxdone) {
|
|
HAL_GPIO_TogglePin(comm485_GPIO_Port, comm485_Pin);
|
|
handleModbusRtu_NEW(master.rxbuf, master.rxbuf, master.rxsize, &huart1);
|
|
master.rxdone = 0;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
|
|
void HAL_UART_TxCpltCallback(UART_HandleTypeDef *huart) {
|
|
if (huart == &huart1) {
|
|
RE_RESET;
|
|
HAL_UARTEx_ReceiveToIdle_DMA(&huart1, master.rxbuf, 255);
|
|
}
|
|
}
|
|
|
|
void HAL_UARTEx_RxEventCallback(UART_HandleTypeDef *huart, uint16_t Size) {
|
|
if (huart == &huart1) {
|
|
master.rxdone = 1;
|
|
master.rxsize = Size;
|
|
}
|
|
}
|