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