]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* Copyright (c) 2004 Coraid, Inc. See COPYING for GPL terms. */ |
2 | /* | |
3 | * aoenet.c | |
4 | * Ethernet portion of AoE driver | |
5 | */ | |
6 | ||
7 | #include <linux/hdreg.h> | |
8 | #include <linux/blkdev.h> | |
9 | #include <linux/netdevice.h> | |
03c41c43 | 10 | #include <linux/moduleparam.h> |
1da177e4 LT |
11 | #include "aoe.h" |
12 | ||
13 | #define NECODES 5 | |
14 | ||
15 | static char *aoe_errlist[] = | |
16 | { | |
17 | "no such error", | |
18 | "unrecognized command code", | |
19 | "bad argument parameter", | |
20 | "device unavailable", | |
21 | "config string present", | |
22 | "unsupported version" | |
23 | }; | |
24 | ||
25 | enum { | |
26 | IFLISTSZ = 1024, | |
27 | }; | |
28 | ||
29 | static char aoe_iflist[IFLISTSZ]; | |
03c41c43 EC |
30 | module_param_string(aoe_iflist, aoe_iflist, IFLISTSZ, 0600); |
31 | MODULE_PARM_DESC(aoe_iflist, "aoe_iflist=\"dev1 [dev2 ...]\"\n"); | |
32 | ||
33 | #ifndef MODULE | |
34 | static int __init aoe_iflist_setup(char *str) | |
35 | { | |
36 | strncpy(aoe_iflist, str, IFLISTSZ); | |
37 | aoe_iflist[IFLISTSZ - 1] = '\0'; | |
38 | return 1; | |
39 | } | |
40 | ||
41 | __setup("aoe_iflist=", aoe_iflist_setup); | |
42 | #endif | |
1da177e4 LT |
43 | |
44 | int | |
45 | is_aoe_netif(struct net_device *ifp) | |
46 | { | |
47 | register char *p, *q; | |
48 | register int len; | |
49 | ||
50 | if (aoe_iflist[0] == '\0') | |
51 | return 1; | |
52 | ||
03c41c43 EC |
53 | p = aoe_iflist + strspn(aoe_iflist, WHITESPACE); |
54 | for (; *p; p = q + strspn(q, WHITESPACE)) { | |
1da177e4 LT |
55 | q = p + strcspn(p, WHITESPACE); |
56 | if (q != p) | |
57 | len = q - p; | |
58 | else | |
59 | len = strlen(p); /* last token in aoe_iflist */ | |
60 | ||
61 | if (strlen(ifp->name) == len && !strncmp(ifp->name, p, len)) | |
62 | return 1; | |
63 | if (q == p) | |
64 | break; | |
65 | } | |
66 | ||
67 | return 0; | |
68 | } | |
69 | ||
70 | int | |
71 | set_aoe_iflist(const char __user *user_str, size_t size) | |
72 | { | |
73 | if (size >= IFLISTSZ) | |
74 | return -EINVAL; | |
75 | ||
76 | if (copy_from_user(aoe_iflist, user_str, size)) { | |
77 | printk(KERN_INFO "aoe: %s: copy from user failed\n", __FUNCTION__); | |
78 | return -EFAULT; | |
79 | } | |
80 | aoe_iflist[size] = 0x00; | |
81 | return 0; | |
82 | } | |
83 | ||
84 | u64 | |
85 | mac_addr(char addr[6]) | |
86 | { | |
63e9cc5d | 87 | __be64 n = 0; |
1da177e4 LT |
88 | char *p = (char *) &n; |
89 | ||
90 | memcpy(p + 2, addr, 6); /* (sizeof addr != 6) */ | |
91 | ||
92 | return __be64_to_cpu(n); | |
93 | } | |
94 | ||
95 | static struct sk_buff * | |
96 | skb_check(struct sk_buff *skb) | |
97 | { | |
98 | if (skb_is_nonlinear(skb)) | |
99 | if ((skb = skb_share_check(skb, GFP_ATOMIC))) | |
100 | if (skb_linearize(skb, GFP_ATOMIC) < 0) { | |
101 | dev_kfree_skb(skb); | |
102 | return NULL; | |
103 | } | |
104 | return skb; | |
105 | } | |
106 | ||
107 | void | |
108 | aoenet_xmit(struct sk_buff *sl) | |
109 | { | |
110 | struct sk_buff *skb; | |
111 | ||
112 | while ((skb = sl)) { | |
113 | sl = sl->next; | |
114 | skb->next = skb->prev = NULL; | |
115 | dev_queue_xmit(skb); | |
116 | } | |
117 | } | |
118 | ||
119 | /* | |
120 | * (1) len doesn't include the header by default. I want this. | |
121 | */ | |
122 | static int | |
f2ccd8fa | 123 | aoenet_rcv(struct sk_buff *skb, struct net_device *ifp, struct packet_type *pt, struct net_device *orig_dev) |
1da177e4 LT |
124 | { |
125 | struct aoe_hdr *h; | |
63e9cc5d | 126 | u32 n; |
1da177e4 LT |
127 | |
128 | skb = skb_check(skb); | |
129 | if (!skb) | |
130 | return 0; | |
131 | ||
132 | if (!is_aoe_netif(ifp)) | |
133 | goto exit; | |
134 | ||
135 | //skb->len += ETH_HLEN; /* (1) */ | |
136 | skb_push(skb, ETH_HLEN); /* (1) */ | |
137 | ||
138 | h = (struct aoe_hdr *) skb->mac.raw; | |
63e9cc5d | 139 | n = be32_to_cpu(h->tag); |
1da177e4 LT |
140 | if ((h->verfl & AOEFL_RSP) == 0 || (n & 1<<31)) |
141 | goto exit; | |
142 | ||
143 | if (h->verfl & AOEFL_ERR) { | |
144 | n = h->err; | |
145 | if (n > NECODES) | |
146 | n = 0; | |
147 | if (net_ratelimit()) | |
148 | printk(KERN_ERR "aoe: aoenet_rcv: error packet from %d.%d; " | |
149 | "ecode=%d '%s'\n", | |
63e9cc5d | 150 | be16_to_cpu(h->major), h->minor, |
1da177e4 LT |
151 | h->err, aoe_errlist[n]); |
152 | goto exit; | |
153 | } | |
154 | ||
155 | switch (h->cmd) { | |
156 | case AOECMD_ATA: | |
157 | aoecmd_ata_rsp(skb); | |
158 | break; | |
159 | case AOECMD_CFG: | |
160 | aoecmd_cfg_rsp(skb); | |
161 | break; | |
162 | default: | |
163 | printk(KERN_INFO "aoe: aoenet_rcv: unknown cmd %d\n", h->cmd); | |
164 | } | |
165 | exit: | |
166 | dev_kfree_skb(skb); | |
167 | return 0; | |
168 | } | |
169 | ||
170 | static struct packet_type aoe_pt = { | |
171 | .type = __constant_htons(ETH_P_AOE), | |
172 | .func = aoenet_rcv, | |
173 | }; | |
174 | ||
175 | int __init | |
176 | aoenet_init(void) | |
177 | { | |
178 | dev_add_pack(&aoe_pt); | |
179 | return 0; | |
180 | } | |
181 | ||
182 | void | |
183 | aoenet_exit(void) | |
184 | { | |
185 | dev_remove_pack(&aoe_pt); | |
186 | } | |
187 |