eth.c 9.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9
/*
 * INET		An implementation of the TCP/IP protocol suite for the LINUX
 *		operating system.  INET is implemented using the  BSD Socket
 *		interface as the means of communication with the user level.
 *
 *		Ethernet-type device handling.
 *
 * Version:	@(#)eth.c	1.0.7	05/25/93
 *
10
 * Authors:	Ross Biro
L
Linus Torvalds 已提交
11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54
 *		Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
 *		Mark Evans, <evansmp@uhura.aston.ac.uk>
 *		Florian  La Roche, <rzsfl@rz.uni-sb.de>
 *		Alan Cox, <gw4pts@gw4pts.ampr.org>
 * 
 * Fixes:
 *		Mr Linux	: Arp problems
 *		Alan Cox	: Generic queue tidyup (very tiny here)
 *		Alan Cox	: eth_header ntohs should be htons
 *		Alan Cox	: eth_rebuild_header missing an htons and
 *				  minor other things.
 *		Tegge		: Arp bug fixes. 
 *		Florian		: Removed many unnecessary functions, code cleanup
 *				  and changes for new arp and skbuff.
 *		Alan Cox	: Redid header building to reflect new format.
 *		Alan Cox	: ARP only when compiled with CONFIG_INET
 *		Greg Page	: 802.2 and SNAP stuff.
 *		Alan Cox	: MAC layer pointers/new format.
 *		Paul Gortmaker	: eth_copy_and_sum shouldn't csum padding.
 *		Alan Cox	: Protect against forwarding explosions with
 *				  older network drivers and IFF_ALLMULTI.
 *	Christer Weinigel	: Better rebuild header message.
 *             Andrew Morton    : 26Feb01: kill ether_setup() - use netdev_boot_setup().
 *
 *		This program is free software; you can redistribute it and/or
 *		modify it under the terms of the GNU General Public License
 *		as published by the Free Software Foundation; either version
 *		2 of the License, or (at your option) any later version.
 */
#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/socket.h>
#include <linux/in.h>
#include <linux/inet.h>
#include <linux/ip.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/skbuff.h>
#include <linux/errno.h>
#include <linux/init.h>
55
#include <linux/if_ether.h>
L
Linus Torvalds 已提交
56 57 58 59 60 61 62 63 64 65
#include <net/dst.h>
#include <net/arp.h>
#include <net/sock.h>
#include <net/ipv6.h>
#include <net/ip.h>
#include <asm/uaccess.h>
#include <asm/system.h>

__setup("ether=", netdev_boot_setup);

S
Stephen Hemminger 已提交
66 67 68 69 70 71 72 73
/**
 * eth_header - create the Ethernet header
 * @skb:	buffer to alter
 * @dev:	source device
 * @type:	Ethernet type field
 * @daddr: destination address (NULL leave destination address)
 * @saddr: source address (NULL use device source address)
 * @len:   packet length (<= skb->len)
L
Linus Torvalds 已提交
74
 *
S
Stephen Hemminger 已提交
75 76 77
 *
 * Set the protocol type. For a packet of type ETH_P_802_3 we put the length
 * in here instead. It is up to the 802.2 layer to carry protocol information.
L
Linus Torvalds 已提交
78 79
 */
int eth_header(struct sk_buff *skb, struct net_device *dev, unsigned short type,
80
	       void *daddr, void *saddr, unsigned len)
L
Linus Torvalds 已提交
81
{
82
	struct ethhdr *eth = (struct ethhdr *)skb_push(skb, ETH_HLEN);
L
Linus Torvalds 已提交
83

84
	if (type != ETH_P_802_3)
L
Linus Torvalds 已提交
85 86 87 88 89
		eth->h_proto = htons(type);
	else
		eth->h_proto = htons(len);

	/*
90
	 *      Set the source hardware address.
L
Linus Torvalds 已提交
91
	 */
92 93

	if (!saddr)
94
		saddr = dev->dev_addr;
95
	memcpy(eth->h_source, saddr, dev->addr_len);
L
Linus Torvalds 已提交
96

97 98
	if (daddr) {
		memcpy(eth->h_dest, daddr, dev->addr_len);
99 100
		return ETH_HLEN;
	}
101

L
Linus Torvalds 已提交
102
	/*
103
	 *      Anyway, the loopback-device should never use this function...
L
Linus Torvalds 已提交
104 105
	 */

106
	if (dev->flags & (IFF_LOOPBACK | IFF_NOARP)) {
L
Linus Torvalds 已提交
107 108 109
		memset(eth->h_dest, 0, dev->addr_len);
		return ETH_HLEN;
	}
110

L
Linus Torvalds 已提交
111 112 113
	return -ETH_HLEN;
}

S
Stephen Hemminger 已提交
114 115 116 117 118 119
/**
 * eth_rebuild_header- rebuild the Ethernet MAC header.
 * @skb: socket buffer to update
 *
 * This is called after an ARP or IPV6 ndisc it's resolution on this
 * sk_buff. We now let protocol (ARP) fill in the other fields.
L
Linus Torvalds 已提交
120
 *
S
Stephen Hemminger 已提交
121 122
 * This routine CANNOT use cached dst->neigh!
 * Really, it is used only when dst->neigh is wrong.
L
Linus Torvalds 已提交
123 124 125 126 127 128
 */
int eth_rebuild_header(struct sk_buff *skb)
{
	struct ethhdr *eth = (struct ethhdr *)skb->data;
	struct net_device *dev = skb->dev;

129
	switch (eth->h_proto) {
L
Linus Torvalds 已提交
130 131
#ifdef CONFIG_INET
	case __constant_htons(ETH_P_IP):
132 133
		return arp_find(eth->h_dest, skb);
#endif
L
Linus Torvalds 已提交
134 135
	default:
		printk(KERN_DEBUG
136
		       "%s: unable to resolve type %X addresses.\n",
L
Linus Torvalds 已提交
137
		       dev->name, (int)eth->h_proto);
138

L
Linus Torvalds 已提交
139 140 141 142 143 144 145
		memcpy(eth->h_source, dev->dev_addr, dev->addr_len);
		break;
	}

	return 0;
}

S
Stephen Hemminger 已提交
146 147 148 149 150 151 152 153
/**
 * eth_type_trans - determine the packet's protocol ID.
 * @skb: received socket data
 * @dev: receiving network device
 *
 * The rule here is that we
 * assume 802.3 if the type field is short enough to be a length.
 * This is normal practice and works for any 'now in use' protocol.
L
Linus Torvalds 已提交
154
 */
A
Alexey Dobriyan 已提交
155
__be16 eth_type_trans(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
156 157 158
{
	struct ethhdr *eth;
	unsigned char *rawp;
159

160
	skb->mac.raw = skb->data;
161
	skb_pull(skb, ETH_HLEN);
L
Linus Torvalds 已提交
162
	eth = eth_hdr(skb);
163

164
	if (is_multicast_ether_addr(eth->h_dest)) {
S
Stephen Hemminger 已提交
165
		if (!compare_ether_addr(eth->h_dest, dev->broadcast))
166
			skb->pkt_type = PACKET_BROADCAST;
L
Linus Torvalds 已提交
167
		else
168
			skb->pkt_type = PACKET_MULTICAST;
L
Linus Torvalds 已提交
169
	}
170

L
Linus Torvalds 已提交
171
	/*
172 173
	 *      This ALLMULTI check should be redundant by 1.4
	 *      so don't forget to remove it.
L
Linus Torvalds 已提交
174
	 *
175 176
	 *      Seems, you forgot to remove it. All silly devices
	 *      seems to set IFF_PROMISC.
L
Linus Torvalds 已提交
177
	 */
178 179

	else if (1 /*dev->flags&IFF_PROMISC */ ) {
S
Stephen Hemminger 已提交
180
		if (unlikely(compare_ether_addr(eth->h_dest, dev->dev_addr)))
181
			skb->pkt_type = PACKET_OTHERHOST;
L
Linus Torvalds 已提交
182
	}
183

L
Linus Torvalds 已提交
184 185
	if (ntohs(eth->h_proto) >= 1536)
		return eth->h_proto;
186

L
Linus Torvalds 已提交
187
	rawp = skb->data;
188

L
Linus Torvalds 已提交
189
	/*
190 191 192 193
	 *      This is a magic hack to spot IPX packets. Older Novell breaks
	 *      the protocol design and runs IPX over 802.3 without an 802.2 LLC
	 *      layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This
	 *      won't work for fault tolerant netware but does for the rest.
L
Linus Torvalds 已提交
194 195 196
	 */
	if (*(unsigned short *)rawp == 0xFFFF)
		return htons(ETH_P_802_3);
197

L
Linus Torvalds 已提交
198
	/*
199
	 *      Real 802.2 LLC
L
Linus Torvalds 已提交
200 201 202
	 */
	return htons(ETH_P_802_2);
}
203
EXPORT_SYMBOL(eth_type_trans);
L
Linus Torvalds 已提交
204

S
Stephen Hemminger 已提交
205 206 207 208 209
/**
 * eth_header_parse - extract hardware address from packet
 * @skb: packet to extract header from
 * @haddr: destination buffer
 */
L
Linus Torvalds 已提交
210 211 212 213 214 215 216
static int eth_header_parse(struct sk_buff *skb, unsigned char *haddr)
{
	struct ethhdr *eth = eth_hdr(skb);
	memcpy(haddr, eth->h_source, ETH_ALEN);
	return ETH_ALEN;
}

S
Stephen Hemminger 已提交
217 218 219 220 221 222
/**
 * eth_header_cache - fill cache entry from neighbour
 * @neigh: source neighbour
 * @hh: destination cache entry
 * Create an Ethernet header template from the neighbour.
 */
L
Linus Torvalds 已提交
223 224
int eth_header_cache(struct neighbour *neigh, struct hh_cache *hh)
{
A
Al Viro 已提交
225
	__be16 type = hh->hh_type;
L
Linus Torvalds 已提交
226 227 228
	struct ethhdr *eth;
	struct net_device *dev = neigh->dev;

229 230
	eth = (struct ethhdr *)
	    (((u8 *) hh->hh_data) + (HH_DATA_OFF(sizeof(*eth))));
L
Linus Torvalds 已提交
231 232 233 234 235 236 237 238 239 240 241

	if (type == __constant_htons(ETH_P_802_3))
		return -1;

	eth->h_proto = type;
	memcpy(eth->h_source, dev->dev_addr, dev->addr_len);
	memcpy(eth->h_dest, neigh->ha, dev->addr_len);
	hh->hh_len = ETH_HLEN;
	return 0;
}

S
Stephen Hemminger 已提交
242 243 244 245 246 247
/**
 * eth_header_cache_update - update cache entry
 * @hh: destination cache entry
 * @dev: network device
 * @haddr: new hardware address
 *
L
Linus Torvalds 已提交
248 249
 * Called by Address Resolution module to notify changes in address.
 */
250 251
void eth_header_cache_update(struct hh_cache *hh, struct net_device *dev,
			     unsigned char *haddr)
L
Linus Torvalds 已提交
252
{
253
	memcpy(((u8 *) hh->hh_data) + HH_DATA_OFF(sizeof(struct ethhdr)),
L
Linus Torvalds 已提交
254 255 256
	       haddr, dev->addr_len);
}

S
Stephen Hemminger 已提交
257 258 259 260 261 262 263 264 265
/**
 * eth_mac_addr - set new Ethernet hardware address
 * @dev: network device
 * @p: socket address
 * Change hardware address of device.
 *
 * This doesn't change hardware matching, so needs to be overridden
 * for most real devices.
 */
L
Linus Torvalds 已提交
266 267
static int eth_mac_addr(struct net_device *dev, void *p)
{
268
	struct sockaddr *addr = p;
L
Linus Torvalds 已提交
269 270
	if (netif_running(dev))
		return -EBUSY;
271
	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
L
Linus Torvalds 已提交
272 273 274
	return 0;
}

S
Stephen Hemminger 已提交
275 276 277 278 279 280 281 282
/**
 * eth_change_mtu - set new MTU size
 * @dev: network device
 * @new_mtu: new Maximum Transfer Unit
 *
 * Allow changing MTU size. Needs to be overridden for devices
 * supporting jumbo frames.
 */
L
Linus Torvalds 已提交
283 284
static int eth_change_mtu(struct net_device *dev, int new_mtu)
{
285
	if (new_mtu < 68 || new_mtu > ETH_DATA_LEN)
L
Linus Torvalds 已提交
286 287 288 289 290
		return -EINVAL;
	dev->mtu = new_mtu;
	return 0;
}

S
Stephen Hemminger 已提交
291 292 293 294
/**
 * ether_setup - setup Ethernet network device
 * @dev: network device
 * Fill in the fields of the device structure with Ethernet-generic values.
L
Linus Torvalds 已提交
295 296 297 298 299 300 301 302 303 304 305 306 307
 */
void ether_setup(struct net_device *dev)
{
	dev->change_mtu		= eth_change_mtu;
	dev->hard_header	= eth_header;
	dev->rebuild_header 	= eth_rebuild_header;
	dev->set_mac_address 	= eth_mac_addr;
	dev->hard_header_cache	= eth_header_cache;
	dev->header_cache_update= eth_header_cache_update;
	dev->hard_header_parse	= eth_header_parse;

	dev->type		= ARPHRD_ETHER;
	dev->hard_header_len 	= ETH_HLEN;
308
	dev->mtu		= ETH_DATA_LEN;
L
Linus Torvalds 已提交
309 310 311 312
	dev->addr_len		= ETH_ALEN;
	dev->tx_queue_len	= 1000;	/* Ethernet wants good queues */	
	dev->flags		= IFF_BROADCAST|IFF_MULTICAST;
	
313
	memset(dev->broadcast, 0xFF, ETH_ALEN);
L
Linus Torvalds 已提交
314 315 316 317 318

}
EXPORT_SYMBOL(ether_setup);

/**
S
Stephen Hemminger 已提交
319
 * alloc_etherdev - Allocates and sets up an Ethernet device
L
Linus Torvalds 已提交
320
 * @sizeof_priv: Size of additional driver-private structure to be allocated
S
Stephen Hemminger 已提交
321
 *	for this Ethernet device
L
Linus Torvalds 已提交
322
 *
S
Stephen Hemminger 已提交
323
 * Fill in the fields of the device structure with Ethernet-generic
L
Linus Torvalds 已提交
324 325 326
 * values. Basically does everything except registering the device.
 *
 * Constructs a new net device, complete with a private data area of
S
Stephen Hemminger 已提交
327
 * size (sizeof_priv).  A 32-byte (not bit) alignment is enforced for
L
Linus Torvalds 已提交
328 329 330 331 332 333 334 335
 * this private data area.
 */

struct net_device *alloc_etherdev(int sizeof_priv)
{
	return alloc_netdev(sizeof_priv, "eth%d", ether_setup);
}
EXPORT_SYMBOL(alloc_etherdev);