1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
|
#include <dde26.h> /* l4dde26_*() */
#include <dde26_net.h> /* l4dde26 networking */
#include <linux/netdevice.h> /* struct sk_buff */
#include <linux/pci.h> /* pci_unregister_driver() */
#include <linux/init.h> // initcall()
#include <linux/delay.h> // msleep()
#include "arping.h"
int using_std = 1;
extern int arping_verbose;
#define VERBOSE_LOG(fmt, ...) \
do { \
if (arping_verbose) printk(fmt, ##__VA_ARGS__); \
} while (0);
extern struct pci_driver ne2k_driver;
extern int arping(void);
void open_nw_dev(void);
void open_nw_dev()
{
struct net_device *dev;
struct net *net;
read_lock(&dev_base_lock);
for_each_net(net) {
for_each_netdev(net, dev) {
int err = 0;
printk("dev: '%s'\n", dev->name);
printk("MAC: "mac_fmt"\n", mac_str(dev->dev_addr));
err = dev_open(dev);
}
}
read_unlock(&dev_base_lock);
}
void close_nw_dev(void);
void close_nw_dev(void)
{
struct net_device *dev;
struct net *net;
read_lock(&dev_base_lock);
for_each_net(net) {
for_each_netdev(net, dev) {
int err = 0;
err = dev_close(dev);
printk("closed %s\n", dev->name);
}
}
read_unlock(&dev_base_lock);
}
static int net_rx_handle(struct sk_buff *skb)
{
skb_push(skb, skb->dev->hard_header_len);
struct arping_elem *e = kmalloc(sizeof(struct arping_elem), GFP_KERNEL);
e->skb = skb;
skb_get(skb);
e->next = NULL;
if (arping_list == NULL)
arping_list = e;
else {
struct arping_elem *f = arping_list;
while (f->next)
f = f->next;
f->next = e;
}
ddekit_sem_up(arping_semaphore);
kfree_skb(skb);
VERBOSE_LOG("freed skb, returning from netif_rx\n");
return NET_RX_SUCCESS;
}
//subsys_initcall(l4dde26_init_pci);
int main(int argc, char **argv);
int main(int argc, char **argv)
{
l4dde26_init();
l4dde26_process_init();
l4dde26_softirq_init();
printk("Initializing skb subsystem\n");
skb_init();
l4dde26_do_initcalls();
printk("Setting rx callback @ %p\n", net_rx_handle);
l4dde26_register_rx_callback(net_rx_handle);
printk("Opening nw devs.\n");
open_nw_dev();
printk("dev is up and ready.\n");
arping();
close_nw_dev();
printk("shut down driver\n");
return 0;
}
|
