tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
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>
10#include <linux/moduleparam.h>
11#include "aoe.h"
12
13#define NECODES 5
14
15static 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
25enum {
26 IFLISTSZ = 1024,
27};
28
29static char aoe_iflist[IFLISTSZ];
30module_param_string(aoe_iflist, aoe_iflist, IFLISTSZ, 0600);
31MODULE_PARM_DESC(aoe_iflist, "aoe_iflist=\"dev1 [dev2 ...]\"\n");
32
33#ifndef MODULE
34static 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
43
44int
45is_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
53 p = aoe_iflist + strspn(aoe_iflist, WHITESPACE);
54 for (; *p; p = q + strspn(q, WHITESPACE)) {
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
70int
71set_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
84u64
85mac_addr(char addr[6])
86{
87 __be64 n = 0;
88 char *p = (char *) &n;
89
90 memcpy(p + 2, addr, 6); /* (sizeof addr != 6) */
91
92 return __be64_to_cpu(n);
93}
94
95void
96aoenet_xmit(struct sk_buff *sl)
97{
98 struct sk_buff *skb;
99
100 while ((skb = sl)) {
101 sl = sl->next;
102 skb->next = skb->prev = NULL;
103 dev_queue_xmit(skb);
104 }
105}
106
107/*
108 * (1) len doesn't include the header by default. I want this.
109 */
110static int
111aoenet_rcv(struct sk_buff *skb, struct net_device *ifp, struct packet_type *pt, struct net_device *orig_dev)
112{
113 struct aoe_hdr *h;
114 u32 n;
115
116 skb = skb_share_check(skb, GFP_ATOMIC);
117 if (skb == NULL)
118 return 0;
119 if (skb_linearize(skb))
120 goto exit;
121 if (!is_aoe_netif(ifp))
122 goto exit;
123 skb_push(skb, ETH_HLEN); /* (1) */
124
125 h = (struct aoe_hdr *) skb->mac.raw;
126 n = be32_to_cpu(h->tag);
127 if ((h->verfl & AOEFL_RSP) == 0 || (n & 1<<31))
128 goto exit;
129
130 if (h->verfl & AOEFL_ERR) {
131 n = h->err;
132 if (n > NECODES)
133 n = 0;
134 if (net_ratelimit())
135 printk(KERN_ERR "aoe: aoenet_rcv: error packet from %d.%d; "
136 "ecode=%d '%s'\n",
137 be16_to_cpu(h->major), h->minor,
138 h->err, aoe_errlist[n]);
139 goto exit;
140 }
141
142 switch (h->cmd) {
143 case AOECMD_ATA:
144 aoecmd_ata_rsp(skb);
145 break;
146 case AOECMD_CFG:
147 aoecmd_cfg_rsp(skb);
148 break;
149 default:
150 printk(KERN_INFO "aoe: aoenet_rcv: unknown cmd %d\n", h->cmd);
151 }
152exit:
153 dev_kfree_skb(skb);
154 return 0;
155}
156
157static struct packet_type aoe_pt = {
158 .type = __constant_htons(ETH_P_AOE),
159 .func = aoenet_rcv,
160};
161
162int __init
163aoenet_init(void)
164{
165 dev_add_pack(&aoe_pt);
166 return 0;
167}
168
169void
170aoenet_exit(void)
171{
172 dev_remove_pack(&aoe_pt);
173}
174