Merge branch 'upstream-fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/linvil...
[linux-2.6] / drivers / block / aoe / aoenet.c
1 /* Copyright (c) 2006 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 <asm/unaligned.h>
12 #include "aoe.h"
13
14 #define NECODES 5
15
16 static char *aoe_errlist[] =
17 {
18         "no such error",
19         "unrecognized command code",
20         "bad argument parameter",
21         "device unavailable",
22         "config string present",
23         "unsupported version"
24 };
25
26 enum {
27         IFLISTSZ = 1024,
28 };
29
30 static char aoe_iflist[IFLISTSZ];
31 module_param_string(aoe_iflist, aoe_iflist, IFLISTSZ, 0600);
32 MODULE_PARM_DESC(aoe_iflist, "aoe_iflist=\"dev1 [dev2 ...]\"\n");
33
34 #ifndef MODULE
35 static int __init aoe_iflist_setup(char *str)
36 {
37         strncpy(aoe_iflist, str, IFLISTSZ);
38         aoe_iflist[IFLISTSZ - 1] = '\0';
39         return 1;
40 }
41
42 __setup("aoe_iflist=", aoe_iflist_setup);
43 #endif
44
45 int
46 is_aoe_netif(struct net_device *ifp)
47 {
48         register char *p, *q;
49         register int len;
50
51         if (aoe_iflist[0] == '\0')
52                 return 1;
53
54         p = aoe_iflist + strspn(aoe_iflist, WHITESPACE);
55         for (; *p; p = q + strspn(q, WHITESPACE)) {
56                 q = p + strcspn(p, WHITESPACE);
57                 if (q != p)
58                         len = q - p;
59                 else
60                         len = strlen(p); /* last token in aoe_iflist */
61
62                 if (strlen(ifp->name) == len && !strncmp(ifp->name, p, len))
63                         return 1;
64                 if (q == p)
65                         break;
66         }
67
68         return 0;
69 }
70
71 int
72 set_aoe_iflist(const char __user *user_str, size_t size)
73 {
74         if (size >= IFLISTSZ)
75                 return -EINVAL;
76
77         if (copy_from_user(aoe_iflist, user_str, size)) {
78                 printk(KERN_INFO "aoe: copy from user failed\n");
79                 return -EFAULT;
80         }
81         aoe_iflist[size] = 0x00;
82         return 0;
83 }
84
85 u64
86 mac_addr(char addr[6])
87 {
88         __be64 n = 0;
89         char *p = (char *) &n;
90
91         memcpy(p + 2, addr, 6); /* (sizeof addr != 6) */
92
93         return __be64_to_cpu(n);
94 }
95
96 void
97 aoenet_xmit(struct sk_buff *sl)
98 {
99         struct sk_buff *skb;
100
101         while ((skb = sl)) {
102                 sl = sl->next;
103                 skb->next = skb->prev = NULL;
104                 dev_queue_xmit(skb);
105         }
106 }
107
108 /* 
109  * (1) len doesn't include the header by default.  I want this. 
110  */
111 static int
112 aoenet_rcv(struct sk_buff *skb, struct net_device *ifp, struct packet_type *pt, struct net_device *orig_dev)
113 {
114         struct aoe_hdr *h;
115         u32 n;
116
117         skb = skb_share_check(skb, GFP_ATOMIC);
118         if (skb == NULL)
119                 return 0;
120         if (skb_linearize(skb))
121                 goto exit;
122         if (!is_aoe_netif(ifp))
123                 goto exit;
124         skb_push(skb, ETH_HLEN);        /* (1) */
125
126         h = (struct aoe_hdr *) skb->mac.raw;
127         n = be32_to_cpu(get_unaligned(&h->tag));
128         if ((h->verfl & AOEFL_RSP) == 0 || (n & 1<<31))
129                 goto exit;
130
131         if (h->verfl & AOEFL_ERR) {
132                 n = h->err;
133                 if (n > NECODES)
134                         n = 0;
135                 if (net_ratelimit())
136                         printk(KERN_ERR "aoe: error packet from %d.%d; ecode=%d '%s'\n",
137                                be16_to_cpu(get_unaligned(&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: unknown cmd %d\n", h->cmd);
151         }
152 exit:
153         dev_kfree_skb(skb);
154         return 0;
155 }
156
157 static struct packet_type aoe_pt = {
158         .type = __constant_htons(ETH_P_AOE),
159         .func = aoenet_rcv,
160 };
161
162 int __init
163 aoenet_init(void)
164 {
165         dev_add_pack(&aoe_pt);
166         return 0;
167 }
168
169 void
170 aoenet_exit(void)
171 {
172         dev_remove_pack(&aoe_pt);
173 }
174