#include "modbusRtuMaster.h" #include "w5500/modbusSlave.h" #include "w5500/modbus_crc.h" #include "usart.h" #include "gpio.h" #include "rtuMaster.h" 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(RtuMaster *master, rtumST myRtumST[20]) { 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; } }