Patrick McHardy | 7750f40 | 2008-07-08 03:23:36 -0700 | [diff] [blame] | 1 | #include <linux/skbuff.h> |
| 2 | #include <linux/netdevice.h> |
| 3 | #include <linux/if_vlan.h> |
Herbert Xu | 4ead443 | 2009-03-01 00:11:52 -0800 | [diff] [blame] | 4 | #include <linux/netpoll.h> |
Paul Gortmaker | bc3b2d7 | 2011-07-15 11:47:34 -0400 | [diff] [blame] | 5 | #include <linux/export.h> |
Patrick McHardy | 7750f40 | 2008-07-08 03:23:36 -0700 | [diff] [blame] | 6 | #include "vlan.h" |
| 7 | |
Eric Dumazet | 6a32e4f | 2011-10-29 06:13:39 +0000 | [diff] [blame] | 8 | bool vlan_do_receive(struct sk_buff **skbp, bool last_handler) |
Patrick McHardy | 7750f40 | 2008-07-08 03:23:36 -0700 | [diff] [blame] | 9 | { |
Jesse Gross | 3701e51 | 2010-10-20 13:56:06 +0000 | [diff] [blame] | 10 | struct sk_buff *skb = *skbp; |
| 11 | u16 vlan_id = skb->vlan_tci & VLAN_VID_MASK; |
Pedro Garcia | ad1afb0 | 2010-07-18 15:38:44 -0700 | [diff] [blame] | 12 | struct net_device *vlan_dev; |
Eric Dumazet | 4af429d | 2010-11-10 23:42:00 +0000 | [diff] [blame] | 13 | struct vlan_pcpu_stats *rx_stats; |
Pedro Garcia | ad1afb0 | 2010-07-18 15:38:44 -0700 | [diff] [blame] | 14 | |
Jesse Gross | 3701e51 | 2010-10-20 13:56:06 +0000 | [diff] [blame] | 15 | vlan_dev = vlan_find_dev(skb->dev, vlan_id); |
| 16 | if (!vlan_dev) { |
Eric Dumazet | 6a32e4f | 2011-10-29 06:13:39 +0000 | [diff] [blame] | 17 | /* Only the last call to vlan_do_receive() should change |
| 18 | * pkt_type to PACKET_OTHERHOST |
| 19 | */ |
| 20 | if (vlan_id && last_handler) |
Jesse Gross | 3701e51 | 2010-10-20 13:56:06 +0000 | [diff] [blame] | 21 | skb->pkt_type = PACKET_OTHERHOST; |
| 22 | return false; |
Eric Dumazet | 173e79f | 2010-09-30 02:16:44 +0000 | [diff] [blame] | 23 | } |
Patrick McHardy | 9b22ea5 | 2008-11-04 14:49:57 -0800 | [diff] [blame] | 24 | |
Jesse Gross | 3701e51 | 2010-10-20 13:56:06 +0000 | [diff] [blame] | 25 | skb = *skbp = skb_share_check(skb, GFP_ATOMIC); |
| 26 | if (unlikely(!skb)) |
| 27 | return false; |
Herbert Xu | e1c096e | 2009-01-06 10:50:09 -0800 | [diff] [blame] | 28 | |
Jesse Gross | 3701e51 | 2010-10-20 13:56:06 +0000 | [diff] [blame] | 29 | skb->dev = vlan_dev; |
Jiri Pirko | 0b5c9db | 2011-06-10 06:56:58 +0000 | [diff] [blame] | 30 | if (skb->pkt_type == PACKET_OTHERHOST) { |
| 31 | /* Our lower layer thinks this is not local, let's make sure. |
| 32 | * This allows the VLAN to have a different MAC than the |
| 33 | * underlying device, and still route correctly. */ |
| 34 | if (!compare_ether_addr(eth_hdr(skb)->h_dest, |
| 35 | vlan_dev->dev_addr)) |
| 36 | skb->pkt_type = PACKET_HOST; |
| 37 | } |
| 38 | |
Jiri Pirko | 7da82c0 | 2011-12-08 04:11:15 +0000 | [diff] [blame] | 39 | if (!(vlan_dev_priv(vlan_dev)->flags & VLAN_FLAG_REORDER_HDR)) { |
Jiri Pirko | 0b5c9db | 2011-06-10 06:56:58 +0000 | [diff] [blame] | 40 | unsigned int offset = skb->data - skb_mac_header(skb); |
| 41 | |
| 42 | /* |
| 43 | * vlan_insert_tag expect skb->data pointing to mac header. |
| 44 | * So change skb->data before calling it and change back to |
| 45 | * original position later |
| 46 | */ |
| 47 | skb_push(skb, offset); |
| 48 | skb = *skbp = vlan_insert_tag(skb, skb->vlan_tci); |
| 49 | if (!skb) |
| 50 | return false; |
| 51 | skb_pull(skb, offset + VLAN_HLEN); |
| 52 | skb_reset_mac_len(skb); |
| 53 | } |
| 54 | |
Jesse Gross | 3701e51 | 2010-10-20 13:56:06 +0000 | [diff] [blame] | 55 | skb->priority = vlan_get_ingress_priority(vlan_dev, skb->vlan_tci); |
Patrick McHardy | bc1d041 | 2008-07-14 22:49:30 -0700 | [diff] [blame] | 56 | skb->vlan_tci = 0; |
Patrick McHardy | 7750f40 | 2008-07-08 03:23:36 -0700 | [diff] [blame] | 57 | |
Jiri Pirko | 7da82c0 | 2011-12-08 04:11:15 +0000 | [diff] [blame] | 58 | rx_stats = this_cpu_ptr(vlan_dev_priv(vlan_dev)->vlan_pcpu_stats); |
Eric Dumazet | 9793241 | 2009-11-17 04:53:09 +0000 | [diff] [blame] | 59 | |
Eric Dumazet | 9618e2f | 2010-06-24 00:55:06 +0000 | [diff] [blame] | 60 | u64_stats_update_begin(&rx_stats->syncp); |
Eric Dumazet | 9793241 | 2009-11-17 04:53:09 +0000 | [diff] [blame] | 61 | rx_stats->rx_packets++; |
| 62 | rx_stats->rx_bytes += skb->len; |
Jiri Pirko | 0b5c9db | 2011-06-10 06:56:58 +0000 | [diff] [blame] | 63 | if (skb->pkt_type == PACKET_MULTICAST) |
Eric Dumazet | 9618e2f | 2010-06-24 00:55:06 +0000 | [diff] [blame] | 64 | rx_stats->rx_multicast++; |
Eric Dumazet | 9618e2f | 2010-06-24 00:55:06 +0000 | [diff] [blame] | 65 | u64_stats_update_end(&rx_stats->syncp); |
Jesse Gross | 3701e51 | 2010-10-20 13:56:06 +0000 | [diff] [blame] | 66 | |
| 67 | return true; |
Patrick McHardy | 7750f40 | 2008-07-08 03:23:36 -0700 | [diff] [blame] | 68 | } |
Patrick McHardy | 22d1ba7 | 2008-07-08 03:23:57 -0700 | [diff] [blame] | 69 | |
Jiri Pirko | cec9c13 | 2011-07-20 04:54:05 +0000 | [diff] [blame] | 70 | /* Must be invoked with rcu_read_lock or with RTNL. */ |
| 71 | struct net_device *__vlan_find_dev_deep(struct net_device *real_dev, |
| 72 | u16 vlan_id) |
| 73 | { |
| 74 | struct vlan_group *grp = rcu_dereference_rtnl(real_dev->vlgrp); |
| 75 | |
| 76 | if (grp) { |
| 77 | return vlan_group_get_device(grp, vlan_id); |
| 78 | } else { |
| 79 | /* |
| 80 | * Bonding slaves do not have grp assigned to themselves. |
| 81 | * Grp is assigned to bonding master instead. |
| 82 | */ |
| 83 | if (netif_is_bond_slave(real_dev)) |
| 84 | return __vlan_find_dev_deep(real_dev->master, vlan_id); |
| 85 | } |
| 86 | |
| 87 | return NULL; |
| 88 | } |
| 89 | EXPORT_SYMBOL(__vlan_find_dev_deep); |
| 90 | |
Patrick McHardy | 22d1ba7 | 2008-07-08 03:23:57 -0700 | [diff] [blame] | 91 | struct net_device *vlan_dev_real_dev(const struct net_device *dev) |
| 92 | { |
Jiri Pirko | 7da82c0 | 2011-12-08 04:11:15 +0000 | [diff] [blame] | 93 | return vlan_dev_priv(dev)->real_dev; |
Patrick McHardy | 22d1ba7 | 2008-07-08 03:23:57 -0700 | [diff] [blame] | 94 | } |
Ben Greear | 116cb42 | 2009-01-26 12:37:53 -0800 | [diff] [blame] | 95 | EXPORT_SYMBOL(vlan_dev_real_dev); |
Patrick McHardy | 22d1ba7 | 2008-07-08 03:23:57 -0700 | [diff] [blame] | 96 | |
| 97 | u16 vlan_dev_vlan_id(const struct net_device *dev) |
| 98 | { |
Jiri Pirko | 7da82c0 | 2011-12-08 04:11:15 +0000 | [diff] [blame] | 99 | return vlan_dev_priv(dev)->vlan_id; |
Patrick McHardy | 22d1ba7 | 2008-07-08 03:23:57 -0700 | [diff] [blame] | 100 | } |
Ben Greear | 116cb42 | 2009-01-26 12:37:53 -0800 | [diff] [blame] | 101 | EXPORT_SYMBOL(vlan_dev_vlan_id); |
Herbert Xu | e1c096e | 2009-01-06 10:50:09 -0800 | [diff] [blame] | 102 | |
Jiri Pirko | 0b5c9db | 2011-06-10 06:56:58 +0000 | [diff] [blame] | 103 | static struct sk_buff *vlan_reorder_header(struct sk_buff *skb) |
Jiri Pirko | bcc6d47 | 2011-04-07 19:48:33 +0000 | [diff] [blame] | 104 | { |
Jiri Pirko | 0b5c9db | 2011-06-10 06:56:58 +0000 | [diff] [blame] | 105 | if (skb_cow(skb, skb_headroom(skb)) < 0) |
| 106 | return NULL; |
| 107 | memmove(skb->data - ETH_HLEN, skb->data - VLAN_ETH_HLEN, 2 * ETH_ALEN); |
| 108 | skb->mac_header += VLAN_HLEN; |
| 109 | skb_reset_mac_len(skb); |
Jiri Pirko | bcc6d47 | 2011-04-07 19:48:33 +0000 | [diff] [blame] | 110 | return skb; |
| 111 | } |
| 112 | |
Jiri Pirko | bcc6d47 | 2011-04-07 19:48:33 +0000 | [diff] [blame] | 113 | struct sk_buff *vlan_untag(struct sk_buff *skb) |
| 114 | { |
| 115 | struct vlan_hdr *vhdr; |
| 116 | u16 vlan_tci; |
| 117 | |
| 118 | if (unlikely(vlan_tx_tag_present(skb))) { |
| 119 | /* vlan_tci is already set-up so leave this for another time */ |
| 120 | return skb; |
| 121 | } |
| 122 | |
| 123 | skb = skb_share_check(skb, GFP_ATOMIC); |
| 124 | if (unlikely(!skb)) |
| 125 | goto err_free; |
| 126 | |
| 127 | if (unlikely(!pskb_may_pull(skb, VLAN_HLEN))) |
| 128 | goto err_free; |
| 129 | |
| 130 | vhdr = (struct vlan_hdr *) skb->data; |
| 131 | vlan_tci = ntohs(vhdr->h_vlan_TCI); |
| 132 | __vlan_hwaccel_put_tag(skb, vlan_tci); |
| 133 | |
| 134 | skb_pull_rcsum(skb, VLAN_HLEN); |
| 135 | vlan_set_encap_proto(skb, vhdr); |
| 136 | |
Jiri Pirko | 0b5c9db | 2011-06-10 06:56:58 +0000 | [diff] [blame] | 137 | skb = vlan_reorder_header(skb); |
Jiri Pirko | bcc6d47 | 2011-04-07 19:48:33 +0000 | [diff] [blame] | 138 | if (unlikely(!skb)) |
| 139 | goto err_free; |
| 140 | |
Jiri Pirko | c5114cd | 2011-08-18 21:29:27 -0700 | [diff] [blame] | 141 | skb_reset_network_header(skb); |
| 142 | skb_reset_transport_header(skb); |
Jiri Pirko | bcc6d47 | 2011-04-07 19:48:33 +0000 | [diff] [blame] | 143 | return skb; |
| 144 | |
| 145 | err_free: |
| 146 | kfree_skb(skb); |
| 147 | return NULL; |
| 148 | } |
Jiri Pirko | 87002b0 | 2011-12-08 04:11:17 +0000 | [diff] [blame^] | 149 | |
| 150 | int vlan_vid_add(struct net_device *dev, unsigned short vid) |
| 151 | { |
| 152 | const struct net_device_ops *ops = dev->netdev_ops; |
| 153 | |
| 154 | if ((dev->features & NETIF_F_HW_VLAN_FILTER) && |
| 155 | ops->ndo_vlan_rx_add_vid) { |
| 156 | return ops->ndo_vlan_rx_add_vid(dev, vid); |
| 157 | } |
| 158 | return 0; |
| 159 | } |
| 160 | EXPORT_SYMBOL(vlan_vid_add); |
| 161 | |
| 162 | void vlan_vid_del(struct net_device *dev, unsigned short vid) |
| 163 | { |
| 164 | const struct net_device_ops *ops = dev->netdev_ops; |
| 165 | |
| 166 | if ((dev->features & NETIF_F_HW_VLAN_FILTER) && |
| 167 | ops->ndo_vlan_rx_kill_vid) { |
| 168 | ops->ndo_vlan_rx_kill_vid(dev, vid); |
| 169 | } |
| 170 | } |
| 171 | EXPORT_SYMBOL(vlan_vid_del); |