[mirror_ubuntu-bionic-kernel.git] / include / linux / if_vlan.h

/*
 * VLAN		An implementation of 802.1Q VLAN tagging.
 *
 * Authors:	Ben Greear <greearb@candelatech.com>
 *
 *		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.
 *
 */
#ifndef _LINUX_IF_VLAN_H_
#define _LINUX_IF_VLAN_H_

#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/rtnetlink.h>
#include <linux/bug.h>
#include <uapi/linux/if_vlan.h>

#define VLAN_HLEN	4		/* The additional bytes required by VLAN
					 * (in addition to the Ethernet header)
					 */
#define VLAN_ETH_HLEN	18		/* Total octets in header.	 */
#define VLAN_ETH_ZLEN	64		/* Min. octets in frame sans FCS */

/*
 * According to 802.3ac, the packet can be 4 bytes longer. --Klika Jan
 */
#define VLAN_ETH_DATA_LEN	1500	/* Max. octets in payload	 */
#define VLAN_ETH_FRAME_LEN	1518	/* Max. octets in frame sans FCS */

/*
 * 	struct vlan_hdr - vlan header
 * 	@h_vlan_TCI: priority and VLAN ID
 *	@h_vlan_encapsulated_proto: packet type ID or len
 */
struct vlan_hdr {
	__be16	h_vlan_TCI;
	__be16	h_vlan_encapsulated_proto;
};

/**
 *	struct vlan_ethhdr - vlan ethernet header (ethhdr + vlan_hdr)
 *	@h_dest: destination ethernet address
 *	@h_source: source ethernet address
 *	@h_vlan_proto: ethernet protocol
 *	@h_vlan_TCI: priority and VLAN ID
 *	@h_vlan_encapsulated_proto: packet type ID or len
 */
struct vlan_ethhdr {
	unsigned char	h_dest[ETH_ALEN];
	unsigned char	h_source[ETH_ALEN];
	__be16		h_vlan_proto;
	__be16		h_vlan_TCI;
	__be16		h_vlan_encapsulated_proto;
};

#include <linux/skbuff.h>

static inline struct vlan_ethhdr *vlan_eth_hdr(const struct sk_buff *skb)
{
	return (struct vlan_ethhdr *)skb_mac_header(skb);
}

#define VLAN_PRIO_MASK		0xe000 /* Priority Code Point */
#define VLAN_PRIO_SHIFT		13
#define VLAN_CFI_MASK		0x1000 /* Canonical Format Indicator */
#define VLAN_TAG_PRESENT	VLAN_CFI_MASK
#define VLAN_VID_MASK		0x0fff /* VLAN Identifier */
#define VLAN_N_VID		4096

/* found in socket.c */
extern void vlan_ioctl_set(int (*hook)(struct net *, void __user *));

static inline bool is_vlan_dev(struct net_device *dev)
{
        return dev->priv_flags & IFF_802_1Q_VLAN;
}

#define vlan_tx_tag_present(__skb)	((__skb)->vlan_tci & VLAN_TAG_PRESENT)
#define vlan_tx_tag_get(__skb)		((__skb)->vlan_tci & ~VLAN_TAG_PRESENT)
#define vlan_tx_tag_get_id(__skb)	((__skb)->vlan_tci & VLAN_VID_MASK)

/**
 *	struct vlan_pcpu_stats - VLAN percpu rx/tx stats
 *	@rx_packets: number of received packets
 *	@rx_bytes: number of received bytes
 *	@rx_multicast: number of received multicast packets
 *	@tx_packets: number of transmitted packets
 *	@tx_bytes: number of transmitted bytes
 *	@syncp: synchronization point for 64bit counters
 *	@rx_errors: number of rx errors
 *	@tx_dropped: number of tx drops
 */
struct vlan_pcpu_stats {
	u64			rx_packets;
	u64			rx_bytes;
	u64			rx_multicast;
	u64			tx_packets;
	u64			tx_bytes;
	struct u64_stats_sync	syncp;
	u32			rx_errors;
	u32			tx_dropped;
};

#if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)

extern struct net_device *__vlan_find_dev_deep(struct net_device *real_dev,
					       __be16 vlan_proto, u16 vlan_id);
extern struct net_device *vlan_dev_real_dev(const struct net_device *dev);
extern u16 vlan_dev_vlan_id(const struct net_device *dev);
extern __be16 vlan_dev_vlan_proto(const struct net_device *dev);

/**
 *	struct vlan_priority_tci_mapping - vlan egress priority mappings
 *	@priority: skb priority
 *	@vlan_qos: vlan priority: (skb->priority << 13) & 0xE000
 *	@next: pointer to next struct
 */
struct vlan_priority_tci_mapping {
	u32					priority;
	u16					vlan_qos;
	struct vlan_priority_tci_mapping	*next;
};

struct proc_dir_entry;
struct netpoll;

/**
 *	struct vlan_dev_priv - VLAN private device data
 *	@nr_ingress_mappings: number of ingress priority mappings
 *	@ingress_priority_map: ingress priority mappings
 *	@nr_egress_mappings: number of egress priority mappings
 *	@egress_priority_map: hash of egress priority mappings
 *	@vlan_proto: VLAN encapsulation protocol
 *	@vlan_id: VLAN identifier
 *	@flags: device flags
 *	@real_dev: underlying netdevice
 *	@real_dev_addr: address of underlying netdevice
 *	@dent: proc dir entry
 *	@vlan_pcpu_stats: ptr to percpu rx stats
 */
struct vlan_dev_priv {
	unsigned int				nr_ingress_mappings;
	u32					ingress_priority_map[8];
	unsigned int				nr_egress_mappings;
	struct vlan_priority_tci_mapping	*egress_priority_map[16];

	__be16					vlan_proto;
	u16					vlan_id;
	u16					flags;

	struct net_device			*real_dev;
	unsigned char				real_dev_addr[ETH_ALEN];

	struct proc_dir_entry			*dent;
	struct vlan_pcpu_stats __percpu		*vlan_pcpu_stats;
#ifdef CONFIG_NET_POLL_CONTROLLER
	struct netpoll				*netpoll;
#endif
	unsigned int				nest_level;
};

static inline struct vlan_dev_priv *vlan_dev_priv(const struct net_device *dev)
{
	return netdev_priv(dev);
}

static inline u16
vlan_dev_get_egress_qos_mask(struct net_device *dev, u32 skprio)
{
	struct vlan_priority_tci_mapping *mp;

	smp_rmb(); /* coupled with smp_wmb() in vlan_dev_set_egress_priority() */

	mp = vlan_dev_priv(dev)->egress_priority_map[(skprio & 0xF)];
	while (mp) {
		if (mp->priority == skprio) {
			return mp->vlan_qos; /* This should already be shifted
					      * to mask correctly with the
					      * VLAN's TCI */
		}
		mp = mp->next;
	}
	return 0;
}

extern bool vlan_do_receive(struct sk_buff **skb);
extern struct sk_buff *vlan_untag(struct sk_buff *skb);

extern int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid);
extern void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid);

extern int vlan_vids_add_by_dev(struct net_device *dev,
				const struct net_device *by_dev);
extern void vlan_vids_del_by_dev(struct net_device *dev,
				 const struct net_device *by_dev);

extern bool vlan_uses_dev(const struct net_device *dev);
#else
static inline struct net_device *
__vlan_find_dev_deep(struct net_device *real_dev,
		     __be16 vlan_proto, u16 vlan_id)
{
	return NULL;
}

static inline struct net_device *vlan_dev_real_dev(const struct net_device *dev)
{
	BUG();
	return NULL;
}

static inline u16 vlan_dev_vlan_id(const struct net_device *dev)
{
	BUG();
	return 0;
}

static inline __be16 vlan_dev_vlan_proto(const struct net_device *dev)
{
	BUG();
	return 0;
}

static inline u16 vlan_dev_get_egress_qos_mask(struct net_device *dev,
					       u32 skprio)
{
	return 0;
}

static inline bool vlan_do_receive(struct sk_buff **skb)
{
	return false;
}

static inline struct sk_buff *vlan_untag(struct sk_buff *skb)
{
	return skb;
}

static inline int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid)
{
	return 0;
}

static inline void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid)
{
}

static inline int vlan_vids_add_by_dev(struct net_device *dev,
				       const struct net_device *by_dev)
{
	return 0;
}

static inline void vlan_vids_del_by_dev(struct net_device *dev,
					const struct net_device *by_dev)
{
}

static inline bool vlan_uses_dev(const struct net_device *dev)
{
	return false;
}
#endif

static inline bool vlan_hw_offload_capable(netdev_features_t features,
					   __be16 proto)
{
	if (proto == htons(ETH_P_8021Q) && features & NETIF_F_HW_VLAN_CTAG_TX)
		return true;
	if (proto == htons(ETH_P_8021AD) && features & NETIF_F_HW_VLAN_STAG_TX)
		return true;
	return false;
}

/**
 * vlan_insert_tag - regular VLAN tag inserting
 * @skb: skbuff to tag
 * @vlan_proto: VLAN encapsulation protocol
 * @vlan_tci: VLAN TCI to insert
 *
 * Inserts the VLAN tag into @skb as part of the payload
 * Returns a VLAN tagged skb. If a new skb is created, @skb is freed.
 *
 * Following the skb_unshare() example, in case of error, the calling function
 * doesn't have to worry about freeing the original skb.
 *
 * Does not change skb->protocol so this function can be used during receive.
 */
static inline struct sk_buff *vlan_insert_tag(struct sk_buff *skb,
					      __be16 vlan_proto, u16 vlan_tci)
{
	struct vlan_ethhdr *veth;

	if (skb_cow_head(skb, VLAN_HLEN) < 0) {
		dev_kfree_skb_any(skb);
		return NULL;
	}
	veth = (struct vlan_ethhdr *)skb_push(skb, VLAN_HLEN);

	/* Move the mac addresses to the beginning of the new header. */
	memmove(skb->data, skb->data + VLAN_HLEN, 2 * ETH_ALEN);
	skb->mac_header -= VLAN_HLEN;

	/* first, the ethernet type */
	veth->h_vlan_proto = vlan_proto;

	/* now, the TCI */
	veth->h_vlan_TCI = htons(vlan_tci);

	return skb;
}

/**
 * __vlan_put_tag - regular VLAN tag inserting
 * @skb: skbuff to tag
 * @vlan_tci: VLAN TCI to insert
 *
 * Inserts the VLAN tag into @skb as part of the payload
 * Returns a VLAN tagged skb. If a new skb is created, @skb is freed.
 *
 * Following the skb_unshare() example, in case of error, the calling function
 * doesn't have to worry about freeing the original skb.
 */
static inline struct sk_buff *__vlan_put_tag(struct sk_buff *skb,
					     __be16 vlan_proto, u16 vlan_tci)
{
	skb = vlan_insert_tag(skb, vlan_proto, vlan_tci);
	if (skb)
		skb->protocol = vlan_proto;
	return skb;
}

/**
 * __vlan_hwaccel_put_tag - hardware accelerated VLAN inserting
 * @skb: skbuff to tag
 * @vlan_proto: VLAN encapsulation protocol
 * @vlan_tci: VLAN TCI to insert
 *
 * Puts the VLAN TCI in @skb->vlan_tci and lets the device do the rest
 */
static inline struct sk_buff *__vlan_hwaccel_put_tag(struct sk_buff *skb,
						     __be16 vlan_proto,
						     u16 vlan_tci)
{
	skb->vlan_proto = vlan_proto;
	skb->vlan_tci = VLAN_TAG_PRESENT | vlan_tci;
	return skb;
}

/**
 * vlan_put_tag - inserts VLAN tag according to device features
 * @skb: skbuff to tag
 * @vlan_tci: VLAN TCI to insert
 *
 * Assumes skb->dev is the target that will xmit this frame.
 * Returns a VLAN tagged skb.
 */
static inline struct sk_buff *vlan_put_tag(struct sk_buff *skb,
					   __be16 vlan_proto, u16 vlan_tci)
{
	if (vlan_hw_offload_capable(skb->dev->features, vlan_proto)) {
		return __vlan_hwaccel_put_tag(skb, vlan_proto, vlan_tci);
	} else {
		return __vlan_put_tag(skb, vlan_proto, vlan_tci);
	}
}

/**
 * __vlan_get_tag - get the VLAN ID that is part of the payload
 * @skb: skbuff to query
 * @vlan_tci: buffer to store vlaue
 *
 * Returns error if the skb is not of VLAN type
 */
static inline int __vlan_get_tag(const struct sk_buff *skb, u16 *vlan_tci)
{
	struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb->data;

	if (veth->h_vlan_proto != htons(ETH_P_8021Q) &&
	    veth->h_vlan_proto != htons(ETH_P_8021AD))
		return -EINVAL;

	*vlan_tci = ntohs(veth->h_vlan_TCI);
	return 0;
}

/**
 * __vlan_hwaccel_get_tag - get the VLAN ID that is in @skb->cb[]
 * @skb: skbuff to query
 * @vlan_tci: buffer to store vlaue
 *
 * Returns error if @skb->vlan_tci is not set correctly
 */
static inline int __vlan_hwaccel_get_tag(const struct sk_buff *skb,
					 u16 *vlan_tci)
{
	if (vlan_tx_tag_present(skb)) {
		*vlan_tci = vlan_tx_tag_get(skb);
		return 0;
	} else {
		*vlan_tci = 0;
		return -EINVAL;
	}
}

#define HAVE_VLAN_GET_TAG

/**
 * vlan_get_tag - get the VLAN ID from the skb
 * @skb: skbuff to query
 * @vlan_tci: buffer to store vlaue
 *
 * Returns error if the skb is not VLAN tagged
 */
static inline int vlan_get_tag(const struct sk_buff *skb, u16 *vlan_tci)
{
	if (skb->dev->features & NETIF_F_HW_VLAN_CTAG_TX) {
		return __vlan_hwaccel_get_tag(skb, vlan_tci);
	} else {
		return __vlan_get_tag(skb, vlan_tci);
	}
}

/**
 * vlan_get_protocol - get protocol EtherType.
 * @skb: skbuff to query
 *
 * Returns the EtherType of the packet, regardless of whether it is
 * vlan encapsulated (normal or hardware accelerated) or not.
 */
static inline __be16 vlan_get_protocol(const struct sk_buff *skb)
{
	__be16 protocol = 0;

	if (vlan_tx_tag_present(skb) ||
	     skb->protocol != cpu_to_be16(ETH_P_8021Q))
		protocol = skb->protocol;
	else {
		__be16 proto, *protop;
		protop = skb_header_pointer(skb, offsetof(struct vlan_ethhdr,
						h_vlan_encapsulated_proto),
						sizeof(proto), &proto);
		if (likely(protop))
			protocol = *protop;
	}

	return protocol;
}

static inline void vlan_set_encap_proto(struct sk_buff *skb,
					struct vlan_hdr *vhdr)
{
	__be16 proto;
	unsigned short *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) >= ETH_P_802_3_MIN) {
		skb->protocol = proto;
		return;
	}

	rawp = (unsigned short *)(vhdr + 1);
	if (*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);
}
#endif /* !(_LINUX_IF_VLAN_H_) */
Commit	Line	Data
1da177e4 LT	1	/*
	2	* VLAN An implementation of 802.1Q VLAN tagging.
	3	*
	4	* Authors: Ben Greear <greearb@candelatech.com>
	5	*
	6	* This program is free software; you can redistribute it and/or
	7	* modify it under the terms of the GNU General Public License
	8	* as published by the Free Software Foundation; either version
	9	* 2 of the License, or (at your option) any later version.
	10	*
	11	*/
1da177e4 LT	12	#ifndef _LINUX_IF_VLAN_H_
	13	#define _LINUX_IF_VLAN_H_
	14
1da177e4	15	#include <linux/netdevice.h>
0610d11b	16	#include <linux/etherdevice.h>
65ac6a5f	17	#include <linux/rtnetlink.h>
187f1882	18	#include <linux/bug.h>
607ca46e	19	#include <uapi/linux/if_vlan.h>
1da177e4	20
a3f671b3 JP	21	#define VLAN_HLEN 4 /* The additional bytes required by VLAN
a3f671b3 JP	22	* (in addition to the Ethernet header)
1da177e4	23	*/
1da177e4 LT	24	#define VLAN_ETH_HLEN 18 /* Total octets in header. */
	25	#define VLAN_ETH_ZLEN 64 /* Min. octets in frame sans FCS */
	26
	27	/*
	28	* According to 802.3ac, the packet can be 4 bytes longer. --Klika Jan
	29	*/
	30	#define VLAN_ETH_DATA_LEN 1500 /* Max. octets in payload */
	31	#define VLAN_ETH_FRAME_LEN 1518 /* Max. octets in frame sans FCS */
	32
740c15d0 PM	33	/*
	34	* struct vlan_hdr - vlan header
	35	* @h_vlan_TCI: priority and VLAN ID
	36	* @h_vlan_encapsulated_proto: packet type ID or len
	37	*/
	38	struct vlan_hdr {
	39	__be16 h_vlan_TCI;
	40	__be16 h_vlan_encapsulated_proto;
	41	};
	42
	43	/**
	44	* struct vlan_ethhdr - vlan ethernet header (ethhdr + vlan_hdr)
	45	* @h_dest: destination ethernet address
	46	* @h_source: source ethernet address
a7bf5804	47	* @h_vlan_proto: ethernet protocol
740c15d0 PM	48	* @h_vlan_TCI: priority and VLAN ID
	49	* @h_vlan_encapsulated_proto: packet type ID or len
	50	*/
1da177e4	51	struct vlan_ethhdr {
740c15d0 PM	52	unsigned char h_dest[ETH_ALEN];
	53	unsigned char h_source[ETH_ALEN];
	54	__be16 h_vlan_proto;
	55	__be16 h_vlan_TCI;
	56	__be16 h_vlan_encapsulated_proto;
1da177e4 LT	57	};
	58
	59	#include <linux/skbuff.h>
	60
	61	static inline struct vlan_ethhdr vlan_eth_hdr(const struct sk_buff skb)
	62	{
98e399f8	63	return (struct vlan_ethhdr *)skb_mac_header(skb);
1da177e4 LT	64	}
1da177e4 LT	65
05423b24 ED	66	#define VLAN_PRIO_MASK 0xe000 /* Priority Code Point */
	67	#define VLAN_PRIO_SHIFT 13
	68	#define VLAN_CFI_MASK 0x1000 /* Canonical Format Indicator */
	69	#define VLAN_TAG_PRESENT VLAN_CFI_MASK
	70	#define VLAN_VID_MASK 0x0fff /* VLAN Identifier */
b738127d	71	#define VLAN_N_VID 4096
1da177e4 LT	72
1da177e4 LT	73	/* found in socket.c */
881d966b	74	extern void vlan_ioctl_set(int (hook)(struct net , void __user *));
1da177e4	75
d38569ab	76	static inline bool is_vlan_dev(struct net_device *dev)
6dcbbe25 NH	77	{
	78	return dev->priv_flags & IFF_802_1Q_VLAN;
	79	}
	80
05423b24 ED	81	#define vlan_tx_tag_present(__skb) ((__skb)->vlan_tci & VLAN_TAG_PRESENT)
05423b24 ED	82	#define vlan_tx_tag_get(__skb) ((__skb)->vlan_tci & ~VLAN_TAG_PRESENT)
d4b812de	83	#define vlan_tx_tag_get_id(__skb) ((__skb)->vlan_tci & VLAN_VID_MASK)
1da177e4	84
e267cb96 DM	85	/**
	86	* struct vlan_pcpu_stats - VLAN percpu rx/tx stats
	87	* @rx_packets: number of received packets
	88	* @rx_bytes: number of received bytes
	89	* @rx_multicast: number of received multicast packets
	90	* @tx_packets: number of transmitted packets
	91	* @tx_bytes: number of transmitted bytes
	92	* @syncp: synchronization point for 64bit counters
	93	* @rx_errors: number of rx errors
	94	* @tx_dropped: number of tx drops
	95	*/
	96	struct vlan_pcpu_stats {
	97	u64 rx_packets;
	98	u64 rx_bytes;
	99	u64 rx_multicast;
	100	u64 tx_packets;
	101	u64 tx_bytes;
	102	struct u64_stats_sync syncp;
	103	u32 rx_errors;
	104	u32 tx_dropped;
	105	};
	106
1e85c9b6 HFS	107	#if defined(CONFIG_VLAN_8021Q) \|\| defined(CONFIG_VLAN_8021Q_MODULE)
	108
	109	extern struct net_device __vlan_find_dev_deep(struct net_device real_dev,
	110	__be16 vlan_proto, u16 vlan_id);
	111	extern struct net_device vlan_dev_real_dev(const struct net_device dev);
	112	extern u16 vlan_dev_vlan_id(const struct net_device *dev);
71e415e4	113	extern __be16 vlan_dev_vlan_proto(const struct net_device *dev);
1e85c9b6 HFS	114
	115	/**
	116	* struct vlan_priority_tci_mapping - vlan egress priority mappings
	117	* @priority: skb priority
	118	* @vlan_qos: vlan priority: (skb->priority << 13) & 0xE000
	119	* @next: pointer to next struct
	120	*/
	121	struct vlan_priority_tci_mapping {
	122	u32 priority;
	123	u16 vlan_qos;
	124	struct vlan_priority_tci_mapping *next;
	125	};
	126
e267cb96 DM	127	struct proc_dir_entry;
	128	struct netpoll;
	129
	130	/**
	131	* struct vlan_dev_priv - VLAN private device data
	132	* @nr_ingress_mappings: number of ingress priority mappings
	133	* @ingress_priority_map: ingress priority mappings
	134	* @nr_egress_mappings: number of egress priority mappings
	135	* @egress_priority_map: hash of egress priority mappings
	136	* @vlan_proto: VLAN encapsulation protocol
	137	* @vlan_id: VLAN identifier
	138	* @flags: device flags
	139	* @real_dev: underlying netdevice
	140	* @real_dev_addr: address of underlying netdevice
	141	* @dent: proc dir entry
	142	* @vlan_pcpu_stats: ptr to percpu rx stats
	143	*/
	144	struct vlan_dev_priv {
	145	unsigned int nr_ingress_mappings;
	146	u32 ingress_priority_map[8];
	147	unsigned int nr_egress_mappings;
	148	struct vlan_priority_tci_mapping *egress_priority_map[16];
	149
	150	__be16 vlan_proto;
	151	u16 vlan_id;
	152	u16 flags;
	153
	154	struct net_device *real_dev;
	155	unsigned char real_dev_addr[ETH_ALEN];
	156
	157	struct proc_dir_entry *dent;
	158	struct vlan_pcpu_stats __percpu *vlan_pcpu_stats;
	159	#ifdef CONFIG_NET_POLL_CONTROLLER
	160	struct netpoll *netpoll;
	161	#endif
d38569ab	162	unsigned int nest_level;
e267cb96 DM	163	};
	164
	165	static inline struct vlan_dev_priv vlan_dev_priv(const struct net_device dev)
	166	{
	167	return netdev_priv(dev);
	168	}
	169
	170	static inline u16
	171	vlan_dev_get_egress_qos_mask(struct net_device *dev, u32 skprio)
	172	{
	173	struct vlan_priority_tci_mapping *mp;
	174
	175	smp_rmb(); /* coupled with smp_wmb() in vlan_dev_set_egress_priority() */
	176
	177	mp = vlan_dev_priv(dev)->egress_priority_map[(skprio & 0xF)];
	178	while (mp) {
	179	if (mp->priority == skprio) {
	180	return mp->vlan_qos; /* This should already be shifted
	181	* to mask correctly with the
	182	* VLAN's TCI */
	183	}
	184	mp = mp->next;
	185	}
	186	return 0;
	187	}
	188
48cc32d3	189	extern bool vlan_do_receive(struct sk_buff **skb);
bcc6d479	190	extern struct sk_buff vlan_untag(struct sk_buff skb);
9b22ea56	191
80d5c368 PM	192	extern int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid);
80d5c368 PM	193	extern void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid);
87002b03	194
348a1443 JP	195	extern int vlan_vids_add_by_dev(struct net_device *dev,
	196	const struct net_device *by_dev);
	197	extern void vlan_vids_del_by_dev(struct net_device *dev,
	198	const struct net_device *by_dev);
9b361c13 JP	199
9b361c13 JP	200	extern bool vlan_uses_dev(const struct net_device *dev);
7750f403	201	#else
cec9c133	202	static inline struct net_device *
9fae27b3 PM	203	__vlan_find_dev_deep(struct net_device *real_dev,
9fae27b3 PM	204	__be16 vlan_proto, u16 vlan_id)
cec9c133 JP	205	{
	206	return NULL;
	207	}
	208
22d1ba74 PM	209	static inline struct net_device vlan_dev_real_dev(const struct net_device dev)
	210	{
	211	BUG();
	212	return NULL;
	213	}
	214
	215	static inline u16 vlan_dev_vlan_id(const struct net_device *dev)
	216	{
	217	BUG();
	218	return 0;
	219	}
	220
71e415e4	221	static inline __be16 vlan_dev_vlan_proto(const struct net_device *dev)
	222	{
	223	BUG();
	224	return 0;
	225	}
	226
d3243539 EP	227	static inline u16 vlan_dev_get_egress_qos_mask(struct net_device *dev,
	228	u32 skprio)
	229	{
	230	return 0;
	231	}
	232
48cc32d3	233	static inline bool vlan_do_receive(struct sk_buff **skb)
9b22ea56	234	{
3701e513	235	return false;
9b22ea56	236	}
e1c096e2	237
6139e75f	238	static inline struct sk_buff vlan_untag(struct sk_buff skb)
bcc6d479 JP	239	{
	240	return skb;
	241	}
87002b03	242
9fae27b3	243	static inline int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid)
87002b03 JP	244	{
	245	return 0;
	246	}
	247
9fae27b3	248	static inline void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid)
87002b03 JP	249	{
87002b03 JP	250	}
348a1443 JP	251
	252	static inline int vlan_vids_add_by_dev(struct net_device *dev,
	253	const struct net_device *by_dev)
	254	{
	255	return 0;
	256	}
	257
	258	static inline void vlan_vids_del_by_dev(struct net_device *dev,
	259	const struct net_device *by_dev)
	260	{
	261	}
9b361c13 JP	262
	263	static inline bool vlan_uses_dev(const struct net_device *dev)
	264	{
	265	return false;
	266	}
7750f403	267	#endif
1da177e4	268
86a9bad3 PM	269	static inline bool vlan_hw_offload_capable(netdev_features_t features,
	270	__be16 proto)
	271	{
	272	if (proto == htons(ETH_P_8021Q) && features & NETIF_F_HW_VLAN_CTAG_TX)
	273	return true;
8ad227ff PM	274	if (proto == htons(ETH_P_8021AD) && features & NETIF_F_HW_VLAN_STAG_TX)
8ad227ff PM	275	return true;
86a9bad3 PM	276	return false;
	277	}
	278
1da177e4	279	/**
0b5c9db1	280	* vlan_insert_tag - regular VLAN tag inserting
1da177e4	281	* @skb: skbuff to tag
86a9bad3	282	* @vlan_proto: VLAN encapsulation protocol
9bb8582e	283	* @vlan_tci: VLAN TCI to insert
1da177e4 LT	284	*
	285	* Inserts the VLAN tag into @skb as part of the payload
	286	* Returns a VLAN tagged skb. If a new skb is created, @skb is freed.
9bb8582e	287	*
1da177e4 LT	288	* Following the skb_unshare() example, in case of error, the calling function
1da177e4 LT	289	* doesn't have to worry about freeing the original skb.
0b5c9db1 JP	290	*
0b5c9db1 JP	291	* Does not change skb->protocol so this function can be used during receive.
1da177e4	292	*/
86a9bad3 PM	293	static inline struct sk_buff vlan_insert_tag(struct sk_buff skb,
86a9bad3 PM	294	__be16 vlan_proto, u16 vlan_tci)
1da177e4 LT	295	{
	296	struct vlan_ethhdr *veth;
	297
11a100f8	298	if (skb_cow_head(skb, VLAN_HLEN) < 0) {
fb7c03df	299	dev_kfree_skb_any(skb);
11a100f8	300	return NULL;
1da177e4	301	}
1da177e4 LT	302	veth = (struct vlan_ethhdr *)skb_push(skb, VLAN_HLEN);
	303
	304	/* Move the mac addresses to the beginning of the new header. */
a3f671b3	305	memmove(skb->data, skb->data + VLAN_HLEN, 2 * ETH_ALEN);
e4dd6188	306	skb->mac_header -= VLAN_HLEN;
1da177e4 LT	307
1da177e4 LT	308	/* first, the ethernet type */
86a9bad3	309	veth->h_vlan_proto = vlan_proto;
1da177e4	310
9bb8582e PM	311	/* now, the TCI */
9bb8582e PM	312	veth->h_vlan_TCI = htons(vlan_tci);
1da177e4	313
0b5c9db1 JP	314	return skb;
0b5c9db1 JP	315	}
1da177e4	316
0b5c9db1 JP	317	/**
	318	* __vlan_put_tag - regular VLAN tag inserting
	319	* @skb: skbuff to tag
	320	* @vlan_tci: VLAN TCI to insert
	321	*
	322	* Inserts the VLAN tag into @skb as part of the payload
	323	* Returns a VLAN tagged skb. If a new skb is created, @skb is freed.
	324	*
	325	* Following the skb_unshare() example, in case of error, the calling function
	326	* doesn't have to worry about freeing the original skb.
	327	*/
86a9bad3 PM	328	static inline struct sk_buff __vlan_put_tag(struct sk_buff skb,
86a9bad3 PM	329	__be16 vlan_proto, u16 vlan_tci)
0b5c9db1	330	{
86a9bad3	331	skb = vlan_insert_tag(skb, vlan_proto, vlan_tci);
0b5c9db1	332	if (skb)
86a9bad3	333	skb->protocol = vlan_proto;
1da177e4 LT	334	return skb;
	335	}
	336
	337	/**
	338	* __vlan_hwaccel_put_tag - hardware accelerated VLAN inserting
	339	* @skb: skbuff to tag
86a9bad3	340	* @vlan_proto: VLAN encapsulation protocol
9bb8582e	341	* @vlan_tci: VLAN TCI to insert
1da177e4	342	*
6aa895b0	343	* Puts the VLAN TCI in @skb->vlan_tci and lets the device do the rest
1da177e4	344	*/
9bb8582e	345	static inline struct sk_buff __vlan_hwaccel_put_tag(struct sk_buff skb,
86a9bad3	346	__be16 vlan_proto,
9bb8582e	347	u16 vlan_tci)
1da177e4	348	{
86a9bad3	349	skb->vlan_proto = vlan_proto;
05423b24	350	skb->vlan_tci = VLAN_TAG_PRESENT \| vlan_tci;
1da177e4 LT	351	return skb;
	352	}
	353
1da177e4 LT	354	/**
	355	* vlan_put_tag - inserts VLAN tag according to device features
	356	* @skb: skbuff to tag
9bb8582e	357	* @vlan_tci: VLAN TCI to insert
1da177e4 LT	358	*
	359	* Assumes skb->dev is the target that will xmit this frame.
	360	* Returns a VLAN tagged skb.
	361	*/
86a9bad3 PM	362	static inline struct sk_buff vlan_put_tag(struct sk_buff skb,
86a9bad3 PM	363	__be16 vlan_proto, u16 vlan_tci)
1da177e4	364	{
86a9bad3 PM	365	if (vlan_hw_offload_capable(skb->dev->features, vlan_proto)) {
86a9bad3 PM	366	return __vlan_hwaccel_put_tag(skb, vlan_proto, vlan_tci);
1da177e4	367	} else {
86a9bad3	368	return __vlan_put_tag(skb, vlan_proto, vlan_tci);
1da177e4 LT	369	}
	370	}
	371
	372	/**
	373	* __vlan_get_tag - get the VLAN ID that is part of the payload
	374	* @skb: skbuff to query
9bb8582e PM	375	* @vlan_tci: buffer to store vlaue
9bb8582e PM	376	*
1da177e4 LT	377	* Returns error if the skb is not of VLAN type
1da177e4 LT	378	*/
9bb8582e	379	static inline int __vlan_get_tag(const struct sk_buff skb, u16 vlan_tci)
1da177e4 LT	380	{
	381	struct vlan_ethhdr veth = (struct vlan_ethhdr )skb->data;
	382
8ad227ff PM	383	if (veth->h_vlan_proto != htons(ETH_P_8021Q) &&
8ad227ff PM	384	veth->h_vlan_proto != htons(ETH_P_8021AD))
1da177e4	385	return -EINVAL;
1da177e4	386
9bb8582e	387	*vlan_tci = ntohs(veth->h_vlan_TCI);
1da177e4 LT	388	return 0;
	389	}
	390
	391	/**
	392	* __vlan_hwaccel_get_tag - get the VLAN ID that is in @skb->cb[]
	393	* @skb: skbuff to query
9bb8582e PM	394	* @vlan_tci: buffer to store vlaue
9bb8582e PM	395	*
6aa895b0	396	* Returns error if @skb->vlan_tci is not set correctly
1da177e4	397	*/
18149935	398	static inline int __vlan_hwaccel_get_tag(const struct sk_buff *skb,
9bb8582e	399	u16 *vlan_tci)
1da177e4	400	{
6aa895b0	401	if (vlan_tx_tag_present(skb)) {
05423b24	402	*vlan_tci = vlan_tx_tag_get(skb);
1da177e4 LT	403	return 0;
1da177e4 LT	404	} else {
9bb8582e	405	*vlan_tci = 0;
1da177e4 LT	406	return -EINVAL;
	407	}
	408	}
	409
	410	#define HAVE_VLAN_GET_TAG
	411
	412	/**
	413	* vlan_get_tag - get the VLAN ID from the skb
	414	* @skb: skbuff to query
9bb8582e PM	415	* @vlan_tci: buffer to store vlaue
9bb8582e PM	416	*
1da177e4 LT	417	* Returns error if the skb is not VLAN tagged
1da177e4 LT	418	*/
9bb8582e	419	static inline int vlan_get_tag(const struct sk_buff skb, u16 vlan_tci)
1da177e4	420	{
f646968f	421	if (skb->dev->features & NETIF_F_HW_VLAN_CTAG_TX) {
9bb8582e	422	return __vlan_hwaccel_get_tag(skb, vlan_tci);
1da177e4	423	} else {
9bb8582e	424	return __vlan_get_tag(skb, vlan_tci);
1da177e4 LT	425	}
	426	}
	427
0a85df00 HZ	428	/**
	429	* vlan_get_protocol - get protocol EtherType.
	430	* @skb: skbuff to query
	431	*
	432	* Returns the EtherType of the packet, regardless of whether it is
	433	* vlan encapsulated (normal or hardware accelerated) or not.
	434	*/
	435	static inline __be16 vlan_get_protocol(const struct sk_buff *skb)
	436	{
	437	__be16 protocol = 0;
	438
	439	if (vlan_tx_tag_present(skb) \|\|
	440	skb->protocol != cpu_to_be16(ETH_P_8021Q))
	441	protocol = skb->protocol;
	442	else {
	443	__be16 proto, *protop;
	444	protop = skb_header_pointer(skb, offsetof(struct vlan_ethhdr,
	445	h_vlan_encapsulated_proto),
	446	sizeof(proto), &proto);
	447	if (likely(protop))
	448	protocol = *protop;
	449	}
	450
	451	return protocol;
	452	}
396cf943 PS	453
	454	static inline void vlan_set_encap_proto(struct sk_buff *skb,
	455	struct vlan_hdr *vhdr)
	456	{
	457	__be16 proto;
da8c8724	458	unsigned short *rawp;
396cf943 PS	459
	460	/*
	461	* Was a VLAN packet, grab the encapsulated protocol, which the layer
	462	* three protocols care about.
	463	*/
	464
	465	proto = vhdr->h_vlan_encapsulated_proto;
e5c5d22e	466	if (ntohs(proto) >= ETH_P_802_3_MIN) {
396cf943 PS	467	skb->protocol = proto;
	468	return;
	469	}
	470
da8c8724 CW	471	rawp = (unsigned short *)(vhdr + 1);
da8c8724 CW	472	if (*rawp == 0xFFFF)
396cf943 PS	473	/*
	474	* This is a magic hack to spot IPX packets. Older Novell
	475	* breaks the protocol design and runs IPX over 802.3 without
	476	* an 802.2 LLC layer. We look for FFFF which isn't a used
	477	* 802.2 SSAP/DSAP. This won't work for fault tolerant netware
	478	* but does for the rest.
	479	*/
	480	skb->protocol = htons(ETH_P_802_3);
	481	else
	482	/*
	483	* Real 802.2 LLC
	484	*/
	485	skb->protocol = htons(ETH_P_802_2);
	486	}
1da177e4	487	#endif /* !(_LINUX_IF_VLAN_H_) */