STM32NET学习笔记 IP ICMP部分
// IP首部总长度 #define IP_HEADER_LEN 20 // 协议类型 // ICMP协议 #define IP_PROTO_ICMP_V 0x01 // TCP协议 #define IP_PROTO_TCP_V 0x06 // UDP协议 #define IP_PROTO_UDP_V 0x11 // IPV4版本 #define IP_V4_V 0x40 #define IP_HEADER_LENGTH_V 0x05 // IP版本号位置 以太网首部2+6+6 #define IP_P 0x0E // 首部长度 #define IP_HEADER_VER_LEN_P 0x0E // 服务类型 #define IP_TOS_P 0x0F // IP总长度 #define IP_TOTLEN_H_P 0x10 #define IP_TOTLEN_L_P 0x11 // IP标识 #define IP_ID_H_P 0x12 #define IP_ID_L_P 0x13 // #define IP_FLAGS_H_P 0x14 #define IP_FLAGS_L_P 0x15 // TTL生存时间 #define IP_TTL_P 0x16 // IP协议类型 例如ICMP TCP UDP #define IP_PROTO_P 0x17 // 首部校验和 #define IP_CHECKSUM_H_P 0x18 #define IP_CHECKSUM_L_P 0x19 // 源IP地址 #define IP_SRC_IP_P 0x1A // 目标IP地址 #define IP_DST_IP_P 0x1E void ip_generate_header ( BYTE *rxtx_buffer, WORD_BYTES total_length, BYTE protocol, BYTE *dest_ip ) { BYTE i; // 校验结果 WORD_BYTES ck; // 版本号和首都长度 rxtx_buffer[ IP_P ] = IP_V4_V | IP_HEADER_LENGTH_V; // 服务类型 rxtx_buffer[ IP_TOS_P ] = 0x00; // 总长度 rxtx_buffer [ IP_TOTLEN_H_P ] = total_length.byte.high; rxtx_buffer [ IP_TOTLEN_L_P ] = total_length.byte.low; // IP标识 rxtx_buffer [ IP_ID_H_P ] = ip_identfier >> 8; rxtx_buffer [ IP_ID_H_P ] = ip_identfier & 0x00ff; // 累加 ip_identfier++; // 标志和分片偏移 rxtx_buffer [ IP_FLAGS_H_P ] = 0x00; rxtx_buffer [ IP_FLAGS_L_P ] = 0x00; // 生存时间 rxtx_buffer [ IP_TTL_P ] = 128; // set ip packettype to tcp/udp/icmp... rxtx_buffer [ IP_PROTO_P ] = protocol; // 设定目标地址和源地址 for ( i = 0; i < 4; i++ ) { rxtx_buffer[ IP_DST_IP_P + i ] = dest_ip[i]; rxtx_buffer[ IP_SRC_IP_P + i ] = avr_ip.byte[ i ]; } // 校验结果 rxtx_buffer[ IP_CHECKSUM_H_P ] = 0; rxtx_buffer[ IP_CHECKSUM_L_P ] = 0; ck.word = software_checksum ( &rxtx_buffer[ IP_P ], sizeof(IP_HEADER), 0 ); rxtx_buffer[ IP_CHECKSUM_H_P ] = ck.byte.high; rxtx_buffer[ IP_CHECKSUM_L_P ] = ck.byte.low; }
BYTE ip_packet_is_ip ( BYTE *rxtx_buffer ) { unsigned char i; // 检查该报文是否为IP报文 if ( rxtx_buffer[ ETH_TYPE_H_P ] != ETH_TYPE_IP_H_V || rxtx_buffer[ ETH_TYPE_L_P ] != ETH_TYPE_IP_L_V) return 0; // 检查该报文的IP地址是否为本机IP地址,逐个检查 for ( i=0; i<sizeof(IP_ADDR); i++ ) { if ( rxtx_buffer[ IP_DST_IP_P + i ] != avr_ip.byte[i] ) return 0; } // 若该报文为IP报文,且目标IP地址为本机地址,返回1 return 1; }
// 回显应答 #define ICMP_TYPE_ECHOREPLY_V 0 // 回显请求 #define ICMP_TYPE_ECHOREQUEST_V 8 // ICMP首部长度 #define ICMP_PACKET_LEN 40 // ICMP类型 #define ICMP_TYPE_P 0x22 // ICMP代码 #define ICMP_CODE_P 0x23 // ICMP首部校验和 #define ICMP_CHECKSUM_H_P 0x24 #define ICMP_CHECKSUM_L_P 0x25 // ICMP标识符 #define ICMP_IDENTIFIER_H_P 0x26 #define ICMP_IDENTIFIER_L_P 0x27 // ICMP序号 #define ICMP_SEQUENCE_H_P 0x28 #define ICMP_SEQUENCE_L_P 0x29 #define ICMP_DATA_P 0x2A
void icmp_generate_packet ( BYTE *rxtx_buffer ,BYTE type) { BYTE i; WORD_BYTES ck; // ICMP回显请求 if( type == ICMP_TYPE_ECHOREQUEST_V ) { rxtx_buffer[ ICMP_TYPE_P ] == ICMP_TYPE_ECHOREQUEST_V; rxtx_buffer[ ICMP_CODE_P ] = 0; rxtx_buffer[ ICMP_IDENTIFIER_H_P ] = icmp_id; rxtx_buffer[ ICMP_IDENTIFIER_L_P ] = 0; rxtx_buffer[ ICMP_SEQUENCE_H_P ] = icmp_seq; rxtx_buffer[ ICMP_SEQUENCE_L_P ] = 0; icmp_id++; icmp_seq++; for ( i=0; i<ICMP_MAX_DATA; i++ ) { rxtx_buffer[ ICMP_DATA_P + i ] = ‘A‘ + i; } } // ICMP回显 if(type == ICMP_TYPE_ECHOREPLY_V) { rxtx_buffer[ ICMP_TYPE_P ] = ICMP_TYPE_ECHOREPLY_V; } // ICMP首部校验和 rxtx_buffer[ ICMP_CHECKSUM_H_P ] = 0; rxtx_buffer[ ICMP_CHECKSUM_L_P ] = 0; ck.word = software_checksum ( &rxtx_buffer[ ICMP_TYPE_P ], sizeof(ICMP_PACKET), 0 ); rxtx_buffer[ ICMP_CHECKSUM_H_P ] = ck.byte.high; rxtx_buffer[ ICMP_CHECKSUM_L_P ] = ck.byte.low; }
BYTE icmp_send_reply ( BYTE *rxtx_buffer, BYTE *dest_mac, BYTE *dest_ip ) { // IP首部中为ICMP协议类型 if ( rxtx_buffer [ IP_PROTO_P ] != IP_PROTO_ICMP_V ) return 0; // 是否为ICMP回显请求 if ( rxtx_buffer [ ICMP_TYPE_P ] != ICMP_TYPE_ECHOREQUEST_V ) return 0; #ifdef ICMP_DEBUG printf("ICMP Request!\n"); printf("Ping from:%d.%d.%d.%d\n", 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]); #endif // 生成以太网首部 eth_generate_header ( rxtx_buffer, (WORD_BYTES){ETH_TYPE_IP_V}, dest_mac ); // 生成IP首部 ip_generate_header ( rxtx_buffer, (WORD_BYTES){(rxtx_buffer[IP_TOTLEN_H_P]<<8)|rxtx_buffer[IP_TOTLEN_L_P]}, IP_PROTO_ICMP_V, dest_ip ); // 生成ICMP首部 icmp_generate_packet ( rxtx_buffer ,(BYTE)ICMP_TYPE_ECHOREPLY_V); // 发送报文 enc28j60_packet_send ( rxtx_buffer, sizeof(ETH_HEADER) + sizeof(IP_HEADER) + sizeof(ICMP_PACKET) ); return 1; }
/* 获得新的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; }
郑重声明:本站内容如果来自互联网及其他传播媒体,其版权均属原媒体及文章作者所有。转载目的在于传递更多信息及用于网络分享,并不代表本站赞同其观点和对其真实性负责,也不构成任何其他建议。