aoenet.c
资源名称:block.rar [点击查看]
上传用户:ajay2009
上传日期:2009-05-22
资源大小:495k
文件大小:3k
源码类别:
驱动编程
开发平台:
Unix_Linux
- /* 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 <linux/moduleparam.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];
- module_param_string(aoe_iflist, aoe_iflist, IFLISTSZ, 0600);
- MODULE_PARM_DESC(aoe_iflist, "aoe_iflist="dev1 [dev2 ...]"n");
- #ifndef MODULE
- static int __init aoe_iflist_setup(char *str)
- {
- strncpy(aoe_iflist, str, IFLISTSZ);
- aoe_iflist[IFLISTSZ - 1] = ' ';
- return 1;
- }
- __setup("aoe_iflist=", aoe_iflist_setup);
- #endif
- int
- is_aoe_netif(struct net_device *ifp)
- {
- register char *p, *q;
- register int len;
- if (aoe_iflist[0] == ' ')
- return 1;
- p = aoe_iflist + strspn(aoe_iflist, WHITESPACE);
- for (; *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 failedn", __FUNCTION__);
- return -EFAULT;
- }
- aoe_iflist[size] = 0x00;
- return 0;
- }
- u64
- mac_addr(char addr[6])
- {
- __be64 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 net_device *orig_dev)
- {
- struct aoe_hdr *h;
- u32 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(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(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 %dn", 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);
- }