您的位置:首页 > 运维架构 > Linux

linux驱动之网卡驱动-虚拟网卡驱动编写

2017-06-16 00:44 465 查看
我们来实现这么一个目的

我ping 3.3.3.4的时候,按理说如果是真实网卡的话,我们3.3.3.3的机器,和3.3.3.4的机器。ping 3.3.3.4的时候3.3.3.3的机器会把包发给3.3.3.4,3.3.3.4收到包之后又会把包发给3.3.3.3

在驱动程序中用netif_rx用这个函数上报包 它就可以ping得通了。但是我们是虚拟网卡,并没有真正的网线,也没有3.3.3.4

但是我们可以造假,发包的时候发过去,然后马上回来上报就行了,构造一个假包

我们网卡把数据发送出去,不可能瞬间发出去,这个网卡把数据发送完之后应该会产生一个中断

我们来看真是的网卡





进入这个函数



发送完之后唤醒我们在发包时休眠的队列

我们skb->data的是这样的,一开始是mac头,然后是IP头,然后是type,后面是其他数据



这就是mac头



第一个是目的mac,第二个是源mac.还有其他协议什么的我们先不管



这是我们的ip头,





saddr是我们源ip, daddr是目的IP

代码如下

#include <Linux/module.h>

#include <linux/errno.h>

#include <linux/netdevice.h>

#include <linux/etherdevice.h>

#include <linux/kernel.h>

#include <linux/types.h>

#include <linux/fcntl.h>

#include <linux/interrupt.h>

#include <linux/ioport.h>

#include <linux/in.h>

#include <linux/skbuff.h>

#include <linux/spinlock.h>

#include <linux/string.h>

#include <linux/init.h>

#include <linux/bitops.h>

#include <linux/delay.h>

#include <linux/gfp.h>

#include <asm/system.h>

#include <asm/io.h>

#include <asm/irq.h>

#include<linux/slab.h>

#include<linux/ip.h>

static struct net_device *vnet_dev;

static void emulator_rx_packet(struct sk_buff *skb, struct net_device *dev)

{
/*参考LDD3*/
unsigned char *type;

// char *data;

// int len;
struct iphdr *ih;

// struct net_device *dest;
__be32 *saddr, *daddr, tmp;
unsigned char tmp_dev_addr[ETH_ALEN];
struct ethhdr *ethhdr;
struct sk_buff *rx_skb;
// 从硬件读出/保存数据
/* 对调"源/目的"的mac地址 */
ethhdr = (struct ethhdr *)skb->data;
memcpy(tmp_dev_addr, ethhdr->h_dest, ETH_ALEN);
memcpy(ethhdr->h_dest, ethhdr->h_source, ETH_ALEN);
memcpy(ethhdr->h_source, tmp_dev_addr, ETH_ALEN);
/* 对调"源/目的"的ip地址 */    
ih = (struct iphdr *)(skb->data + sizeof(struct ethhdr));

saddr = &ih->saddr;
daddr = &ih->daddr;
tmp = *saddr;
*saddr = *daddr;
*daddr = tmp;
//((u8 *)saddr)[2] ^= 1; /* change the third octet (class C) */
//((u8 *)daddr)[2] ^= 1;
type = skb->data + sizeof(struct ethhdr) + sizeof(struct iphdr);
//printk("tx package type = %02x\n", *type);
// 修改类型, 原来0x8表示ping
*type = 0; /* 0表示reply */

ih->check = 0;  /* and rebuild the checksum (ip needs it) */
ih->check = ip_fast_csum((unsigned char *)ih,ih->ihl);
// 构造一个sk_buff
rx_skb = dev_alloc_skb(skb->len + 2);
skb_reserve(rx_skb, 2); /* align IP on 16B boundary */
memcpy(skb_put(rx_skb, skb->len), skb->data, skb->len);
/* Write metadata, and then pass to the receive level */
rx_skb->dev = dev;
rx_skb->protocol = eth_type_trans(rx_skb, dev);
rx_skb->ip_summed = CHECKSUM_UNNECESSARY; /* don't check it */
dev->stats.rx_packets++;
dev->stats.rx_bytes += skb->len;

// 提交sk_buff
netif_rx(rx_skb);

}

static int gh_start_xmit(struct sk_buff *skb, struct net_device *dev)

{

static int cnt = 0;
printk("virt_net_send_packet cnt = %d\n", ++cnt);

/*停止该网卡的队列*/
netif_stop_queue(dev);
/*把sk_buff的数据写入网卡*/
/******************************/

/*构造一个假包,来上报*/
emulator_rx_packet(skb,dev);

/*已经把sk_buf的数据写入网卡了,我们释放*/
dev_kfree_skb(skb);
netif_wake_queue(dev);
/*更新统计信息*/
vnet_dev->stats.tx_packets++;
vnet_dev->stats.tx_bytes +=skb->len;

return 0;

}

static const struct net_device_ops gh_netdev_ops = {
.ndo_start_xmit= gh_start_xmit,

};

static int virtnet_init(void)

{

/*1.分配一个net_device结构体**/
vnet_dev=alloc_netdev(0, "ghnet%d", ether_setup);
/*2.设置*/
vnet_dev->netdev_ops= &gh_netdev_ops;

/*设置mac地址*/
vnet_dev->dev_addr[0] = 0x08;
vnet_dev->dev_addr[1] = 0x89;
vnet_dev->dev_addr[2] = 0x89;
vnet_dev->dev_addr[3] = 0x89;
vnet_dev->dev_addr[4] = 0x89;
vnet_dev->dev_addr[5] = 0x11;

/* 设置下面两项才能ping通 */
vnet_dev->flags           |= IFF_NOARP;
vnet_dev->features        |= NETIF_F_NO_CSUM;

/*3.注册*/
register_netdev(vnet_dev);
return 0;

}

static void virtnet_exit(void)

{
unregister_netdev(vnet_dev);
free_netdev(vnet_dev);

}

module_init(virtnet_init);

module_exit(virtnet_exit);

MODULE_LICENSE("GPL");

MODULE_AUTHOR("EIGHT");

测试结果如图

内容来自用户分享和网络整理,不保证内容的准确性,如有侵权内容,可联系管理员处理 点击这里给我发消息
标签: