Files
stm32-comm/comm/protocols/modbustcpslave.c
T

318 lines
7.6 KiB
C
Raw Blame History

This file contains ambiguous Unicode characters
This file contains Unicode characters that might be confused with other characters. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.
/*
* @file modbustcpslave.c
* @brief Modbus TCP从站服务 + Modbus TCP转RTU转发
*/
#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];
// ============================================================================
// 工具函数
// ============================================================================
/**
* @brief Modbus TCP转RTU格式
* @param tcp_buf: TCP输入缓冲区
* @param rtu_buf: RTU输出缓冲区
* @return RTU帧总长度
*/
uint16_t tcp_to_rtu(uint8_t *tcp_buf, uint8_t *rtu_buf) {
// TCP长度字段 - 去掉MBAP头中的UnitID之前的长度
uint16_t len = ((tcp_buf[4] << 8) | tcp_buf[5]) - 1;
// 从UnitID开始拷贝
memcpy(rtu_buf, &tcp_buf[6], len + 1);
// 计算CRC16并添加到末尾
uint16_t crc = crc16(rtu_buf, len + 1);
rtu_buf[len + 1] = crc & 0xFF;
rtu_buf[len + 2] = (crc >> 8) & 0xFF;
return len + 3; // 返回RTU总长度
}
/**
* @brief Modbus RTU转TCP格式
* @param rtu_buf: RTU输入缓冲区
* @param tcp_buf: TCP输出缓冲区
* @param rtu_len: RTU帧长度
* @param rx_buf: 原TCP接收缓冲区,用于拷贝MBAP头
* @return TCP帧总长度,0表示CRC错误
*/
uint16_t rtu_to_tcp(uint8_t *rtu_buf, uint8_t *tcp_buf, uint16_t rtu_len, uint8_t *rx_buf) {
// 校验CRC
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);
// Unit ID
tcp_buf[6] = rtu_buf[0];
// 功能码+数据
memcpy(&tcp_buf[7], &rtu_buf[1], rtu_len - 3);
// 设置长度
uint16_t pdu_len = rtu_len - 3;
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, // 空闲,等待TCP请求
STATE_WAIT_RTU // 已经转发RTU,等待RS485响应
} modbus_state = STATE_IDLE;
// ============================================================================
// 公共接口
// ============================================================================
/**
* @brief Modbus TCP服务主函数,W5500socket主循环处理
* @param sn: socket编号
* @param port: 监听端口 (通常502)
* @return 0/正表示正常,负表示错误
*/
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;
}
// 处理Modbus TCP请求
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;
}
/**
* @brief Modbus TCP转RTU转发,TCP请求转RS485RTU,RTU响应转TCP返回
* @param sn: socket编号
* @param buf: TCP接收缓冲区
* @param port: 监听端口
* @param timeout: 超时计数指针
* @param rtu_rx: RTU接收状态结构体
* @return 0/正表示正常,负表示错误
*/
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:
// RTU响应接收完成,转TCP返回
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;
}
// 同时检查是否有新的TCP请求
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;
}
// UnitID匹配本地从站地址,本地处理
if (buf[6] == get_slaveid()) {
rxbuf_size = handleModbusTcp(buf, sendbuf);
}
// 不匹配,转发到RS485RTU
else {
uint8_t rtu_tx[256];
uint16_t rtu_tx_len = tcp_to_rtu(buf, rtu_tx);
RE_SET; // 485芯片设置为发送
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;
}