Linux 网络装备驱动

一.网络装备驱动框架 

接收
将报文从装备驱动接受并送入协议栈

老API netif_if
编写网络装备驱动
步调
1.注册一个网络装备
2.填充net_device_ops布局体
3.编写接收发送函数

1. // SPDX-License-Identifier: GPL-2.0-only
2. /*
3. * This module emits "Hello, world" on printk when loaded.
4. *
5. * It is designed to be used for basic evaluation of the module loading
6. * subsystem (for example when validating module signing/verification). It
7. * lacks any extra dependencies, and will not normally be loaded by the
8. * system unless explicitly requested by name.
9. */
12. #include <linux/kernel.h>
13. #include <linux/jiffies.h>
14. #include <linux/module.h>
15. #include <linux/interrupt.h>
16. #include <linux/fs.h>
17. #include <linux/types.h>
18. #include <linux/string.h>
19. #include <linux/socket.h>
20. #include <linux/errno.h>
21. #include <linux/fcntl.h>
22. #include <linux/in.h>
24. #include <linux/uaccess.h>
25. #include <linux/io.h>
27. #include <linux/inet.h>
28. #include <linux/netdevice.h>
29. #include <linux/etherdevice.h>
30. #include <linux/skbuff.h>
31. #include <linux/ethtool.h>
32. #include <net/sock.h>
33. #include <net/checksum.h>
34. #include <linux/if_ether.h>        /* For the statistics structure. */
35. #include <linux/if_arp.h>        /* For ARPHRD_ETHER */
36. #include <linux/ip.h>
37. #include <linux/tcp.h>
38. #include <linux/percpu.h>
39. #include <linux/net_tstamp.h>
40. #include <net/net_namespace.h>
41. #include <linux/u64_stats_sync.h>
42. #include <linux/printk.h>
43. #include <linux/icmp.h>
45. #define DEBUG_TEST_NETDEV
47. #define TEST_NETDEV_NAME "test%d"
48. #define MAX_JUMBO_FRAME_SIZE         0x3F00
50. static struct net_device *test_netdev;
51. #ifdef DEBUG_TEST_NETDEV
52. static void dump_skb (struct sk_buff * skb)
53. {
54.   print_hex_dump(KERN_ERR, "data: ", DUMP_PREFIX_OFFSET,
55.                          16, 1, skb->data, skb->len, true);
56.   return;
57. }
58. #endif
59. static int test_open(struct net_device *dev)
60. {
61.         printk("<%s:%d>\n", __FUNCTION__,__LINE__);
62.         return 0;
63. }
64. static int test_close(struct net_device *dev)
65. {
66.         printk("<%s:%d>\n", __FUNCTION__,__LINE__);
67.         return 0;
68. }
69. netdev_tx_t        test_xmit_frame(struct sk_buff *skb, struct net_device *dev)
70. {
71.         int len;
72.         struct ethhdr *ethh = eth_hdr(skb);
73.         struct iphdr *iph = ip_hdr(skb);
74.         struct icmphdr *icmph = icmp_hdr(skb);
75.         char mac_tmp[6];
76.         __be32 addr_tmp;
77.         printk("<%s:%d>\n", __FUNCTION__,__LINE__);
78.        
79. #ifdef DEBUG_TEST_NETDEV
80.         dump_skb(skb);
81. #endif
82.         memcpy(mac_tmp, ethh->h_source, 6);
83.         memcpy(ethh->h_source, ethh->h_dest, 6);
84.         memcpy(ethh->h_dest, mac_tmp, 6);
85.         addr_tmp = iph->saddr;
86.         iph->saddr = iph->daddr;
87.         iph->daddr = addr_tmp;
88.         icmph->type = 0;
89.         icmph->checksum = 0;
90.         icmph->checksum = ip_compute_csum(icmph, iph->tot_len - iph->ihl);
91.         iph->check = 0;
92.         iph->check = ip_compute_csum(iph, iph->tot_len);
93.        
94. #ifdef DEBUG_TEST_NETDEV
95.         dump_skb(skb);
96. #endif
97.         skb_tx_timestamp(skb);
99.         /* do not fool net_timestamp_check() with various clock bases */
100.         skb->tstamp = 0;
102.         skb_orphan(skb);
104.         /* Before queueing this packet to netif_rx(),
105.          * make sure dst is refcounted.
106.          */
107.         skb_dst_force(skb);
108.        
109.         skb->protocol = eth_type_trans(skb, dev);
113.         len = skb->len;
114.        
115.         if (likely(netif_rx(skb) == NET_RX_SUCCESS)) {
116.                 test_netdev->stats.rx_bytes += len;
117.                 test_netdev->stats.tx_bytes += len;
118.                 test_netdev->stats.rx_packets++;
119.                 test_netdev->stats.tx_packets++;
120.         }
121.        
122.         return NETDEV_TX_OK;
123. }
125. static void        test_set_rx_mode(struct net_device *dev)
126. {
127.         printk("<%s:%d>\n", __FUNCTION__,__LINE__);
128.         return;
129. }
131. static int test_set_mac(struct net_device *dev, void *addr)
132. {
133.         struct sockaddr *saddr = addr;
134.         printk("<%s:%d> mac: %02x:%02x:%02x:%02x:%02x:%02x\n",__FUNCTION__,__LINE__,
135.                 saddr->sa_data[0],saddr->sa_data[1],saddr->sa_data[2],saddr->sa_data[3],saddr->sa_data[4],saddr->sa_data[5]);
136.         memcpy(dev->dev_addr, saddr->sa_data, dev->addr_len);
137.         return 0;
138. }
140. static void test_tx_timeout (struct net_device *dev)
141. {
142.         printk("<%s:%d>\n", __FUNCTION__,__LINE__);
143.         return;
144. }
145. static int test_change_mtu(struct net_device *dev, int new_mtu)
146. {
147.         printk("<%s:%d>: mtu: %d\n", __FUNCTION__,__LINE__, new_mtu);
148.         return 0;
149. }
150. static int test_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
151. {
153.         printk("<%s:%d> cmd %d\n", __FUNCTION__,__LINE__, cmd);
154.         return 0;
156. }
157. static void test_netpoll(struct net_device *dev)
158. {
159.         printk("<%s:%d>\n", __FUNCTION__,__LINE__);
160.         return;
161. }
162. static netdev_features_t test_fix_features(struct net_device *dev, netdev_features_t features)
163. {
164.        
165.         printk("<%s:%d> features %llx\n", __FUNCTION__,__LINE__, dev->features);
166.         return features;
167. }
168. static int test_set_features(struct net_device *dev, netdev_features_t features)
169. {
170.         printk("<%s:%d> features %llx\n", __FUNCTION__,__LINE__, features);
171.         dev->features = features;
172.         return 1;
173. }
174. static void test_change_rx_flags(struct net_device *dev, int flags)
175. {
176.         printk("<%s:%d> flags %d\n", __FUNCTION__,__LINE__, flags);
177. }
179. static const struct net_device_ops test_netdev_ops = {
180.         .ndo_open                        = test_open,
181.         .ndo_stop                        = test_close,
182.         .ndo_start_xmit                = test_xmit_frame,
183.         .ndo_set_rx_mode        = test_set_rx_mode,
184.         .ndo_set_mac_address        = test_set_mac,
185.         .ndo_tx_timeout                = test_tx_timeout,
186.         .ndo_change_mtu                = test_change_mtu,
187.         .ndo_do_ioctl                = test_ioctl,
188.         .ndo_validate_addr        = eth_validate_addr,
190. #ifdef CONFIG_NET_POLL_CONTROLLER
191.         .ndo_poll_controller        = test_netpoll,
192. #endif
193.         .ndo_fix_features                = test_fix_features,
194.         .ndo_set_features                = test_set_features,
195.            .ndo_change_rx_flags         = test_change_rx_flags,
198. };
201. static int __init test_netdev_init(void)
202. {
204.        
205.         int ret = 0;
206.         pr_warn("init test netdev\n");
207.         test_netdev = alloc_etherdev(sizeof(struct net_device));
208.         if (!test_netdev)
209.                 goto out;
210.         test_netdev->netdev_ops = &test_netdev_ops;
211.         strcpy(test_netdev->name, TEST_NETDEV_NAME);
212.         ret = register_netdev(test_netdev);
213.         if(ret)
214.                 goto failed;
215.         test_netdev->min_mtu = ETH_ZLEN - ETH_HLEN;
216.         test_netdev->max_mtu = MAX_JUMBO_FRAME_SIZE - (ETH_HLEN + ETH_FCS_LEN);
217.         memset(test_netdev->dev_addr, 0x60, test_netdev->addr_len);
218.         return 0;
219. failed:
220.         free_netdev(test_netdev);
221. out:
222.         return 0;
223. }
225. module_init(test_netdev_init);
227. static void __exit test_netdev_exit(void)
228. {
229.         pr_warn("exit test netdev\n");
230.         unregister_netdev(test_netdev);
231.         free_netdev(test_netdev);
233. }
235. module_exit(test_netdev_exit);
237. MODULE_AUTHOR("Kees Cook <keescook@chromium.org>");
238. MODULE_LICENSE("GPL");

复制代码

 test0就是我们的驱动

免责声明：如果侵犯了您的权益，请联系站长，我们会及时删除侵权内容，谢谢合作！更多信息从访问主页：qidao123.com:ToB企服之家，中国第一个企服评测及商务社交产业平台。