Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * INET An implementation of the TCP/IP protocol suite for the LINUX |
| 3 | * operating system. INET is implemented using the BSD Socket |
| 4 | * interface as the means of communication with the user level. |
| 5 | * |
| 6 | * FDDI-type device handling. |
| 7 | * |
| 8 | * Version: @(#)fddi.c 1.0.0 08/12/96 |
| 9 | * |
| 10 | * Authors: Lawrence V. Stefani, <stefani@lkg.dec.com> |
| 11 | * |
| 12 | * fddi.c is based on previous eth.c and tr.c work by |
Jesper Juhl | 02c30a8 | 2005-05-05 16:16:16 -0700 | [diff] [blame] | 13 | * Ross Biro |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 14 | * Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG> |
| 15 | * Mark Evans, <evansmp@uhura.aston.ac.uk> |
| 16 | * Florian La Roche, <rzsfl@rz.uni-sb.de> |
| 17 | * Alan Cox, <gw4pts@gw4pts.ampr.org> |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 18 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 19 | * This program is free software; you can redistribute it and/or |
| 20 | * modify it under the terms of the GNU General Public License |
| 21 | * as published by the Free Software Foundation; either version |
| 22 | * 2 of the License, or (at your option) any later version. |
| 23 | * |
| 24 | * Changes |
| 25 | * Alan Cox : New arp/rebuild header |
| 26 | * Maciej W. Rozycki : IPv6 support |
| 27 | */ |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 28 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | #include <linux/module.h> |
| 30 | #include <asm/system.h> |
| 31 | #include <linux/types.h> |
| 32 | #include <linux/kernel.h> |
| 33 | #include <linux/sched.h> |
| 34 | #include <linux/string.h> |
| 35 | #include <linux/mm.h> |
| 36 | #include <linux/socket.h> |
| 37 | #include <linux/in.h> |
| 38 | #include <linux/inet.h> |
| 39 | #include <linux/netdevice.h> |
| 40 | #include <linux/fddidevice.h> |
| 41 | #include <linux/if_ether.h> |
| 42 | #include <linux/skbuff.h> |
| 43 | #include <linux/errno.h> |
| 44 | #include <net/arp.h> |
| 45 | #include <net/sock.h> |
| 46 | |
| 47 | /* |
| 48 | * Create the FDDI MAC header for an arbitrary protocol layer |
| 49 | * |
| 50 | * saddr=NULL means use device source address |
| 51 | * daddr=NULL means leave destination address (eg unresolved arp) |
| 52 | */ |
| 53 | |
| 54 | static int fddi_header(struct sk_buff *skb, struct net_device *dev, |
| 55 | unsigned short type, |
| 56 | void *daddr, void *saddr, unsigned len) |
| 57 | { |
| 58 | int hl = FDDI_K_SNAP_HLEN; |
| 59 | struct fddihdr *fddi; |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 60 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 | if(type != ETH_P_IP && type != ETH_P_IPV6 && type != ETH_P_ARP) |
| 62 | hl=FDDI_K_8022_HLEN-3; |
| 63 | fddi = (struct fddihdr *)skb_push(skb, hl); |
| 64 | fddi->fc = FDDI_FC_K_ASYNC_LLC_DEF; |
| 65 | if(type == ETH_P_IP || type == ETH_P_IPV6 || type == ETH_P_ARP) |
| 66 | { |
| 67 | fddi->hdr.llc_snap.dsap = FDDI_EXTENDED_SAP; |
| 68 | fddi->hdr.llc_snap.ssap = FDDI_EXTENDED_SAP; |
| 69 | fddi->hdr.llc_snap.ctrl = FDDI_UI_CMD; |
| 70 | fddi->hdr.llc_snap.oui[0] = 0x00; |
| 71 | fddi->hdr.llc_snap.oui[1] = 0x00; |
| 72 | fddi->hdr.llc_snap.oui[2] = 0x00; |
| 73 | fddi->hdr.llc_snap.ethertype = htons(type); |
| 74 | } |
| 75 | |
| 76 | /* Set the source and destination hardware addresses */ |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 77 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | if (saddr != NULL) |
| 79 | memcpy(fddi->saddr, saddr, dev->addr_len); |
| 80 | else |
| 81 | memcpy(fddi->saddr, dev->dev_addr, dev->addr_len); |
| 82 | |
| 83 | if (daddr != NULL) |
| 84 | { |
| 85 | memcpy(fddi->daddr, daddr, dev->addr_len); |
| 86 | return(hl); |
| 87 | } |
| 88 | |
| 89 | return(-hl); |
| 90 | } |
| 91 | |
| 92 | |
| 93 | /* |
| 94 | * Rebuild the FDDI MAC header. This is called after an ARP |
| 95 | * (or in future other address resolution) has completed on |
| 96 | * this sk_buff. We now let ARP fill in the other fields. |
| 97 | */ |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 98 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 99 | static int fddi_rebuild_header(struct sk_buff *skb) |
| 100 | { |
| 101 | struct fddihdr *fddi = (struct fddihdr *)skb->data; |
| 102 | |
| 103 | #ifdef CONFIG_INET |
| 104 | if (fddi->hdr.llc_snap.ethertype == __constant_htons(ETH_P_IP)) |
| 105 | /* Try to get ARP to resolve the header and fill destination address */ |
| 106 | return arp_find(fddi->daddr, skb); |
| 107 | else |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 108 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 | { |
Alexey Dobriyan | 57bf145 | 2005-08-25 16:06:19 -0700 | [diff] [blame] | 110 | printk("%s: Don't know how to resolve type %04X addresses.\n", |
| 111 | skb->dev->name, ntohs(fddi->hdr.llc_snap.ethertype)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | return(0); |
| 113 | } |
| 114 | } |
| 115 | |
| 116 | |
| 117 | /* |
| 118 | * Determine the packet's protocol ID and fill in skb fields. |
| 119 | * This routine is called before an incoming packet is passed |
| 120 | * up. It's used to fill in specific skb fields and to set |
| 121 | * the proper pointer to the start of packet data (skb->data). |
| 122 | */ |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 123 | |
Alexey Dobriyan | ab61148 | 2005-07-12 12:08:43 -0700 | [diff] [blame] | 124 | __be16 fddi_type_trans(struct sk_buff *skb, struct net_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | { |
| 126 | struct fddihdr *fddi = (struct fddihdr *)skb->data; |
Alexey Dobriyan | ab61148 | 2005-07-12 12:08:43 -0700 | [diff] [blame] | 127 | __be16 type; |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 128 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | /* |
| 130 | * Set mac.raw field to point to FC byte, set data field to point |
| 131 | * to start of packet data. Assume 802.2 SNAP frames for now. |
| 132 | */ |
| 133 | |
| 134 | skb->mac.raw = skb->data; /* point to frame control (FC) */ |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 135 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 | if(fddi->hdr.llc_8022_1.dsap==0xe0) |
| 137 | { |
| 138 | skb_pull(skb, FDDI_K_8022_HLEN-3); |
| 139 | type = __constant_htons(ETH_P_802_2); |
| 140 | } |
| 141 | else |
| 142 | { |
| 143 | skb_pull(skb, FDDI_K_SNAP_HLEN); /* adjust for 21 byte header */ |
| 144 | type=fddi->hdr.llc_snap.ethertype; |
| 145 | } |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 146 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | /* Set packet type based on destination address and flag settings */ |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 148 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | if (*fddi->daddr & 0x01) |
| 150 | { |
| 151 | if (memcmp(fddi->daddr, dev->broadcast, FDDI_K_ALEN) == 0) |
| 152 | skb->pkt_type = PACKET_BROADCAST; |
| 153 | else |
| 154 | skb->pkt_type = PACKET_MULTICAST; |
| 155 | } |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 156 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | else if (dev->flags & IFF_PROMISC) |
| 158 | { |
| 159 | if (memcmp(fddi->daddr, dev->dev_addr, FDDI_K_ALEN)) |
| 160 | skb->pkt_type = PACKET_OTHERHOST; |
| 161 | } |
| 162 | |
| 163 | /* Assume 802.2 SNAP frames, for now */ |
| 164 | |
| 165 | return(type); |
| 166 | } |
| 167 | |
| 168 | EXPORT_SYMBOL(fddi_type_trans); |
| 169 | |
| 170 | static int fddi_change_mtu(struct net_device *dev, int new_mtu) |
| 171 | { |
| 172 | if ((new_mtu < FDDI_K_SNAP_HLEN) || (new_mtu > FDDI_K_SNAP_DLEN)) |
| 173 | return(-EINVAL); |
| 174 | dev->mtu = new_mtu; |
| 175 | return(0); |
| 176 | } |
| 177 | |
| 178 | static void fddi_setup(struct net_device *dev) |
| 179 | { |
| 180 | dev->change_mtu = fddi_change_mtu; |
| 181 | dev->hard_header = fddi_header; |
| 182 | dev->rebuild_header = fddi_rebuild_header; |
| 183 | |
| 184 | dev->type = ARPHRD_FDDI; |
| 185 | dev->hard_header_len = FDDI_K_SNAP_HLEN+3; /* Assume 802.2 SNAP hdr len + 3 pad bytes */ |
| 186 | dev->mtu = FDDI_K_SNAP_DLEN; /* Assume max payload of 802.2 SNAP frame */ |
| 187 | dev->addr_len = FDDI_K_ALEN; |
| 188 | dev->tx_queue_len = 100; /* Long queues on FDDI */ |
| 189 | dev->flags = IFF_BROADCAST | IFF_MULTICAST; |
YOSHIFUJI Hideaki | 9afa094 | 2007-02-09 23:24:24 +0900 | [diff] [blame^] | 190 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | memset(dev->broadcast, 0xFF, FDDI_K_ALEN); |
| 192 | } |
| 193 | |
| 194 | /** |
| 195 | * alloc_fddidev - Register FDDI device |
| 196 | * @sizeof_priv: Size of additional driver-private structure to be allocated |
| 197 | * for this FDDI device |
| 198 | * |
| 199 | * Fill in the fields of the device structure with FDDI-generic values. |
| 200 | * |
| 201 | * Constructs a new net device, complete with a private data area of |
| 202 | * size @sizeof_priv. A 32-byte (not bit) alignment is enforced for |
| 203 | * this private data area. |
| 204 | */ |
| 205 | struct net_device *alloc_fddidev(int sizeof_priv) |
| 206 | { |
| 207 | return alloc_netdev(sizeof_priv, "fddi%d", fddi_setup); |
| 208 | } |
| 209 | EXPORT_SYMBOL(alloc_fddidev); |