This commit was manufactured by cvs2svn to create branch 'vserver'.

[linux-2.6.git] / drivers / block / aoe / aoenet.c

diff --git a/drivers/block/aoe/aoenet.c b/drivers/block/aoe/aoenet.c
new file mode 100644 (file)
index 0000000..cc1945b
--- /dev/null
+++ b/drivers/block/aoe/aoenet.c
@@ -0,0 +1,172 @@
+/* Copyright (c) 2004 Coraid, Inc.  See COPYING for GPL terms. */
+/*
+ * aoenet.c
+ * Ethernet portion of AoE driver
+ */
+
+#include <linux/hdreg.h>
+#include <linux/blkdev.h>
+#include <linux/netdevice.h>
+#include "aoe.h"
+
+#define NECODES 5
+
+static char *aoe_errlist[] =
+{
+       "no such error",
+       "unrecognized command code",
+       "bad argument parameter",
+       "device unavailable",
+       "config string present",
+       "unsupported version"
+};
+
+enum {
+       IFLISTSZ = 1024,
+};
+
+static char aoe_iflist[IFLISTSZ];
+
+int
+is_aoe_netif(struct net_device *ifp)
+{
+       register char *p, *q;
+       register int len;
+
+       if (aoe_iflist[0] == '\0')
+               return 1;
+
+       for (p = aoe_iflist; *p; p = q + strspn(q, WHITESPACE)) {
+               q = p + strcspn(p, WHITESPACE);
+               if (q != p)
+                       len = q - p;
+               else
+                       len = strlen(p); /* last token in aoe_iflist */
+
+               if (strlen(ifp->name) == len && !strncmp(ifp->name, p, len))
+                       return 1;
+               if (q == p)
+                       break;
+       }
+
+       return 0;
+}
+
+int
+set_aoe_iflist(const char __user *user_str, size_t size)
+{
+       if (size >= IFLISTSZ)
+               return -EINVAL;
+
+       if (copy_from_user(aoe_iflist, user_str, size)) {
+               printk(KERN_INFO "aoe: %s: copy from user failed\n", __FUNCTION__);
+               return -EFAULT;
+       }
+       aoe_iflist[size] = 0x00;
+       return 0;
+}
+
+u64
+mac_addr(char addr[6])
+{
+       u64 n = 0;
+       char *p = (char *) &n;
+
+       memcpy(p + 2, addr, 6); /* (sizeof addr != 6) */
+
+       return __be64_to_cpu(n);
+}
+
+static struct sk_buff *
+skb_check(struct sk_buff *skb)
+{
+       if (skb_is_nonlinear(skb))
+       if ((skb = skb_share_check(skb, GFP_ATOMIC)))
+       if (skb_linearize(skb, GFP_ATOMIC) < 0) {
+               dev_kfree_skb(skb);
+               return NULL;
+       }
+       return skb;
+}
+
+void
+aoenet_xmit(struct sk_buff *sl)
+{
+       struct sk_buff *skb;
+
+       while ((skb = sl)) {
+               sl = sl->next;
+               skb->next = skb->prev = NULL;
+               dev_queue_xmit(skb);
+       }
+}
+
+/* 
+ * (1) len doesn't include the header by default.  I want this. 
+ */
+static int
+aoenet_rcv(struct sk_buff *skb, struct net_device *ifp, struct packet_type *pt)
+{
+       struct aoe_hdr *h;
+       ulong n;
+
+       skb = skb_check(skb);
+       if (!skb)
+               return 0;
+
+       if (!is_aoe_netif(ifp))
+               goto exit;
+
+       //skb->len += ETH_HLEN; /* (1) */
+       skb_push(skb, ETH_HLEN);        /* (1) */
+
+       h = (struct aoe_hdr *) skb->mac.raw;
+       n = __be32_to_cpu(*((u32 *) h->tag));
+       if ((h->verfl & AOEFL_RSP) == 0 || (n & 1<<31))
+               goto exit;
+
+       if (h->verfl & AOEFL_ERR) {
+               n = h->err;
+               if (n > NECODES)
+                       n = 0;
+               if (net_ratelimit())
+                       printk(KERN_ERR "aoe: aoenet_rcv: error packet from %d.%d; "
+                              "ecode=%d '%s'\n",
+                              __be16_to_cpu(*((u16 *) h->major)), h->minor, 
+                              h->err, aoe_errlist[n]);
+               goto exit;
+       }
+
+       switch (h->cmd) {
+       case AOECMD_ATA:
+               aoecmd_ata_rsp(skb);
+               break;
+       case AOECMD_CFG:
+               aoecmd_cfg_rsp(skb);
+               break;
+       default:
+               printk(KERN_INFO "aoe: aoenet_rcv: unknown cmd %d\n", h->cmd);
+       }
+exit:
+       dev_kfree_skb(skb);
+       return 0;
+}
+
+static struct packet_type aoe_pt = {
+       .type = __constant_htons(ETH_P_AOE),
+       .func = aoenet_rcv,
+};
+
+int __init
+aoenet_init(void)
+{
+       dev_add_pack(&aoe_pt);
+       return 0;
+}
+
+void
+aoenet_exit(void)
+{
+       dev_remove_pack(&aoe_pt);
+}
+