130 lines
4.7 KiB
C
130 lines
4.7 KiB
C
#include "tcpserverc.h"
|
||
#include "lwip/netif.h"
|
||
#include "lwip/ip.h"
|
||
#include "lwip/tcp.h"
|
||
#include "lwip/init.h"
|
||
#include "netif/etharp.h"
|
||
#include "lwip/udp.h"
|
||
#include "lwip/pbuf.h"
|
||
#include <stdio.h>
|
||
#include <string.h>
|
||
|
||
#include "main.h"
|
||
|
||
#include "user_lib.h"
|
||
#include "communication_protocol.h"
|
||
#include "user_gpio.h"
|
||
|
||
struct tcp_pcb *server_pcb_control = NULL;
|
||
|
||
communication_di_t *user_communication_di = NULL;
|
||
communication_do_t *user_communication_do = NULL;
|
||
|
||
extern uint8_t tcp_echo_flags_control;
|
||
|
||
/*接收回调函数*/
|
||
|
||
static err_t tcpecho_recv_control(void *arg, struct tcp_pcb *tpcb, struct pbuf *p, err_t err)
|
||
{
|
||
uint8_t tcp_rx_data[128] = {0}; // 接受数据缓存区
|
||
uint8_t tcp_tx_data[128] = {0}; // 发送数据缓存区
|
||
uint8_t rx_data_len = 0;
|
||
uint8_t tx_data_len = 0;
|
||
communication_data_u communication_data;
|
||
if (p != NULL)
|
||
{
|
||
/* 更新窗口*/
|
||
|
||
tcp_recved(tpcb, p->tot_len); // 读取数据的控制块 得到所有数据的长度
|
||
memcpy(tcp_rx_data, (int *)p->payload, p->tot_len);
|
||
rx_data_len = p->tot_len;
|
||
/*1. 对接收的数据做异或校验、帧头帧尾判断，校验失败返回信息，校验通过继续下一步、校验数据从帧头后面到校验位结束*/
|
||
if (tcp_rx_data[0] != 0xAA || tcp_rx_data[rx_data_len - 1] != 0x3C) // 帧头帧尾判断
|
||
{
|
||
tx_data_len = COM_ERROR_CODE_SIZE;
|
||
communication_exception(tcp_tx_data, tcp_rx_data, FRAMING_ERROR);
|
||
tcp_write(tpcb, tcp_tx_data, tx_data_len, 1);
|
||
}
|
||
else
|
||
{
|
||
if (tcp_rx_data[rx_data_len - 2] != xor_compute(tcp_rx_data + 1, rx_data_len - 3)) // 异或校验
|
||
{
|
||
tx_data_len = COM_ERROR_CODE_SIZE;
|
||
communication_exception(tcp_tx_data, tcp_rx_data, CHECK_ERROR);
|
||
tcp_write(tpcb, tcp_tx_data, tx_data_len, 1);
|
||
}
|
||
else
|
||
{
|
||
memcpy(communication_data.data, tcp_rx_data + 5, tcp_rx_data[4]);
|
||
if (tcp_rx_data[3] == 0x02) // 读数字量指令
|
||
{
|
||
/*读操作，从寄存器读取数据，组包返回*/
|
||
|
||
user_communication_di = &communication_data.di_data;
|
||
tx_data_len = 7 + user_communication_di->num;
|
||
user_read_gpio(user_communication_di, tcp_tx_data, tcp_rx_data);
|
||
tcp_write(tpcb, tcp_tx_data, tx_data_len, 1);
|
||
}
|
||
else if (tcp_rx_data[3] == 0x03) // 写数字量指令
|
||
{
|
||
/*写操作，将数据写入寄存器，组包返回*/
|
||
user_communication_do = &communication_data.do_data;
|
||
user_write_gpio(user_communication_do);
|
||
tcp_write(tpcb, tcp_rx_data, rx_data_len, 1);
|
||
}
|
||
else if (tcp_rx_data[3] == SEND_STATE_CMD)
|
||
{
|
||
send_data_flag_cmd = 0; // 上位机返回数据，发送状态标志位清零
|
||
}
|
||
else
|
||
{
|
||
// 返回命令号错误
|
||
tx_data_len = COM_ERROR_CODE_SIZE;
|
||
communication_exception(tcp_tx_data, tcp_rx_data, COMMAND_ERROR);
|
||
tcp_write(tpcb, tcp_tx_data, tx_data_len, 1);
|
||
}
|
||
}
|
||
|
||
/*2. 判断所要执行的操作 读或写指令*/
|
||
/*3. 对要发送的数据进行校验，组包，返回数据*/
|
||
}
|
||
pbuf_free(p);
|
||
}
|
||
else if (err == ERR_OK) // 检测到对方主动关闭连接时，也会调用recv函数，此时p为空
|
||
{
|
||
tcp_echo_flags_control = 0;
|
||
return tcp_close(tpcb);
|
||
}
|
||
|
||
return ERR_OK;
|
||
}
|
||
static err_t tcpecho_accept_control(void *arg, struct tcp_pcb *newpcb, err_t err) // 由于这个函数是*tcp_accept_fn类型的
|
||
{
|
||
tcp_recv(newpcb, tcpecho_recv_control); // 当收到数据时，回调用户自己写的tcpecho_recv
|
||
server_pcb_control = newpcb; // 直接赋值
|
||
tcp_echo_flags_control = 1;
|
||
return ERR_OK;
|
||
}
|
||
void tcp_echo_init(void)
|
||
{
|
||
struct tcp_pcb *server_control = NULL;
|
||
|
||
/* 创建控制块 */
|
||
server_control = tcp_new();
|
||
|
||
/* 绑定TCP控制块 */
|
||
tcp_bind(server_control, IP_ADDR_ANY, TCP_PORT_CONTROL);
|
||
|
||
/* 进入监听状态 */
|
||
server_control = tcp_listen(server_control);
|
||
|
||
/* 处理连接 注册函数，侦听到连接时被注册的函数被回调 */
|
||
tcp_accept(server_control, tcpecho_accept_control); // 侦听到连接后，回调用户编写的tcpecho_accept
|
||
}
|
||
|
||
void user_send_data_control(uint8_t *data, uint16_t len)
|
||
{
|
||
|
||
tcp_write(server_pcb_control, data, len, 1);
|
||
}
|