[NET]: Clean up skb_linearize
[linux-2.6.git] / drivers / block / aoe / aoenet.c
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
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];
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
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
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
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 {
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
95 void
96 aoenet_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  */
110 static int
111 aoenet_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         }
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