用户态协议栈03-icmp实现

2024-06-21 11:04
文章标签 实现 协议 icmp 用户 03

本文主要是介绍用户态协议栈03-icmp实现，希望对大家解决编程问题提供一定的参考价值，需要的开发者们随着小编来一起学习吧！

icmp协议

ICMP（Internet Control Message Protocol）Internet控制报文协议。它是TCP/IP协议簇的一个子协议，用于在IP主机、路由器之间传递控制消息。控制消息是指网络通不通、主机是否可达、路由是否可用等网络本身的消息。这些控制消息虽然并不传输用户数据，但是对于用户数据的传递起着重要的作用。 [1]

ICMP使用IP的基本支持，就像它是一个更高级别的协议，但是，ICMP实际上是IP的一个组成部分，必须由每个IP模块实现。

icmp报文结构

打包icmp

打包其实都是一个原理，直接放代码了：

static void dpdk_encode_icmp_pkt(uint8_t* msg, uint8_t* dst_mac, uint32_t sip, uint32_t dip, uint16_t id, uint16_t seq) {struct rte_ether_hdr* eth = (struct rte_ether_hdr*)msg;rte_memcpy(eth->s_addr.addr_bytes, gSrcMac, RTE_ETHER_ADDR_LEN);rte_memcpy(eth->d_addr.addr_bytes, dst_mac, RTE_ETHER_ADDR_LEN);eth->ether_type = htons(RTE_ETHER_TYPE_IPV4);struct rte_ipv4_hdr* ip = (struct rte_ipv4_hdr*)(eth + 1);ip->version_ihl = 0x45;ip->type_of_service = 0;ip->total_length = htons(sizeof(struct rte_ipv4_hdr) + sizeof(struct rte_icmp_hdr));ip->packet_id = 0;ip->fragment_offset = 0;ip->time_to_live = 64;ip->next_proto_id = IPPROTO_ICMP;ip->dst_addr = dip;ip->src_addr = sip;ip->hdr_checksum = 0;ip->hdr_checksum = rte_ipv4_cksum(ip);struct rte_icmp_hdr* icmp = (struct rte_icmp_hdr*)(ip + 1);icmp->icmp_type = RTE_IP_ICMP_ECHO_REPLY;icmp->icmp_code = 0;icmp->icmp_ident = id;icmp->icmp_seq_nb = seq;icmp->icmp_cksum = 0;icmp->icmp_cksum = rte_icmp_cksum((uint16_t*)icmp, sizeof(struct rte_icmp_hdr));
}static struct rte_mbuf* dpdk_send_icmp(struct rte_mempool* mbuf_pool, uint8_t* dst_mac, uint32_t sip,  uint32_t dip, uint16_t id, uint16_t seq) {struct rte_mbuf* mbuf = rte_pktmbuf_alloc(mbuf_pool);if(!mbuf) {rte_exit(EXIT_FAILURE, "rte_pktmbuf_alloc\n");}uint16_t total_len = sizeof(struct rte_ether_hdr) + sizeof(struct rte_ipv4_hdr) + sizeof(struct rte_icmp_hdr);mbuf->pkt_len = total_len;mbuf->data_len = total_len;uint8_t* pkt = rte_pktmbuf_mtod(mbuf, uint8_t*);dpdk_encode_icmp_pkt(pkt, dst_mac, sip, dip, id, seq);return mbuf;
}

这里我们依然是做的基础的回复包，效果是使用物理机进行ping操作的时候，可以收到数据返回，所以我们只是打了一个RTE_IP_ICMP_ECHO_REPLY的包。

icmp校验

由于DPDK中好像没有专门的ICMP校验接口，这里我们参考文档自己写一个，文档我会放在最后：

static uint16_t rte_icmp_cksum(uint16_t* addr, int count) {long sum = 0;while (count > 1){sum += *(unsigned short*)addr++;count -= 2;}if(count > 0)sum += *(unsigned char*)addr;while(sum >> 16)sum = (sum & 0xffff) + (sum >> 16);return ~sum;
}

完整代码

#include <rte_eal.h>
#include <rte_ethdev.h>
#include <stdio.h>
#include <arpa/inet.h>#define MBUF_LEN    (4096-1)
#define MBUF_SIZE   64
static const int gDpdkPortId = 0;
#define MAKE_IPV4_ADDR(a, b, c, d)  (a + (b<<8) + (c<<16) + (d<<24))
uint32_t gLocalIp = MAKE_IPV4_ADDR(192, 168, 1, 185);uint32_t gSrcIp;
uint32_t gDstIp;
uint8_t gSrcMac[RTE_ETHER_ADDR_LEN];
uint8_t gDstMac[RTE_ETHER_ADDR_LEN];
uint16_t gSrcPort;
uint16_t gDstPort;struct rte_eth_conf default_port_info = {.rxmode = {.max_rx_pkt_len = RTE_ETHER_MAX_LEN},
};static void dpdk_port_init(struct rte_mempool* mbuf_pool) {uint16_t sys_port_count = rte_eth_dev_count_avail();if(sys_port_count == 0)rte_exit(EXIT_FAILURE, "Could not support port\n");struct rte_eth_dev_info dev_info;rte_eth_dev_info_get(gDpdkPortId, &dev_info);const unsigned nb_rx_queue = 1;const unsigned nb_tx_queue = 1;struct rte_eth_conf port_conf = default_port_info;rte_eth_dev_configure(gDpdkPortId, nb_rx_queue, nb_tx_queue, &port_conf);if(rte_eth_rx_queue_setup(gDpdkPortId, 0, 128, rte_eth_dev_socket_id(gDpdkPortId), NULL, mbuf_pool) < 0)rte_exit(EXIT_FAILURE, "Could not setup RX queue\n");struct rte_eth_txconf txconf = dev_info.default_txconf;txconf.offloads = default_port_info.rxmode.offloads;if(rte_eth_tx_queue_setup(gDpdkPortId, 0, 512, rte_eth_dev_socket_id(gDpdkPortId), &txconf) < 0)rte_exit(EXIT_FAILURE, "Could not setup TX queue\n");if(rte_eth_dev_start(gDpdkPortId) < 0)rte_exit(EXIT_FAILURE, "Could not start\n");
}static void dpdk_encode_udp_pkt(uint8_t* msg, uint8_t* data, uint16_t total_len) {struct rte_ether_hdr* eth = (struct rte_ether_hdr*)msg;rte_memcpy(eth->d_addr.addr_bytes, gDstMac, RTE_ETHER_ADDR_LEN);rte_memcpy(eth->s_addr.addr_bytes, gSrcMac, RTE_ETHER_ADDR_LEN);eth->ether_type = htons(RTE_ETHER_TYPE_IPV4);struct rte_ipv4_hdr* ip = (struct rte_ipv4_hdr*)(eth + 1);ip->version_ihl = 0x45;ip->type_of_service = 0;ip->total_length = htons(total_len - sizeof(struct rte_ether_hdr));ip->packet_id = 0;ip->fragment_offset = 0;ip->time_to_live = 64;ip->next_proto_id = IPPROTO_UDP;ip->dst_addr = gDstIp;ip->src_addr = gSrcIp;ip->hdr_checksum = 0;ip->hdr_checksum = rte_ipv4_cksum(ip);struct rte_udp_hdr* udp = (struct rte_udp_hdr*)(ip + 1);uint16_t length = total_len - sizeof(struct rte_ether_hdr) - sizeof(struct rte_ipv4_hdr);udp->dst_port = gDstPort;udp->src_port = gSrcIp;udp->dgram_len = htons(length);rte_memcpy((uint8_t*)(udp + 1), data, length);udp->dgram_cksum = 0;udp->dgram_cksum = rte_ipv4_udptcp_cksum(ip, udp);
}static  struct rte_mbuf* dpdk_send_udp(struct rte_mempool* mbuf_pool, uint8_t* data, uint16_t length) {struct rte_mbuf* mbuf = rte_pktmbuf_alloc(mbuf_pool);if(!mbuf)rte_exit(EXIT_FAILURE, "rte_pktmbuf_alloc\n");uint16_t total_len = length + 42;mbuf->pkt_len = total_len;mbuf->data_len = total_len;uint8_t* pkt = rte_pktmbuf_mtod(mbuf, uint8_t*);dpdk_encode_udp_pkt(pkt, data, length);return mbuf;
}static void dpdk_encode_arp_pkt(uint8_t* msg, uint8_t* dst_mac, uint32_t sip, uint32_t dip) {struct rte_ether_hdr* eth = (struct rte_ether_hdr*)(msg);rte_memcpy(eth->s_addr.addr_bytes, gSrcMac, RTE_ETHER_ADDR_LEN);rte_memcpy(eth->d_addr.addr_bytes, dst_mac, RTE_ETHER_ADDR_LEN);eth->ether_type = htons(RTE_ETHER_TYPE_ARP);struct rte_arp_hdr* arp = (struct rte_arp_hdr*)(eth + 1);arp->arp_hardware = htons(1);arp->arp_protocol = htons(RTE_ETHER_TYPE_IPV4);arp->arp_plen = sizeof(uint32_t);arp->arp_hlen = RTE_ETHER_ADDR_LEN;arp->arp_opcode = htons(2);arp->arp_data.arp_sip = sip;arp->arp_data.arp_tip = dip;rte_memcpy(arp->arp_data.arp_sha.addr_bytes, gSrcMac, RTE_ETHER_ADDR_LEN);rte_memcpy(arp->arp_data.arp_tha.addr_bytes, dst_mac, RTE_ETHER_ADDR_LEN);
}static  struct rte_mbuf* dpdk_send_arp(struct rte_mempool* mbuf_pool, uint8_t* dst_mac, uint32_t sip, uint32_t dip) {struct rte_mbuf* mbuf = rte_pktmbuf_alloc(mbuf_pool);if(!mbuf)rte_exit(EXIT_FAILURE, "rte_pktmbuf_alloc\n");uint16_t total_len = sizeof(struct rte_ether_hdr) + sizeof(struct rte_arp_hdr);mbuf->pkt_len = total_len;mbuf->data_len = total_len;uint8_t* pkt = rte_pktmbuf_mtod(mbuf, uint8_t*);dpdk_encode_arp_pkt(pkt, dst_mac, sip, dip);return mbuf;
}static uint16_t rte_icmp_cksum(uint16_t* addr, int count) {long sum = 0;while (count > 1){sum += *(unsigned short*)addr++;count -= 2;}if(count > 0)sum += *(unsigned char*)addr;while(sum >> 16)sum = (sum & 0xffff) + (sum >> 16);return ~sum;
}static void dpdk_encode_icmp_pkt(uint8_t* msg, uint8_t* dst_mac, uint32_t sip, uint32_t dip, uint16_t id, uint16_t seq) {struct rte_ether_hdr* eth = (struct rte_ether_hdr*)msg;rte_memcpy(eth->s_addr.addr_bytes, gSrcMac, RTE_ETHER_ADDR_LEN);rte_memcpy(eth->d_addr.addr_bytes, dst_mac, RTE_ETHER_ADDR_LEN);eth->ether_type = htons(RTE_ETHER_TYPE_IPV4);struct rte_ipv4_hdr* ip = (struct rte_ipv4_hdr*)(eth + 1);ip->version_ihl = 0x45;ip->type_of_service = 0;ip->total_length = htons(sizeof(struct rte_ipv4_hdr) + sizeof(struct rte_icmp_hdr));ip->packet_id = 0;ip->fragment_offset = 0;ip->time_to_live = 64;ip->next_proto_id = IPPROTO_ICMP;ip->dst_addr = dip;ip->src_addr = sip;ip->hdr_checksum = 0;ip->hdr_checksum = rte_ipv4_cksum(ip);struct rte_icmp_hdr* icmp = (struct rte_icmp_hdr*)(ip + 1);icmp->icmp_type = RTE_IP_ICMP_ECHO_REPLY;icmp->icmp_code = 0;icmp->icmp_ident = id;icmp->icmp_seq_nb = seq;icmp->icmp_cksum = 0;icmp->icmp_cksum = rte_icmp_cksum((uint16_t*)icmp, sizeof(struct rte_icmp_hdr));
}static struct rte_mbuf* dpdk_send_icmp(struct rte_mempool* mbuf_pool, uint8_t* dst_mac, uint32_t sip,  uint32_t dip, uint16_t id, uint16_t seq) {struct rte_mbuf* mbuf = rte_pktmbuf_alloc(mbuf_pool);if(!mbuf) {rte_exit(EXIT_FAILURE, "rte_pktmbuf_alloc\n");}uint16_t total_len = sizeof(struct rte_ether_hdr) + sizeof(struct rte_ipv4_hdr) + sizeof(struct rte_icmp_hdr);mbuf->pkt_len = total_len;mbuf->data_len = total_len;uint8_t* pkt = rte_pktmbuf_mtod(mbuf, uint8_t*);dpdk_encode_icmp_pkt(pkt, dst_mac, sip, dip, id, seq);return mbuf;
}int main(int argc, char* argv[]) {if(rte_eal_init(argc, argv) < 0)rte_exit(EXIT_FAILURE, "Error with eal init\n");struct rte_mempool* mbuf_pool = rte_pktmbuf_pool_create("mbuf_pool", MBUF_LEN, 0, 0, RTE_MBUF_DEFAULT_BUF_SIZE, rte_socket_id());if(!mbuf_pool)rte_exit(EXIT_FAILURE, "Error with mempool create\n");dpdk_port_init(mbuf_pool);rte_eth_macaddr_get(gDpdkPortId, (struct rte_ether_addr*)gSrcMac);while(1) {struct rte_mbuf* mbufs[MBUF_SIZE];int nb_pkt = rte_eth_rx_burst(gDpdkPortId, 0, mbufs, MBUF_SIZE);if(nb_pkt > MBUF_SIZE)rte_exit(EXIT_FAILURE, "Error withs pkt num\n");int i;for(i = 0; i < nb_pkt; i++) {struct rte_ether_hdr* eth = rte_pktmbuf_mtod(mbufs[i], struct rte_ether_hdr*);if(eth->ether_type == rte_cpu_to_be_16(RTE_ETHER_TYPE_ARP)) {struct rte_arp_hdr* arp = rte_pktmbuf_mtod_offset(mbufs[i], struct rte_arp_hdr*, sizeof(struct rte_ether_hdr));struct in_addr addr;addr.s_addr = arp->arp_data.arp_sip;printf("arp-->src: %s ", inet_ntoa(addr));addr.s_addr = arp->arp_data.arp_tip;printf("dst: %s\n", inet_ntoa(addr));if(arp->arp_data.arp_tip == gLocalIp) {struct rte_mbuf* txbuf = dpdk_send_arp(mbuf_pool, arp->arp_data.arp_sha.addr_bytes, gLocalIp, arp->arp_data.arp_sip);rte_eth_tx_burst(gDpdkPortId, 0, &txbuf, 1);rte_pktmbuf_free(txbuf);rte_pktmbuf_free(mbufs[i]);txbuf = NULL;mbufs[i] = NULL;}continue;}if(eth->ether_type != rte_cpu_to_be_16(RTE_ETHER_TYPE_IPV4)) {rte_pktmbuf_free(mbufs[i]);mbufs[i] = NULL;continue;}struct rte_ipv4_hdr* ip = rte_pktmbuf_mtod_offset(mbufs[i], struct rte_ipv4_hdr*, sizeof(struct rte_ether_hdr));if(ip->next_proto_id == IPPROTO_UDP) {struct rte_udp_hdr* udp = (struct rte_udp_hdr*)(ip + 1);rte_memcpy(gDstMac, eth->s_addr.addr_bytes, RTE_ETHER_ADDR_LEN);rte_memcpy(&gSrcIp, &ip->dst_addr, sizeof(uint32_t));rte_memcpy(&gDstIp, &ip->src_addr, sizeof(uint32_t));rte_memcpy(&gSrcPort, &udp->dst_port, sizeof(uint16_t));rte_memcpy(&gDstPort, &udp->src_port, sizeof(uint16_t));uint16_t len = ntohs(udp->dgram_len);*((char*)udp + len) = '\0';struct in_addr addr;addr.s_addr = ip->src_addr;printf("udp-->src: %s:%d ", inet_ntoa(addr), ntohs(udp->src_port));addr.s_addr = ip->dst_addr;printf("dst: %s:%d %s\n", inet_ntoa(addr), udp->dst_port, (char*)(udp + 1));struct rte_mbuf* txbuf = dpdk_send_udp(mbuf_pool, (uint8_t*)(udp + 1), len);rte_eth_tx_burst(gDpdkPortId, 0, &txbuf, 1);rte_pktmbuf_free(txbuf);rte_pktmbuf_free(mbufs[i]);txbuf = NULL;mbufs[i] = NULL;}if(ip->next_proto_id == IPPROTO_ICMP) {struct rte_icmp_hdr* icmp = (struct rte_icmp_hdr*)(ip + 1);struct in_addr addr;addr.s_addr = ip->src_addr;printf("icmp-->src: %s ", inet_ntoa(addr));if(icmp->icmp_type == RTE_IP_ICMP_ECHO_REQUEST) {addr.s_addr = ip->dst_addr;printf("local:%s, type: %d\n", inet_ntoa(addr), icmp->icmp_type);struct rte_mbuf* txbuf = dpdk_send_icmp(mbuf_pool, eth->s_addr.addr_bytes, ip->dst_addr, ip->src_addr, icmp->icmp_ident, icmp->icmp_seq_nb);rte_eth_tx_burst(gDpdkPortId, 0, &txbuf, 1);rte_pktmbuf_free(txbuf);rte_pktmbuf_free(mbufs[i]);}}}}return 0;
}

文档

RFC参考文档

在参考文档中找到cksum相关的就可以了。

这篇关于用户态协议栈03-icmp实现的文章就介绍到这儿，希望我们推荐的文章对编程师们有所帮助！


http://www.chinasem.cn/article/1081047。

相关文章

Linux下删除乱码文件和目录的实现方式

Linux下删除乱码文件和目录的实现方式

《Linux下删除乱码文件和目录的实现方式》：本文主要介绍Linux下删除乱码文件和目录的实现方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录linux下删除乱码文件和目录方法1方法2总结Linux下删除乱码文件和目录方法1使用ls -i命令找到文件或目录
阅读更多...
SpringBoot+EasyExcel实现自定义复杂样式导入导出

SpringBoot+EasyExcel实现自定义复杂样式导入导出

《SpringBoot+EasyExcel实现自定义复杂样式导入导出》这篇文章主要为大家详细介绍了SpringBoot如何结果EasyExcel实现自定义复杂样式导入导出功能,文中的示例代码讲解详细,... 目录安装处理自定义导出复杂场景1、列不固定，动态列2、动态下拉3、自定义锁定行/列，添加密码4、合并
阅读更多...
mybatis执行insert返回id实现详解

mybatis执行insert返回id实现详解

《mybatis执行insert返回id实现详解》MyBatis插入操作默认返回受影响行数,需通过useGeneratedKeys+keyProperty或selectKey获取主键ID,确保主键为自... 目录 两种方式获取自增 ID：1. ​​useGeneratedKeys+keyProperty（推
阅读更多...
Spring Boot集成Druid实现数据源管理与监控的详细步骤

Spring Boot集成Druid实现数据源管理与监控的详细步骤

《SpringBoot集成Druid实现数据源管理与监控的详细步骤》本文介绍如何在SpringBoot项目中集成Druid数据库连接池,包括环境搭建、Maven依赖配置、SpringBoot配置文件... 目录1. 引言1.1 环境准备1.2 Druid介绍2. 配置Druid连接池3. 查看Druid监控
阅读更多...
Linux在线解压jar包的实现方式

Linux在线解压jar包的实现方式

《Linux在线解压jar包的实现方式》：本文主要介绍Linux在线解压jar包的实现方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录linux在线解压jar包解压 jar包的步骤总结Linux在线解压jar包在 Centos 中解压 jar 包可以使用 u
阅读更多...
c++ 类成员变量默认初始值的实现

c++ 类成员变量默认初始值的实现

《c++类成员变量默认初始值的实现》本文主要介绍了c++类成员变量默认初始值,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一起学习学习吧... 目录C++类成员变量初始化c++类的变量的初始化在C++中，如果使用类成员变量时未给定其初始值，那么它将被
阅读更多...
Qt使用QSqlDatabase连接MySQL实现增删改查功能

Qt使用QSqlDatabase连接MySQL实现增删改查功能

《Qt使用QSqlDatabase连接MySQL实现增删改查功能》这篇文章主要为大家详细介绍了Qt如何使用QSqlDatabase连接MySQL实现增删改查功能,文中的示例代码讲解详细,感兴趣的小伙伴... 目录一、创建数据表二、连接mysql数据库三、封装成一个完整的轻量级 ORM 风格类3.1 表结构
阅读更多...
基于Python实现一个图片拆分工具

基于Python实现一个图片拆分工具

《基于Python实现一个图片拆分工具》这篇文章主要为大家详细介绍了如何基于Python实现一个图片拆分工具,可以根据需要的行数和列数进行拆分,感兴趣的小伙伴可以跟随小编一起学习一下... 简单介绍先自己选择输入的图片，默认是输出到项目文件夹中，可以自己选择其他的文件夹，选择需要拆分的行数和列数，可以通过
阅读更多...
Python中将嵌套列表扁平化的多种实现方法

Python中将嵌套列表扁平化的多种实现方法

《Python中将嵌套列表扁平化的多种实现方法》在Python编程中,我们常常会遇到需要将嵌套列表（即列表中包含列表）转换为一个一维的扁平列表的需求,本文将给大家介绍了多种实现这一目标的方法,需要的朋... 目录python中将嵌套列表扁平化的方法技术背景实现步骤1. 使用嵌套列表推导式2. 使用itert
阅读更多...
Python使用pip工具实现包自动更新的多种方法

Python使用pip工具实现包自动更新的多种方法

《Python使用pip工具实现包自动更新的多种方法》本文深入探讨了使用Python的pip工具实现包自动更新的各种方法和技术,我们将从基础概念开始,逐步介绍手动更新方法、自动化脚本编写、结合CI/C... 目录1. 背景介绍1.1 目的和范围1.2 预期读者1.3 文档结构概述1.4 术语表1.4.1 核
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2