vlan_dev.c 19.8 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

L
Linus Torvalds 已提交
370 371 372 373 374 375
	/* 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...
	 */

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

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

384
		pr_debug("%s: proto to encap: 0x%hx\n",
A
Al Viro 已提交
385
			 __FUNCTION__, ntohs(veth->h_vlan_proto));
L
Linus Torvalds 已提交
386 387 388 389 390 391
		/* 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)
		 */
392
		veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
393 394 395 396 397 398 399 400
		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 已提交
401
		if (orig_headroom < VLAN_HLEN)
402
			vlan_dev_info(dev)->cnt_inc_headroom_on_tx++;
L
Linus Torvalds 已提交
403 404
	}

405
	pr_debug("%s: about to send skb: %p to dev: %s\n",
L
Linus Torvalds 已提交
406
		__FUNCTION__, skb, skb->dev->name);
407 408 409 410 411
	pr_debug("  " MAC_FMT " " MAC_FMT " %4hx %4hx %4hx\n",
		 veth->h_dest[0], veth->h_dest[1], veth->h_dest[2],
		 veth->h_dest[3], veth->h_dest[4], veth->h_dest[5],
		 veth->h_source[0], veth->h_source[1], veth->h_source[2],
		 veth->h_source[3], veth->h_source[4], veth->h_source[5],
412 413
		 veth->h_vlan_proto, veth->h_vlan_TCI,
		 veth->h_vlan_encapsulated_proto);
L
Linus Torvalds 已提交
414 415 416 417

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

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

	return 0;
}

424 425
static int vlan_dev_hwaccel_hard_start_xmit(struct sk_buff *skb,
					    struct net_device *dev)
L
Linus Torvalds 已提交
426
{
P
Patrick McHardy 已提交
427
	struct net_device_stats *stats = &dev->stats;
L
Linus Torvalds 已提交
428 429 430 431 432 433 434 435
	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)
	 */
436
	veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
437 438 439 440 441 442
	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;

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

	return 0;
}

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

	dev->mtu = new_mtu;

	return 0;
}

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

	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 已提交
473 474
}

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

483
	/* See if a priority mapping exists.. */
484
	mp = vlan->egress_priority_map[skb_prio & 0xF];
485 486
	while (mp) {
		if (mp->priority == skb_prio) {
487 488 489 490 491
			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;
492
			return 0;
L
Linus Torvalds 已提交
493
		}
494
		mp = mp->next;
L
Linus Torvalds 已提交
495
	}
496 497

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

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

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

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

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

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

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

546 547 548 549 550 551 552
	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);

553 554 555 556 557
	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 已提交
558 559 560
	return 0;
}

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

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

572 573 574
	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 已提交
575 576 577
	return 0;
}

578
static int vlan_dev_set_mac_address(struct net_device *dev, void *p)
579
{
580
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603
	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;
}

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

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

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

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

	return err;
}

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

	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);
}

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

/*
 * 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)
{
659
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
660 661 662
	int subclass = 0;

	/* IFF_BROADCAST|IFF_MULTICAST; ??? */
663
	dev->flags  = real_dev->flags & ~(IFF_UP | IFF_PROMISC | IFF_ALLMULTI);
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 705 706
	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;
707 708
	dev->set_rx_mode	= vlan_dev_set_rx_mode;
	dev->set_multicast_list	= vlan_dev_set_rx_mode;
709 710 711 712 713 714
	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);
}