vlan_dev.c 19.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/* -*- linux-c -*-
 * INET		802.1Q VLAN
 *		Ethernet-type device handling.
 *
 * Authors:	Ben Greear <greearb@candelatech.com>
P
Patrick McHardy 已提交
6
 *              Please send support related email to: netdev@vger.kernel.org
L
Linus Torvalds 已提交
7
 *              VLAN Home Page: http://www.candelatech.com/~greear/vlan.html
8
 *
L
Linus Torvalds 已提交
9 10 11 12 13 14
 * Fixes:       Mar 22 2001: Martin Bokaemper <mbokaemper@unispherenetworks.com>
 *                - reset skb->pkt_type on incoming packets when MAC was changed
 *                - see that changed MAC is saddr for outgoing packets
 *              Oct 20, 2001:  Ard van Breeman:
 *                - Fix MC-list, finally.
 *                - Flush MC-list on VLAN destroy.
15
 *
L
Linus Torvalds 已提交
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
 *
 *		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/mm.h>
#include <linux/in.h>
#include <linux/init.h>
#include <asm/uaccess.h> /* for copy_from_user */
#include <linux/skbuff.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <net/datalink.h>
#include <net/p8022.h>
#include <net/arp.h>

#include "vlan.h"
#include "vlanproc.h"
#include <linux/if_vlan.h>
#include <net/ip.h>

/*
 *	Rebuild the Ethernet MAC header. This is called after an ARP
 *	(or in future other address resolution) has completed on this
 *	sk_buff. We now let ARP fill in the other fields.
 *
 *	This routine CANNOT use cached dst->neigh!
 *	Really, it is used only when dst->neigh is wrong.
 *
 * TODO:  This needs a checkup, I'm ignorant here. --BLG
 */
50
static int vlan_dev_rebuild_header(struct sk_buff *skb)
L
Linus Torvalds 已提交
51 52 53 54 55 56 57 58 59 60
{
	struct net_device *dev = skb->dev;
	struct vlan_ethhdr *veth = (struct vlan_ethhdr *)(skb->data);

	switch (veth->h_vlan_encapsulated_proto) {
#ifdef CONFIG_INET
	case __constant_htons(ETH_P_IP):

		/* TODO:  Confirm this will work with VLAN headers... */
		return arp_find(veth->h_dest, skb);
61
#endif
L
Linus Torvalds 已提交
62
	default:
63 64
		pr_debug("%s: unable to resolve type %X addresses.\n",
			 dev->name, ntohs(veth->h_vlan_encapsulated_proto));
65

L
Linus Torvalds 已提交
66 67
		memcpy(veth->h_source, dev->dev_addr, ETH_ALEN);
		break;
68
	}
L
Linus Torvalds 已提交
69 70 71 72 73 74

	return 0;
}

static inline struct sk_buff *vlan_check_reorder_header(struct sk_buff *skb)
{
75
	if (vlan_dev_info(skb->dev)->flags & VLAN_FLAG_REORDER_HDR) {
L
Linus Torvalds 已提交
76 77 78 79 80 81 82 83 84
		if (skb_shared(skb) || skb_cloned(skb)) {
			struct sk_buff *nskb = skb_copy(skb, GFP_ATOMIC);
			kfree_skb(skb);
			skb = nskb;
		}
		if (skb) {
			/* Lifted from Gleb's VLAN code... */
			memmove(skb->data - ETH_HLEN,
				skb->data - VLAN_ETH_HLEN, 12);
85
			skb->mac_header += VLAN_HLEN;
L
Linus Torvalds 已提交
86 87 88 89 90 91
		}
	}

	return skb;
}

92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
static inline void vlan_set_encap_proto(struct sk_buff *skb,
		struct vlan_hdr *vhdr)
{
	__be16 proto;
	unsigned char *rawp;

	/*
	 * Was a VLAN packet, grab the encapsulated protocol, which the layer
	 * three protocols care about.
	 */

	proto = vhdr->h_vlan_encapsulated_proto;
	if (ntohs(proto) >= 1536) {
		skb->protocol = proto;
		return;
	}

	rawp = skb->data;
	if (*(unsigned short *)rawp == 0xFFFF)
		/*
		 * 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.
		 */
		skb->protocol = htons(ETH_P_802_3);
	else
		/*
		 * Real 802.2 LLC
		 */
		skb->protocol = htons(ETH_P_802_2);
}

L
Linus Torvalds 已提交
126
/*
127
 *	Determine the packet's protocol ID. The rule here is that we
L
Linus Torvalds 已提交
128 129 130 131 132 133 134 135 136 137 138 139 140 141 142
 *	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.
 *
 *  Also, at this point we assume that we ARE dealing exclusively with
 *  VLAN packets, or packets that should be made into VLAN packets based
 *  on a default VLAN ID.
 *
 *  NOTE:  Should be similar to ethernet/eth.c.
 *
 *  SANITY NOTE:  This method is called when a packet is moving up the stack
 *                towards userland.  To get here, it would have already passed
 *                through the ethernet/eth.c eth_type_trans() method.
 *  SANITY NOTE 2: We are referencing to the VLAN_HDR frields, which MAY be
 *                 stored UNALIGNED in the memory.  RISC systems don't like
 *                 such cases very much...
P
Patrick McHardy 已提交
143 144 145
 *  SANITY NOTE 2a: According to Dave Miller & Alexey, it will always be
 *  		    aligned, so there doesn't need to be any of the unaligned
 *  		    stuff.  It has been commented out now...  --Ben
L
Linus Torvalds 已提交
146 147 148
 *
 */
int vlan_skb_recv(struct sk_buff *skb, struct net_device *dev,
P
Patrick McHardy 已提交
149
		  struct packet_type *ptype, struct net_device *orig_dev)
L
Linus Torvalds 已提交
150
{
151
	struct vlan_hdr *vhdr;
L
Linus Torvalds 已提交
152 153 154 155
	unsigned short vid;
	struct net_device_stats *stats;
	unsigned short vlan_TCI;

156 157
	if (dev->nd_net != &init_net)
		goto err_free;
158

P
Patrick McHardy 已提交
159 160
	skb = skb_share_check(skb, GFP_ATOMIC);
	if (skb == NULL)
161
		goto err_free;
162

163 164
	if (unlikely(!pskb_may_pull(skb, VLAN_HLEN)))
		goto err_free;
165

166
	vhdr = (struct vlan_hdr *)skb->data;
L
Linus Torvalds 已提交
167 168 169 170 171 172
	vlan_TCI = ntohs(vhdr->h_vlan_TCI);
	vid = (vlan_TCI & VLAN_VID_MASK);

	rcu_read_lock();
	skb->dev = __find_vlan_dev(dev, vid);
	if (!skb->dev) {
P
Patrick McHardy 已提交
173 174
		pr_debug("%s: ERROR: No net_device for VID: %u on dev: %s\n",
			 __FUNCTION__, (unsigned int)vid, dev->name);
175
		goto err_unlock;
L
Linus Torvalds 已提交
176 177 178 179
	}

	skb->dev->last_rx = jiffies;

P
Patrick McHardy 已提交
180
	stats = &skb->dev->stats;
L
Linus Torvalds 已提交
181 182 183
	stats->rx_packets++;
	stats->rx_bytes += skb->len;

184
	skb_pull_rcsum(skb, VLAN_HLEN);
185

P
Patrick McHardy 已提交
186 187
	skb->priority = vlan_get_ingress_priority(skb->dev,
						  ntohs(vhdr->h_vlan_TCI));
L
Linus Torvalds 已提交
188

189 190
	pr_debug("%s: priority: %u for TCI: %hu\n",
		 __FUNCTION__, skb->priority, ntohs(vhdr->h_vlan_TCI));
L
Linus Torvalds 已提交
191 192 193

	switch (skb->pkt_type) {
	case PACKET_BROADCAST: /* Yeah, stats collect these together.. */
P
Patrick McHardy 已提交
194
		/* stats->broadcast ++; // no such counter :-( */
L
Linus Torvalds 已提交
195 196 197 198 199 200
		break;

	case PACKET_MULTICAST:
		stats->multicast++;
		break;

201
	case PACKET_OTHERHOST:
L
Linus Torvalds 已提交
202
		/* Our lower layer thinks this is not local, let's make sure.
P
Patrick McHardy 已提交
203 204
		 * This allows the VLAN to have a different MAC than the
		 * underlying device, and still route correctly.
L
Linus Torvalds 已提交
205
		 */
P
Patrick McHardy 已提交
206 207
		if (!compare_ether_addr(eth_hdr(skb)->h_dest,
					skb->dev->dev_addr))
L
Linus Torvalds 已提交
208 209 210 211
			skb->pkt_type = PACKET_HOST;
		break;
	default:
		break;
212
	}
L
Linus Torvalds 已提交
213

214
	vlan_set_encap_proto(skb, vhdr);
L
Linus Torvalds 已提交
215 216

	skb = vlan_check_reorder_header(skb);
217
	if (!skb) {
L
Linus Torvalds 已提交
218
		stats->rx_errors++;
219
		goto err_unlock;
L
Linus Torvalds 已提交
220
	}
221 222

	netif_rx(skb);
L
Linus Torvalds 已提交
223
	rcu_read_unlock();
224 225 226 227 228 229 230
	return NET_RX_SUCCESS;

err_unlock:
	rcu_read_unlock();
err_free:
	kfree_skb(skb);
	return NET_RX_DROP;
L
Linus Torvalds 已提交
231 232
}

P
Patrick McHardy 已提交
233 234
static inline unsigned short
vlan_dev_get_egress_qos_mask(struct net_device *dev, struct sk_buff *skb)
L
Linus Torvalds 已提交
235
{
P
Patrick McHardy 已提交
236
	struct vlan_priority_tci_mapping *mp;
L
Linus Torvalds 已提交
237

P
Patrick McHardy 已提交
238
	mp = vlan_dev_info(dev)->egress_priority_map[(skb->priority & 0xF)];
L
Linus Torvalds 已提交
239 240
	while (mp) {
		if (mp->priority == skb->priority) {
P
Patrick McHardy 已提交
241 242 243
			return mp->vlan_qos; /* This should already be shifted
					      * to mask correctly with the
					      * VLAN's TCI */
L
Linus Torvalds 已提交
244 245 246 247 248 249 250
		}
		mp = mp->next;
	}
	return 0;
}

/*
251
 *	Create the VLAN header for an arbitrary protocol layer
L
Linus Torvalds 已提交
252 253 254 255 256 257 258
 *
 *	saddr=NULL	means use device source address
 *	daddr=NULL	means leave destination address (eg unresolved arp)
 *
 *  This is called when the SKB is moving down the stack towards the
 *  physical devices.
 */
259 260 261 262
static int vlan_dev_hard_header(struct sk_buff *skb, struct net_device *dev,
				unsigned short type,
				const void *daddr, const void *saddr,
				unsigned int len)
L
Linus Torvalds 已提交
263 264 265 266 267
{
	struct vlan_hdr *vhdr;
	unsigned short veth_TCI = 0;
	int rc = 0;
	int build_vlan_header = 0;
P
Patrick McHardy 已提交
268
	struct net_device *vdev = dev;
L
Linus Torvalds 已提交
269

270
	pr_debug("%s: skb: %p type: %hx len: %u vlan_id: %hx, daddr: %p\n",
P
Patrick McHardy 已提交
271 272
		 __FUNCTION__, skb, type, len, vlan_dev_info(dev)->vlan_id,
		 daddr);
L
Linus Torvalds 已提交
273 274 275 276 277

	/* build vlan header only if re_order_header flag is NOT set.  This
	 * fixes some programs that get confused when they see a VLAN device
	 * sending a frame that is VLAN encoded (the consensus is that the VLAN
	 * device should look completely like an Ethernet device when the
278
	 * REORDER_HEADER flag is set)	The drawback to this is some extra
L
Linus Torvalds 已提交
279 280 281
	 * header shuffling in the hard_start_xmit.  Users can turn off this
	 * REORDER behaviour with the vconfig tool.
	 */
282
	if (!(vlan_dev_info(dev)->flags & VLAN_FLAG_REORDER_HDR))
283
		build_vlan_header = 1;
L
Linus Torvalds 已提交
284 285 286 287 288 289

	if (build_vlan_header) {
		vhdr = (struct vlan_hdr *) skb_push(skb, VLAN_HLEN);

		/* build the four bytes that make this a VLAN header. */

P
Patrick McHardy 已提交
290 291
		/* Now, construct the second two bytes. This field looks
		 * something like:
L
Linus Torvalds 已提交
292 293 294 295 296
		 * usr_priority: 3 bits	 (high bits)
		 * CFI		 1 bit
		 * VLAN ID	 12 bits (low bits)
		 *
		 */
297
		veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
298 299 300 301 302
		veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb);

		vhdr->h_vlan_TCI = htons(veth_TCI);

		/*
P
Patrick McHardy 已提交
303 304 305
		 *  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 已提交
306 307
		 */

P
Patrick McHardy 已提交
308
		if (type != ETH_P_802_3)
L
Linus Torvalds 已提交
309
			vhdr->h_vlan_encapsulated_proto = htons(type);
P
Patrick McHardy 已提交
310
		else
L
Linus Torvalds 已提交
311
			vhdr->h_vlan_encapsulated_proto = htons(len);
312 313

		skb->protocol = htons(ETH_P_8021Q);
314
		skb_reset_network_header(skb);
L
Linus Torvalds 已提交
315 316 317 318 319 320
	}

	/* Before delegating work to the lower layer, enter our MAC-address */
	if (saddr == NULL)
		saddr = dev->dev_addr;

321
	dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
322

P
Patrick McHardy 已提交
323 324 325 326
	/* MPLS can send us skbuffs w/out enough space.	This check will grow
	 * the skb if it doesn't have enough headroom. Not a beautiful solution,
	 * so I'll tick a counter so that users can know it's happening...
	 * If they care...
L
Linus Torvalds 已提交
327 328
	 */

P
Patrick McHardy 已提交
329 330
	/* NOTE: This may still break if the underlying device is not the final
	 * device (and thus there are more headers to add...) It should work for
L
Linus Torvalds 已提交
331 332 333 334 335 336 337
	 * good-ole-ethernet though.
	 */
	if (skb_headroom(skb) < dev->hard_header_len) {
		struct sk_buff *sk_tmp = skb;
		skb = skb_realloc_headroom(sk_tmp, dev->hard_header_len);
		kfree_skb(sk_tmp);
		if (skb == NULL) {
P
Patrick McHardy 已提交
338
			struct net_device_stats *stats = &vdev->stats;
L
Linus Torvalds 已提交
339 340 341
			stats->tx_dropped++;
			return -ENOMEM;
		}
342
		vlan_dev_info(vdev)->cnt_inc_headroom_on_tx++;
P
Patrick McHardy 已提交
343
		pr_debug("%s: %s: had to grow skb\n", __FUNCTION__, vdev->name);
L
Linus Torvalds 已提交
344 345 346 347
	}

	if (build_vlan_header) {
		/* Now make the underlying real hard header */
348 349 350
		rc = dev_hard_header(skb, dev, ETH_P_8021Q, daddr, saddr,
				     len + VLAN_HLEN);
		if (rc > 0)
L
Linus Torvalds 已提交
351
			rc += VLAN_HLEN;
352
		else if (rc < 0)
L
Linus Torvalds 已提交
353
			rc -= VLAN_HLEN;
354
	} else
P
Patrick McHardy 已提交
355 356 357 358
		/* If here, then we'll just make a normal looking ethernet
		 * frame, but, the hard_start_xmit method will insert the tag
		 * (it has to be able to do this for bridged and other skbs
		 * that don't come down the protocol stack in an orderly manner.
L
Linus Torvalds 已提交
359
		 */
360
		rc = dev_hard_header(skb, dev, type, daddr, saddr, len);
L
Linus Torvalds 已提交
361 362 363 364

	return rc;
}

365
static int vlan_dev_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
366
{
P
Patrick McHardy 已提交
367
	struct net_device_stats *stats = &dev->stats;
L
Linus Torvalds 已提交
368
	struct vlan_ethhdr *veth = (struct vlan_ethhdr *)(skb->data);
369 370
	DECLARE_MAC_BUF(mac);
	DECLARE_MAC_BUF(mac2);
L
Linus Torvalds 已提交
371 372 373 374 375 376
	/* Handle non-VLAN frames if they are sent to us, for example by DHCP.
	 *
	 * NOTE: THIS ASSUMES DIX ETHERNET, SPECIFICALLY NOT SUPPORTING
	 * OTHER THINGS LIKE FDDI/TokenRing/802.3 SNAPs...
	 */

377
	if (veth->h_vlan_proto != htons(ETH_P_8021Q) ||
378
		vlan_dev_info(dev)->flags & VLAN_FLAG_REORDER_HDR) {
L
Linus Torvalds 已提交
379 380 381 382
		int orig_headroom = skb_headroom(skb);
		unsigned short veth_TCI;

		/* This is not a VLAN frame...but we can fix that! */
383
		vlan_dev_info(dev)->cnt_encap_on_xmit++;
L
Linus Torvalds 已提交
384

385 386
		pr_debug("%s: proto to encap: 0x%hx\n",
			 __FUNCTION__, htons(veth->h_vlan_proto));
L
Linus Torvalds 已提交
387 388 389 390 391 392
		/* Construct the second two bytes. This field looks something
		 * like:
		 * usr_priority: 3 bits	 (high bits)
		 * CFI		 1 bit
		 * VLAN ID	 12 bits (low bits)
		 */
393
		veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
394 395 396 397 398 399 400 401
		veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb);

		skb = __vlan_put_tag(skb, veth_TCI);
		if (!skb) {
			stats->tx_dropped++;
			return 0;
		}

P
Patrick McHardy 已提交
402
		if (orig_headroom < VLAN_HLEN)
403
			vlan_dev_info(dev)->cnt_inc_headroom_on_tx++;
L
Linus Torvalds 已提交
404 405
	}

406
	pr_debug("%s: about to send skb: %p to dev: %s\n",
L
Linus Torvalds 已提交
407
		__FUNCTION__, skb, skb->dev->name);
408 409
	pr_debug("  %s %s %4hx %4hx %4hx\n",
		 print_mac(mac, veth->h_dest), print_mac(mac2, veth->h_source),
410 411
		 veth->h_vlan_proto, veth->h_vlan_TCI,
		 veth->h_vlan_encapsulated_proto);
L
Linus Torvalds 已提交
412 413 414 415

	stats->tx_packets++; /* for statics only */
	stats->tx_bytes += skb->len;

416
	skb->dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
417 418 419 420 421
	dev_queue_xmit(skb);

	return 0;
}

422 423
static int vlan_dev_hwaccel_hard_start_xmit(struct sk_buff *skb,
					    struct net_device *dev)
L
Linus Torvalds 已提交
424
{
P
Patrick McHardy 已提交
425
	struct net_device_stats *stats = &dev->stats;
L
Linus Torvalds 已提交
426 427 428 429 430 431 432 433
	unsigned short veth_TCI;

	/* Construct the second two bytes. This field looks something
	 * like:
	 * usr_priority: 3 bits	 (high bits)
	 * CFI		 1 bit
	 * VLAN ID	 12 bits (low bits)
	 */
434
	veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
435 436 437 438 439 440
	veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb);
	skb = __vlan_hwaccel_put_tag(skb, veth_TCI);

	stats->tx_packets++;
	stats->tx_bytes += skb->len;

441
	skb->dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
442 443 444 445 446
	dev_queue_xmit(skb);

	return 0;
}

447
static int vlan_dev_change_mtu(struct net_device *dev, int new_mtu)
L
Linus Torvalds 已提交
448 449 450 451
{
	/* TODO: gotta make sure the underlying layer can handle it,
	 * maybe an IFF_VLAN_CAPABLE flag for devices?
	 */
452
	if (vlan_dev_info(dev)->real_dev->mtu < new_mtu)
L
Linus Torvalds 已提交
453 454 455 456 457 458 459
		return -ERANGE;

	dev->mtu = new_mtu;

	return 0;
}

460 461
void vlan_dev_set_ingress_priority(const struct net_device *dev,
				   u32 skb_prio, short vlan_prio)
L
Linus Torvalds 已提交
462
{
463
	struct vlan_dev_info *vlan = vlan_dev_info(dev);
464 465 466 467 468 469 470

	if (vlan->ingress_priority_map[vlan_prio & 0x7] && !skb_prio)
		vlan->nr_ingress_mappings--;
	else if (!vlan->ingress_priority_map[vlan_prio & 0x7] && skb_prio)
		vlan->nr_ingress_mappings++;

	vlan->ingress_priority_map[vlan_prio & 0x7] = skb_prio;
L
Linus Torvalds 已提交
471 472
}

473 474
int vlan_dev_set_egress_priority(const struct net_device *dev,
				 u32 skb_prio, short vlan_prio)
L
Linus Torvalds 已提交
475
{
476
	struct vlan_dev_info *vlan = vlan_dev_info(dev);
L
Linus Torvalds 已提交
477 478
	struct vlan_priority_tci_mapping *mp = NULL;
	struct vlan_priority_tci_mapping *np;
479
	u32 vlan_qos = (vlan_prio << 13) & 0xE000;
480

481
	/* See if a priority mapping exists.. */
482
	mp = vlan->egress_priority_map[skb_prio & 0xF];
483 484
	while (mp) {
		if (mp->priority == skb_prio) {
485 486 487 488 489
			if (mp->vlan_qos && !vlan_qos)
				vlan->nr_egress_mappings--;
			else if (!mp->vlan_qos && vlan_qos)
				vlan->nr_egress_mappings++;
			mp->vlan_qos = vlan_qos;
490
			return 0;
L
Linus Torvalds 已提交
491
		}
492
		mp = mp->next;
L
Linus Torvalds 已提交
493
	}
494 495

	/* Create a new mapping then. */
496
	mp = vlan->egress_priority_map[skb_prio & 0xF];
497 498 499 500 501 502
	np = kmalloc(sizeof(struct vlan_priority_tci_mapping), GFP_KERNEL);
	if (!np)
		return -ENOBUFS;

	np->next = mp;
	np->priority = skb_prio;
503 504 505 506
	np->vlan_qos = vlan_qos;
	vlan->egress_priority_map[skb_prio & 0xF] = np;
	if (vlan_qos)
		vlan->nr_egress_mappings++;
507
	return 0;
L
Linus Torvalds 已提交
508 509
}

510
/* Flags are defined in the vlan_flags enum in include/linux/if_vlan.h file. */
511 512
int vlan_dev_set_vlan_flag(const struct net_device *dev,
			   u32 flag, short flag_val)
L
Linus Torvalds 已提交
513
{
514
	/* verify flag is supported */
515
	if (flag == VLAN_FLAG_REORDER_HDR) {
P
Patrick McHardy 已提交
516
		if (flag_val)
517
			vlan_dev_info(dev)->flags |= VLAN_FLAG_REORDER_HDR;
P
Patrick McHardy 已提交
518
		else
519
			vlan_dev_info(dev)->flags &= ~VLAN_FLAG_REORDER_HDR;
520
		return 0;
L
Linus Torvalds 已提交
521 522 523 524
	}
	return -EINVAL;
}

525
void vlan_dev_get_realdev_name(const struct net_device *dev, char *result)
L
Linus Torvalds 已提交
526
{
527
	strncpy(result, vlan_dev_info(dev)->real_dev->name, 23);
L
Linus Torvalds 已提交
528 529
}

530
void vlan_dev_get_vid(const struct net_device *dev, unsigned short *result)
L
Linus Torvalds 已提交
531
{
532
	*result = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
533 534
}

535
static int vlan_dev_open(struct net_device *dev)
L
Linus Torvalds 已提交
536
{
537
	struct vlan_dev_info *vlan = vlan_dev_info(dev);
538 539 540 541
	struct net_device *real_dev = vlan->real_dev;
	int err;

	if (!(real_dev->flags & IFF_UP))
L
Linus Torvalds 已提交
542 543
		return -ENETDOWN;

544 545 546 547 548 549 550
	if (compare_ether_addr(dev->dev_addr, real_dev->dev_addr)) {
		err = dev_unicast_add(real_dev, dev->dev_addr, ETH_ALEN);
		if (err < 0)
			return err;
	}
	memcpy(vlan->real_dev_addr, real_dev->dev_addr, ETH_ALEN);

551 552 553 554 555
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(real_dev, 1);
	if (dev->flags & IFF_PROMISC)
		dev_set_promiscuity(real_dev, 1);

L
Linus Torvalds 已提交
556 557 558
	return 0;
}

559
static int vlan_dev_stop(struct net_device *dev)
L
Linus Torvalds 已提交
560
{
561
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
562

563
	dev_mc_unsync(real_dev, dev);
564
	dev_unicast_unsync(real_dev, dev);
565 566 567 568 569
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(real_dev, -1);
	if (dev->flags & IFF_PROMISC)
		dev_set_promiscuity(real_dev, -1);

570 571 572
	if (compare_ether_addr(dev->dev_addr, real_dev->dev_addr))
		dev_unicast_delete(real_dev, dev->dev_addr, dev->addr_len);

L
Linus Torvalds 已提交
573 574 575
	return 0;
}

576
static int vlan_dev_set_mac_address(struct net_device *dev, void *p)
577
{
578
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601
	struct sockaddr *addr = p;
	int err;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	if (!(dev->flags & IFF_UP))
		goto out;

	if (compare_ether_addr(addr->sa_data, real_dev->dev_addr)) {
		err = dev_unicast_add(real_dev, addr->sa_data, ETH_ALEN);
		if (err < 0)
			return err;
	}

	if (compare_ether_addr(dev->dev_addr, real_dev->dev_addr))
		dev_unicast_delete(real_dev, dev->dev_addr, ETH_ALEN);

out:
	memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN);
	return 0;
}

602
static int vlan_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
L
Linus Torvalds 已提交
603
{
604
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
605 606 607 608 609 610
	struct ifreq ifrr;
	int err = -EOPNOTSUPP;

	strncpy(ifrr.ifr_name, real_dev->name, IFNAMSIZ);
	ifrr.ifr_ifru = ifr->ifr_ifru;

P
Patrick McHardy 已提交
611
	switch (cmd) {
L
Linus Torvalds 已提交
612 613 614
	case SIOCGMIIPHY:
	case SIOCGMIIREG:
	case SIOCSMIIREG:
615
		if (real_dev->do_ioctl && netif_device_present(real_dev))
L
Linus Torvalds 已提交
616 617 618 619
			err = real_dev->do_ioctl(real_dev, &ifrr, cmd);
		break;
	}

620
	if (!err)
L
Linus Torvalds 已提交
621 622 623 624 625
		ifr->ifr_ifru = ifrr.ifr_ifru;

	return err;
}

626
static void vlan_dev_change_rx_flags(struct net_device *dev, int change)
627
{
628
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
629 630 631 632 633 634 635

	if (change & IFF_ALLMULTI)
		dev_set_allmulti(real_dev, dev->flags & IFF_ALLMULTI ? 1 : -1);
	if (change & IFF_PROMISC)
		dev_set_promiscuity(real_dev, dev->flags & IFF_PROMISC ? 1 : -1);
}

636
static void vlan_dev_set_rx_mode(struct net_device *vlan_dev)
L
Linus Torvalds 已提交
637
{
638
	dev_mc_sync(vlan_dev_info(vlan_dev)->real_dev, vlan_dev);
639
	dev_unicast_sync(vlan_dev_info(vlan_dev)->real_dev, vlan_dev);
L
Linus Torvalds 已提交
640
}
641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656

/*
 * vlan network devices have devices nesting below it, and are a special
 * "super class" of normal network devices; split their locks off into a
 * separate class since they always nest.
 */
static struct lock_class_key vlan_netdev_xmit_lock_key;

static const struct header_ops vlan_header_ops = {
	.create	 = vlan_dev_hard_header,
	.rebuild = vlan_dev_rebuild_header,
	.parse	 = eth_header_parse,
};

static int vlan_dev_init(struct net_device *dev)
{
657
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704
	int subclass = 0;

	/* IFF_BROADCAST|IFF_MULTICAST; ??? */
	dev->flags  = real_dev->flags & ~IFF_UP;
	dev->iflink = real_dev->ifindex;
	dev->state  = (real_dev->state & ((1<<__LINK_STATE_NOCARRIER) |
					  (1<<__LINK_STATE_DORMANT))) |
		      (1<<__LINK_STATE_PRESENT);

	/* ipv6 shared card related stuff */
	dev->dev_id = real_dev->dev_id;

	if (is_zero_ether_addr(dev->dev_addr))
		memcpy(dev->dev_addr, real_dev->dev_addr, dev->addr_len);
	if (is_zero_ether_addr(dev->broadcast))
		memcpy(dev->broadcast, real_dev->broadcast, dev->addr_len);

	if (real_dev->features & NETIF_F_HW_VLAN_TX) {
		dev->header_ops      = real_dev->header_ops;
		dev->hard_header_len = real_dev->hard_header_len;
		dev->hard_start_xmit = vlan_dev_hwaccel_hard_start_xmit;
	} else {
		dev->header_ops      = &vlan_header_ops;
		dev->hard_header_len = real_dev->hard_header_len + VLAN_HLEN;
		dev->hard_start_xmit = vlan_dev_hard_start_xmit;
	}

	if (real_dev->priv_flags & IFF_802_1Q_VLAN)
		subclass = 1;

	lockdep_set_class_and_subclass(&dev->_xmit_lock,
				&vlan_netdev_xmit_lock_key, subclass);
	return 0;
}

void vlan_setup(struct net_device *dev)
{
	ether_setup(dev);

	dev->priv_flags		|= IFF_802_1Q_VLAN;
	dev->tx_queue_len	= 0;

	dev->change_mtu		= vlan_dev_change_mtu;
	dev->init		= vlan_dev_init;
	dev->open		= vlan_dev_open;
	dev->stop		= vlan_dev_stop;
	dev->set_mac_address	= vlan_dev_set_mac_address;
705 706
	dev->set_rx_mode	= vlan_dev_set_rx_mode;
	dev->set_multicast_list	= vlan_dev_set_rx_mode;
707 708 709 710 711 712
	dev->change_rx_flags	= vlan_dev_change_rx_flags;
	dev->do_ioctl		= vlan_dev_ioctl;
	dev->destructor		= free_netdev;

	memset(dev->broadcast, 0, ETH_ALEN);
}