vlan_dev.c 19.5 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 92
		}
	}

	return skb;
}

/*
93
 *	Determine the packet's protocol ID. The rule here is that we
L
Linus Torvalds 已提交
94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
 *	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 已提交
109 110 111
 *  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 已提交
112 113 114
 *
 */
int vlan_skb_recv(struct sk_buff *skb, struct net_device *dev,
P
Patrick McHardy 已提交
115
		  struct packet_type *ptype, struct net_device *orig_dev)
L
Linus Torvalds 已提交
116
{
117
	unsigned char *rawp;
118
	struct vlan_hdr *vhdr;
L
Linus Torvalds 已提交
119 120 121
	unsigned short vid;
	struct net_device_stats *stats;
	unsigned short vlan_TCI;
122
	__be16 proto;
L
Linus Torvalds 已提交
123

124 125
	if (dev->nd_net != &init_net)
		goto err_free;
126

P
Patrick McHardy 已提交
127 128
	skb = skb_share_check(skb, GFP_ATOMIC);
	if (skb == NULL)
129
		goto err_free;
130

131 132
	if (unlikely(!pskb_may_pull(skb, VLAN_HLEN)))
		goto err_free;
133

134
	vhdr = (struct vlan_hdr *)skb->data;
L
Linus Torvalds 已提交
135 136 137 138 139 140
	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 已提交
141 142
		pr_debug("%s: ERROR: No net_device for VID: %u on dev: %s\n",
			 __FUNCTION__, (unsigned int)vid, dev->name);
143
		goto err_unlock;
L
Linus Torvalds 已提交
144 145 146 147
	}

	skb->dev->last_rx = jiffies;

P
Patrick McHardy 已提交
148
	stats = &skb->dev->stats;
L
Linus Torvalds 已提交
149 150 151
	stats->rx_packets++;
	stats->rx_bytes += skb->len;

152
	skb_pull_rcsum(skb, VLAN_HLEN);
153

P
Patrick McHardy 已提交
154 155
	skb->priority = vlan_get_ingress_priority(skb->dev,
						  ntohs(vhdr->h_vlan_TCI));
L
Linus Torvalds 已提交
156

157 158
	pr_debug("%s: priority: %u for TCI: %hu\n",
		 __FUNCTION__, skb->priority, ntohs(vhdr->h_vlan_TCI));
L
Linus Torvalds 已提交
159 160 161

	switch (skb->pkt_type) {
	case PACKET_BROADCAST: /* Yeah, stats collect these together.. */
P
Patrick McHardy 已提交
162
		/* stats->broadcast ++; // no such counter :-( */
L
Linus Torvalds 已提交
163 164 165 166 167 168
		break;

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

169
	case PACKET_OTHERHOST:
L
Linus Torvalds 已提交
170
		/* Our lower layer thinks this is not local, let's make sure.
P
Patrick McHardy 已提交
171 172
		 * This allows the VLAN to have a different MAC than the
		 * underlying device, and still route correctly.
L
Linus Torvalds 已提交
173
		 */
P
Patrick McHardy 已提交
174 175
		if (!compare_ether_addr(eth_hdr(skb)->h_dest,
					skb->dev->dev_addr))
L
Linus Torvalds 已提交
176 177 178 179
			skb->pkt_type = PACKET_HOST;
		break;
	default:
		break;
180
	}
L
Linus Torvalds 已提交
181 182 183 184 185 186

	/*  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) {
187 188
		skb->protocol = proto;
		goto recv;
L
Linus Torvalds 已提交
189 190 191 192 193 194 195 196
	}

	/*
	 * 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.
	 */
197
	rawp = skb->data;
L
Linus Torvalds 已提交
198
	if (*(unsigned short *)rawp == 0xFFFF) {
199
		skb->protocol = htons(ETH_P_802_3);
200
		goto recv;
L
Linus Torvalds 已提交
201 202 203 204 205
	}

	/*
	 *	Real 802.2 LLC
	 */
206
	skb->protocol = htons(ETH_P_802_2);
L
Linus Torvalds 已提交
207

208
recv:
L
Linus Torvalds 已提交
209
	skb = vlan_check_reorder_header(skb);
210
	if (!skb) {
L
Linus Torvalds 已提交
211
		stats->rx_errors++;
212
		goto err_unlock;
L
Linus Torvalds 已提交
213
	}
214 215

	netif_rx(skb);
L
Linus Torvalds 已提交
216
	rcu_read_unlock();
217 218 219 220 221 222 223
	return NET_RX_SUCCESS;

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

P
Patrick McHardy 已提交
226 227
static inline unsigned short
vlan_dev_get_egress_qos_mask(struct net_device *dev, struct sk_buff *skb)
L
Linus Torvalds 已提交
228
{
P
Patrick McHardy 已提交
229
	struct vlan_priority_tci_mapping *mp;
L
Linus Torvalds 已提交
230

P
Patrick McHardy 已提交
231
	mp = vlan_dev_info(dev)->egress_priority_map[(skb->priority & 0xF)];
L
Linus Torvalds 已提交
232 233
	while (mp) {
		if (mp->priority == skb->priority) {
P
Patrick McHardy 已提交
234 235 236
			return mp->vlan_qos; /* This should already be shifted
					      * to mask correctly with the
					      * VLAN's TCI */
L
Linus Torvalds 已提交
237 238 239 240 241 242 243
		}
		mp = mp->next;
	}
	return 0;
}

/*
244
 *	Create the VLAN header for an arbitrary protocol layer
L
Linus Torvalds 已提交
245 246 247 248 249 250 251
 *
 *	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.
 */
252 253 254 255
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 已提交
256 257 258 259 260
{
	struct vlan_hdr *vhdr;
	unsigned short veth_TCI = 0;
	int rc = 0;
	int build_vlan_header = 0;
P
Patrick McHardy 已提交
261
	struct net_device *vdev = dev;
L
Linus Torvalds 已提交
262

263
	pr_debug("%s: skb: %p type: %hx len: %u vlan_id: %hx, daddr: %p\n",
P
Patrick McHardy 已提交
264 265
		 __FUNCTION__, skb, type, len, vlan_dev_info(dev)->vlan_id,
		 daddr);
L
Linus Torvalds 已提交
266 267 268 269 270

	/* 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
271
	 * REORDER_HEADER flag is set)	The drawback to this is some extra
L
Linus Torvalds 已提交
272 273 274
	 * header shuffling in the hard_start_xmit.  Users can turn off this
	 * REORDER behaviour with the vconfig tool.
	 */
275
	if (!(vlan_dev_info(dev)->flags & VLAN_FLAG_REORDER_HDR))
276
		build_vlan_header = 1;
L
Linus Torvalds 已提交
277 278 279 280 281 282

	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 已提交
283 284
		/* Now, construct the second two bytes. This field looks
		 * something like:
L
Linus Torvalds 已提交
285 286 287 288 289
		 * usr_priority: 3 bits	 (high bits)
		 * CFI		 1 bit
		 * VLAN ID	 12 bits (low bits)
		 *
		 */
290
		veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
291 292 293 294 295
		veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb);

		vhdr->h_vlan_TCI = htons(veth_TCI);

		/*
P
Patrick McHardy 已提交
296 297 298
		 *  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 已提交
299 300
		 */

P
Patrick McHardy 已提交
301
		if (type != ETH_P_802_3)
L
Linus Torvalds 已提交
302
			vhdr->h_vlan_encapsulated_proto = htons(type);
P
Patrick McHardy 已提交
303
		else
L
Linus Torvalds 已提交
304
			vhdr->h_vlan_encapsulated_proto = htons(len);
305 306

		skb->protocol = htons(ETH_P_8021Q);
307
		skb_reset_network_header(skb);
L
Linus Torvalds 已提交
308 309 310 311 312 313
	}

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

314
	dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
315

P
Patrick McHardy 已提交
316 317 318 319
	/* 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 已提交
320 321
	 */

P
Patrick McHardy 已提交
322 323
	/* 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 已提交
324 325 326 327 328 329 330
	 * 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 已提交
331
			struct net_device_stats *stats = &vdev->stats;
L
Linus Torvalds 已提交
332 333 334
			stats->tx_dropped++;
			return -ENOMEM;
		}
335
		vlan_dev_info(vdev)->cnt_inc_headroom_on_tx++;
P
Patrick McHardy 已提交
336
		pr_debug("%s: %s: had to grow skb\n", __FUNCTION__, vdev->name);
L
Linus Torvalds 已提交
337 338 339 340
	}

	if (build_vlan_header) {
		/* Now make the underlying real hard header */
341 342 343
		rc = dev_hard_header(skb, dev, ETH_P_8021Q, daddr, saddr,
				     len + VLAN_HLEN);
		if (rc > 0)
L
Linus Torvalds 已提交
344
			rc += VLAN_HLEN;
345
		else if (rc < 0)
L
Linus Torvalds 已提交
346
			rc -= VLAN_HLEN;
347
	} else
P
Patrick McHardy 已提交
348 349 350 351
		/* 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 已提交
352
		 */
353
		rc = dev_hard_header(skb, dev, type, daddr, saddr, len);
L
Linus Torvalds 已提交
354 355 356 357

	return rc;
}

358
static int vlan_dev_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
359
{
P
Patrick McHardy 已提交
360
	struct net_device_stats *stats = &dev->stats;
L
Linus Torvalds 已提交
361 362 363 364 365 366 367 368
	struct vlan_ethhdr *veth = (struct vlan_ethhdr *)(skb->data);

	/* 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...
	 */

369
	if (veth->h_vlan_proto != htons(ETH_P_8021Q) ||
370
		vlan_dev_info(dev)->flags & VLAN_FLAG_REORDER_HDR) {
L
Linus Torvalds 已提交
371 372 373 374
		int orig_headroom = skb_headroom(skb);
		unsigned short veth_TCI;

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

377 378
		pr_debug("%s: proto to encap: 0x%hx\n",
			 __FUNCTION__, htons(veth->h_vlan_proto));
L
Linus Torvalds 已提交
379 380 381 382 383 384
		/* 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)
		 */
385
		veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
386 387 388 389 390 391 392 393
		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 已提交
394
		if (orig_headroom < VLAN_HLEN)
395
			vlan_dev_info(dev)->cnt_inc_headroom_on_tx++;
L
Linus Torvalds 已提交
396 397
	}

398
	pr_debug("%s: about to send skb: %p to dev: %s\n",
L
Linus Torvalds 已提交
399
		__FUNCTION__, skb, skb->dev->name);
400 401 402 403 404 405 406
	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],
		 veth->h_vlan_proto, veth->h_vlan_TCI,
		 veth->h_vlan_encapsulated_proto);
L
Linus Torvalds 已提交
407 408 409 410

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

411
	skb->dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
412 413 414 415 416
	dev_queue_xmit(skb);

	return 0;
}

417 418
static int vlan_dev_hwaccel_hard_start_xmit(struct sk_buff *skb,
					    struct net_device *dev)
L
Linus Torvalds 已提交
419
{
P
Patrick McHardy 已提交
420
	struct net_device_stats *stats = &dev->stats;
L
Linus Torvalds 已提交
421 422 423 424 425 426 427 428
	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)
	 */
429
	veth_TCI = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
430 431 432 433 434 435
	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;

436
	skb->dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
437 438 439 440 441
	dev_queue_xmit(skb);

	return 0;
}

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

	dev->mtu = new_mtu;

	return 0;
}

455 456
void vlan_dev_set_ingress_priority(const struct net_device *dev,
				   u32 skb_prio, short vlan_prio)
L
Linus Torvalds 已提交
457
{
458
	struct vlan_dev_info *vlan = vlan_dev_info(dev);
459 460 461 462 463 464 465

	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 已提交
466 467
}

468 469
int vlan_dev_set_egress_priority(const struct net_device *dev,
				 u32 skb_prio, short vlan_prio)
L
Linus Torvalds 已提交
470
{
471
	struct vlan_dev_info *vlan = vlan_dev_info(dev);
L
Linus Torvalds 已提交
472 473
	struct vlan_priority_tci_mapping *mp = NULL;
	struct vlan_priority_tci_mapping *np;
474
	u32 vlan_qos = (vlan_prio << 13) & 0xE000;
475

476
	/* See if a priority mapping exists.. */
477
	mp = vlan->egress_priority_map[skb_prio & 0xF];
478 479
	while (mp) {
		if (mp->priority == skb_prio) {
480 481 482 483 484
			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;
485
			return 0;
L
Linus Torvalds 已提交
486
		}
487
		mp = mp->next;
L
Linus Torvalds 已提交
488
	}
489 490

	/* Create a new mapping then. */
491
	mp = vlan->egress_priority_map[skb_prio & 0xF];
492 493 494 495 496 497
	np = kmalloc(sizeof(struct vlan_priority_tci_mapping), GFP_KERNEL);
	if (!np)
		return -ENOBUFS;

	np->next = mp;
	np->priority = skb_prio;
498 499 500 501
	np->vlan_qos = vlan_qos;
	vlan->egress_priority_map[skb_prio & 0xF] = np;
	if (vlan_qos)
		vlan->nr_egress_mappings++;
502
	return 0;
L
Linus Torvalds 已提交
503 504
}

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

520
void vlan_dev_get_realdev_name(const struct net_device *dev, char *result)
L
Linus Torvalds 已提交
521
{
522
	strncpy(result, vlan_dev_info(dev)->real_dev->name, 23);
L
Linus Torvalds 已提交
523 524
}

525
void vlan_dev_get_vid(const struct net_device *dev, unsigned short *result)
L
Linus Torvalds 已提交
526
{
527
	*result = vlan_dev_info(dev)->vlan_id;
L
Linus Torvalds 已提交
528 529
}

530
static int vlan_dev_open(struct net_device *dev)
L
Linus Torvalds 已提交
531
{
532
	struct vlan_dev_info *vlan = vlan_dev_info(dev);
533 534 535 536
	struct net_device *real_dev = vlan->real_dev;
	int err;

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

539 540 541 542 543 544 545
	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);

546 547 548 549 550
	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 已提交
551 552 553
	return 0;
}

554
static int vlan_dev_stop(struct net_device *dev)
L
Linus Torvalds 已提交
555
{
556
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
557

558
	dev_mc_unsync(real_dev, dev);
559 560 561 562 563
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(real_dev, -1);
	if (dev->flags & IFF_PROMISC)
		dev_set_promiscuity(real_dev, -1);

564 565 566
	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 已提交
567 568 569
	return 0;
}

570
static int vlan_dev_set_mac_address(struct net_device *dev, void *p)
571
{
572
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595
	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;
}

596
static int vlan_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
L
Linus Torvalds 已提交
597
{
598
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
L
Linus Torvalds 已提交
599 600 601 602 603 604
	struct ifreq ifrr;
	int err = -EOPNOTSUPP;

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

P
Patrick McHardy 已提交
605
	switch (cmd) {
L
Linus Torvalds 已提交
606 607 608
	case SIOCGMIIPHY:
	case SIOCGMIIREG:
	case SIOCSMIIREG:
609
		if (real_dev->do_ioctl && netif_device_present(real_dev))
L
Linus Torvalds 已提交
610 611 612 613
			err = real_dev->do_ioctl(real_dev, &ifrr, cmd);
		break;
	}

614
	if (!err)
L
Linus Torvalds 已提交
615 616 617 618 619
		ifr->ifr_ifru = ifrr.ifr_ifru;

	return err;
}

620
static void vlan_dev_change_rx_flags(struct net_device *dev, int change)
621
{
622
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
623 624 625 626 627 628 629

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

630
static void vlan_dev_set_multicast_list(struct net_device *vlan_dev)
L
Linus Torvalds 已提交
631
{
632
	dev_mc_sync(vlan_dev_info(vlan_dev)->real_dev, vlan_dev);
L
Linus Torvalds 已提交
633
}
634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649

/*
 * 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)
{
650
	struct net_device *real_dev = vlan_dev_info(dev)->real_dev;
651 652 653 654 655 656 657 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;
	dev->set_multicast_list	= vlan_dev_set_multicast_list;
	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);
}