STM32NET学习笔记 UDP部分
// UDP默认端口号 #define UDP_AVR_PORT_V 3000 #define UDP_AVR_PORT_H_V (UDP_AVR_PORT_V>>8) #define UDP_AVR_PORT_L_V (UDP_AVR_PORT_V&0xff) // 源端口 #define UDP_SRC_PORT_H_P 0x22 #define UDP_SRC_PORT_L_P 0x23 // 目标端口 #define UDP_DST_PORT_H_P 0x24 #define UDP_DST_PORT_L_P 0x25 // UDP负载长度 #define UDP_LENGTH_H_P 0x26 #define UDP_LENGTH_L_P 0x27 // UDP校验和 #define UDP_CHECKSUM_H_P 0x28 #define UDP_CHECKSUM_L_P 0x29 // UDP负载起始地址 #define UDP_DATA_P 0x2A
#define UDP_AVR_PORT_V 3000 #define UDP_AVR_PORT_H_V (UDP_AVR_PORT_V>>8) #define UDP_AVR_PORT_L_V (UDP_AVR_PORT_V&0xff)
void udp_generate_header ( BYTE *rxtx_buffer, WORD_BYTES dest_port, WORD_BYTES length ) { WORD_BYTES ck; // 默认端口号 3000 rxtx_buffer[UDP_SRC_PORT_H_P] = UDP_AVR_PORT_H_V; rxtx_buffer[UDP_SRC_PORT_L_P] = UDP_AVR_PORT_L_V; // 目标端口地址 rxtx_buffer[UDP_DST_PORT_H_P] = dest_port.byte.high; rxtx_buffer[UDP_DST_PORT_L_P] = dest_port.byte.low; // 负载长度 rxtx_buffer[UDP_LENGTH_H_P] = length.byte.high; rxtx_buffer[UDP_LENGTH_L_P] = length.byte.low; // 计算校验和 rxtx_buffer[UDP_CHECKSUM_H_P] = 0; rxtx_buffer[UDP_CHECKSUM_L_P] = 0; // length+8 for source/destination IP address length (8-bytes) ck.word = software_checksum ( (BYTE*)&rxtx_buffer[IP_SRC_IP_P], length.word+8, length.word+IP_PROTO_UDP_V); rxtx_buffer[UDP_CHECKSUM_H_P] = ck.byte.high; rxtx_buffer[UDP_CHECKSUM_L_P] = ck.byte.low; }
WORD udp_get_dlength( BYTE *rxtx_buffer ) { WORD length = 0; // 获得UDP长度 length = rxtx_buffer[UDP_LENGTH_H_P] << 8 | rxtx_buffer[UDP_LENGTH_L_P]; // 去除首部长度 length = length - 8; return length; }
WORD udp_puts_data ( BYTE *rxtx_buffer, BYTE *data, WORD offset ) { while(*data) { rxtx_buffer[UDP_DATA_P + offset] = *data++; offset++; } return offset; }
BYTE udp_receive ( BYTE *rxtx_buffer, BYTE *dest_mac, BYTE *dest_ip ) { WORD dlength = 0; // udp负载长度 WORD udp_loadlen = 0; // 匹配UDP协议 UDP端口号 if ( rxtx_buffer[IP_PROTO_P] == IP_PROTO_UDP_V && rxtx_buffer[UDP_DST_PORT_H_P] == UDP_AVR_PORT_H_V && rxtx_buffer[ UDP_DST_PORT_L_P ] == UDP_AVR_PORT_L_V ) { // 获得UDP负载长度 udp_loadlen = udp_get_dlength(rxtx_buffer); // 复制UDP接收 memcpy(udp_recbuf, (char*)&rxtx_buffer[UDP_DATA_P], udp_loadlen); #if UDP_DEBUG printf("UDP Message!\r\n"); printf("Send Form:%d.%d.%d.%d ", rxtx_buffer[IP_SRC_IP_P+0],rxtx_buffer[IP_SRC_IP_P+1], rxtx_buffer[IP_SRC_IP_P+2],rxtx_buffer[IP_SRC_IP_P+3]); printf("Port:%d\r\n",(rxtx_buffer[UDP_SRC_PORT_H_P] << 8) | rxtx_buffer[UDP_SRC_PORT_L_P]); printf("Reccive:%s\r\n",udp_recbuf); #endif // 生成以太网首部 eth_generate_header(rxtx_buffer, (WORD_BYTES){ETH_TYPE_IP_V}, dest_mac ); // 生成IP首部 ip_generate_header(rxtx_buffer, (WORD_BYTES){sizeof(IP_HEADER)+sizeof(UDP_HEADER)+dlength}, IP_PROTO_UDP_V, dest_ip ); // 生成UDP首部 udp_generate_header(rxtx_buffer, (WORD_BYTES){(rxtx_buffer[UDP_SRC_PORT_H_P]<<8)|rxtx_buffer[UDP_SRC_PORT_L_P]}, (WORD_BYTES){sizeof(UDP_HEADER)+dlength}); // 发送所有首部和UDP负载数据 enc28j60_packet_send(rxtx_buffer, sizeof(ETH_HEADER)+sizeof(IP_HEADER)+sizeof(UDP_HEADER)+dlength ); // 返回1代表数据包已被处理 return 1; } // 返回0代表数据包未被处理 return 0; }
// 获得新的IP报文 plen = enc28j60_packet_receive( (BYTE*)&rxtx_buffer, MAX_RXTX_BUFFER ); if(plen==0) return; // 保存客服端的MAC地址 memcpy ( (BYTE*)&client_mac, &rxtx_buffer[ ETH_SRC_MAC_P ], sizeof( MAC_ADDR) ); // 检查该报文是不是ARP报文 if ( arp_packet_is_arp( rxtx_buffer, (WORD_BYTES){ARP_OPCODE_REQUEST_V} ) ) { // 向客户端返回ARP报文 arp_send_reply ( (BYTE*)&rxtx_buffer, (BYTE*)&client_mac ); return; } // 保存客服端的IP地址 memcpy ( (BYTE*)&client_ip, &rxtx_buffer[ IP_SRC_IP_P ], sizeof(IP_ADDR) ); // 检查该报文是否为IP报文 if ( ip_packet_is_ip ( (BYTE*)&rxtx_buffer ) == 0 ) { return; } // 如果是ICMP报文 向发起方返回数据 if ( icmp_send_reply ( (BYTE*)&rxtx_buffer, (BYTE*)&client_mac, (BYTE*)&client_ip ) ) { return; } // 进行UDP处理 if (udp_receive ( (BYTE *)&rxtx_buffer, (BYTE *)&client_mac, (BYTE *)&client_ip )) { return; }
// 获得UDP负载长度 udp_loadlen = udp_get_dlength(rxtx_buffer); // 复制UDP接收 memcpy(udp_recbuf, (char*)&rxtx_buffer[UDP_DATA_P], udp_loadlen); #if UDP_DEBUG printf("UDP Message!\r\n"); printf("Send Form:%d.%d.%d.%d ", rxtx_buffer[IP_SRC_IP_P+0],rxtx_buffer[IP_SRC_IP_P+1], rxtx_buffer[IP_SRC_IP_P+2],rxtx_buffer[IP_SRC_IP_P+3]); printf("Port:%d\r\n",(rxtx_buffer[UDP_SRC_PORT_H_P] << 8) | rxtx_buffer[UDP_SRC_PORT_L_P]); printf("Reccive:%s\r\n",udp_recbuf); #endif
#if UDP_ECHO // Hello 范例 // 复制Hello strcpy(udp_sendbuf,"UDP:Hello "); // 连接数据 strcat(udp_sendbuf, udp_recbuf); dlength = udp_puts_data(rxtx_buffer, (BYTE*)udp_sendbuf, 0); #endif
#if UDP_LEDCTRL int match_count = 0; int led_index = 0; int led_status = 0; // 匹配led,x,y match_count = sscanf(udp_recbuf,"led,%d,%d", &led_index, &led_status); if(match_count == 2) { switch(led_index) { case 1: led_status?BSP_LEDOn(1):BSP_LEDOff(1); dlength = udp_puts_data(rxtx_buffer, (BYTE*)"LED1 Control OK\r\n", 0); break; case 2: led_status?BSP_LEDOn(2):BSP_LEDOff(2); dlength = udp_puts_data(rxtx_buffer, (BYTE*)"LED2 Control OK\r\n", 0); break; default: dlength = udp_puts_data(rxtx_buffer, (BYTE*)"Invalid Led Index\r\n", 0); break; } } else { dlength = udp_puts_data(rxtx_buffer, (BYTE*)"unknow command\r\n", 0); } #endif
郑重声明:本站内容如果来自互联网及其他传播媒体,其版权均属原媒体及文章作者所有。转载目的在于传递更多信息及用于网络分享,并不代表本站赞同其观点和对其真实性负责,也不构成任何其他建议。