refactor: 分文件重构,新建protocols文件夹,三个协议分文件存放:modbustcpslave/finsudpmaster/slmptcpmaster,结构更清晰

This commit is contained in:
claw committed 2026-04-02 22:35:56 +08:00
1 parent 99fa72eaa0
commit e3519bf1f4
8 files changed
+852 -741

No files matched your search

+243
View File
@@ -0,0 +1,243 @@
/*
* modbustcpslave.c
* Modbus TCP从站服务
*/
#include "modbustcpslave.h"
#include "socket.h"
#include "wizchip_conf.h"
#include "modbusSlave.h"
#include "modbus_crc.h"
#include "usart.h"
#include <string.h>
#include "gpio.h"
uint8_t loopback_tcps_modbus_rxbuf[1024];
uint8_t loopback_tcps_modbus_txbuf[1024];
// 将Modbus TCP转RTU (转发到485)
uint16_t tcp_to_rtu(uint8_t *tcp_buf, uint8_t *rtu_buf) {
uint16_t len = ((tcp_buf[4] << 8) | tcp_buf[5]) - 1; // 去掉UnitID前的长度
memcpy(rtu_buf, &tcp_buf[6], len + 1); // 从UnitID开始拷贝
uint16_t crc = crc16(rtu_buf, len + 1);
rtu_buf[len + 1] = crc & 0xFF;
rtu_buf[len + 2] = (crc >> 8) & 0xFF;
return len + 3; // 返回总长度
}
// 将Modbus RTU转TCP (从485转发回TCP)
uint16_t rtu_to_tcp(uint8_t *rtu_buf, uint8_t *tcp_buf, uint16_t rtu_len, uint8_t *rx_buf) {
uint16_t crc_calc = crc16(rtu_buf, rtu_len - 2);
uint16_t crc_recv = rtu_buf[rtu_len - 2] | (rtu_buf[rtu_len - 1] << 8);
if (crc_calc != crc_recv) {
return 0; // CRC错误
}
// 还原MBAP头
memcpy(tcp_buf, rx_buf, 6); // Transaction ID, Protocol ID, Length先拷贝
tcp_buf[6] = rtu_buf[0]; // UnitID
memcpy(&tcp_buf[7], &rtu_buf[1], rtu_len - 3); // 功能码+数据
uint16_t pdu_len = rtu_len - 3; // PDU长度
uint16_t mbap_len = pdu_len + 1; // 必须 +1 包含 UnitID
tcp_buf[4] = (mbap_len >> 8) & 0xFF;
tcp_buf[5] = (mbap_len) & 0xFF;
return 7 + pdu_len; // MBAP(7) + PDU
}
enum {
STATE_IDLE, STATE_WAIT_RTU
} modbus_state = STATE_IDLE;
// Modbus TCP服务主函数
int32_t loopback_tcps_modbus(uint8_t sn, uint16_t port) {
int32_t ret;
uint16_t size = 0, sentsize = 0;
#ifdef _LOOPBACK_DEBUG_
uint8_t destip[4];
uint16_t destport;
#endif
switch (getSn_SR(sn)) {
case SOCK_ESTABLISHED:
if (getSn_IR(sn) & Sn_IR_CON) {
#ifdef _LOOPBACK_DEBUG_
getSn_DIPR(sn, destip);
destport = getSn_DPORT(sn);
printf("%d:Connected - %d.%d.%d.%d : %d\r\n", sn, destip[0],
destip[1], destip[2], destip[3], destport);
#endif
setSn_IR(sn, Sn_IR_CON);
}
if ((size = getSn_RX_RSR(sn)) > 0) {
if (size > DATA_BUF_SIZE)
size = DATA_BUF_SIZE;
ret = recv(sn, loopback_tcps_modbus_rxbuf, size);
if (ret <= 0)
return ret;
uint16_t rxbuf_size = handleModbusTcp(loopback_tcps_modbus_rxbuf, loopback_tcps_modbus_txbuf);
if (rxbuf_size > 0) {
sentsize = 0;
while (rxbuf_size != sentsize) {
ret = send(sn, loopback_tcps_modbus_txbuf + sentsize, rxbuf_size - sentsize);
if (ret < 0) {
close(sn);
return ret;
}
sentsize += ret;
}
}
}
break;
case SOCK_CLOSE_WAIT:
#ifdef _LOOPBACK_DEBUG_
//printf("%d:CloseWait\r\n",sn);
#endif
if ((ret = disconnect(sn)) != SOCK_OK)
return ret;
#ifdef _LOOPBACK_DEBUG_
printf("%d:Socket Closed\r\n", sn);
#endif
break;
case SOCK_INIT:
#ifdef _LOOPBACK_DEBUG_
printf("%d:Listen, TCP server loopback, port [%d]\r\n", sn, port);
#endif
if ((ret = listen(sn)) != SOCK_OK)
return ret;
break;
case SOCK_CLOSED:
#ifdef _LOOPBACK_DEBUG_
//printf("%d:TCP server loopback start\r\n",sn);
#endif
if ((ret = socket(sn, Sn_MR_TCP, port, 0x00)) != sn)
return ret;
#ifdef _LOOPBACK_DEBUG_
//printf("%d:Socket opened\r\n",sn);
#endif
break;
default:
break;
}
return 1;
}
// Modbus TCP转RTU转发主函数
int32_t loopback_tcps_modbus_to485(uint8_t sn, uint8_t *buf, uint16_t port, uint16_t *timeout, RtuRxST *rtu_rx) {
int32_t ret;
uint16_t size = 0, sentsize = 0;
#ifdef _LOOPBACK_DEBUG_
uint8_t destip[4];
uint16_t destport;
#endif
switch (getSn_SR(sn)) {
case SOCK_ESTABLISHED:
if (getSn_IR(sn) & Sn_IR_CON) {
#ifdef _LOOPBACK_DEBUG_
getSn_DIPR(sn, destip);
destport = getSn_DPORT(sn);
printf("%d:Connected - %d.%d.%d.%d : %d\r\n", sn, destip[0], destip[1], destip[2],
destip[3], destport);
#endif
setSn_IR(sn, Sn_IR_CON);
}
uint16_t rxbuf_size = 0;
uint8_t sendbuf[1024];
switch (modbus_state) {
case STATE_WAIT_RTU:
if (rtu_rx->done) {
rxbuf_size = rtu_to_tcp(rtu_rx->buf, sendbuf, rtu_rx->size, buf);
}
if (rtu_rx->done || *timeout > 1000) {
rtu_rx->done = 0;
modbus_state = STATE_IDLE;
}
if ((size = getSn_RX_RSR(sn)) > 0) {
ret = recv(sn, buf, size);
if (ret <= 0) {
return ret;
}
}
break;
case STATE_IDLE:
if ((size = getSn_RX_RSR(sn)) > 0) {
if (size > DATA_BUF_SIZE)
size = DATA_BUF_SIZE;
ret = recv(sn, buf, size);
if (ret <= 0)
return ret;
if (buf[6] == get_slaveid()) {
rxbuf_size = handleModbusTcp(buf, sendbuf);
} else {
uint8_t rtu_tx[256];
uint16_t rtu_tx_len = tcp_to_rtu(buf, rtu_tx);
RE_SET;
HAL_UART_Transmit_DMA(&huart1, rtu_tx, rtu_tx_len);
*timeout = 0;
rtu_rx->done = 0;
modbus_state = STATE_WAIT_RTU;
}
}
break;
default:
break;
}
if (rxbuf_size > 0) {
sentsize = 0;
while (rxbuf_size != sentsize) {
ret = send(sn, sendbuf + sentsize, rxbuf_size - sentsize);
if (ret < 0) {
close(sn);
return ret;
}
sentsize += ret;
}
}
break;
case SOCK_CLOSE_WAIT:
#ifdef _LOOPBACK_DEBUG_
//printf("%d:CloseWait\r\n",sn);
#endif
if ((ret = disconnect(sn)) != SOCK_OK)
return ret;
#ifdef _LOOPBACK_DEBUG_
printf("%d:Socket Closed\r\n", sn);
#endif
break;
case SOCK_INIT:
#ifdef _LOOPBACK_DEBUG_
printf("%d:Listen, TCP server loopback, port [%d]\r\n", sn, port);
#endif
if ((ret = listen(sn)) != SOCK_OK)
return ret;
break;
case SOCK_CLOSED:
#ifdef _LOOPBACK_DEBUG_
//printf("%d:TCP server loopback start\r\n",sn);
#endif
if ((ret = socket(sn, Sn_MR_TCP, port, 0x00)) != sn)
return ret;
#ifdef _LOOPBACK_DEBUG_
//printf("%d:Socket opened\r\n",sn);
#endif
break;
default:
break;
}
return 1;
}