release/src-rt-6.x.4708/linux/linux-2.6.36/net/bridge/br_device.c

   1 /* Modified by Broadcom Corp. Portions Copyright (c) Broadcom Corp, 2012. */
   2 /*
   3  *      Device handling code
   4  *      Linux ethernet bridge
   5  *
   6  *      Authors:
   7  *      Lennert Buytenhek               <buytenh@gnu.org>
   8  *
   9  *      This program is free software; you can redistribute it and/or
  10  *      modify it under the terms of the GNU General Public License
  11  *      as published by the Free Software Foundation; either version
  12  *      2 of the License, or (at your option) any later version.
  13  */
  14
  15 #include <linux/kernel.h>
  16 #include <linux/netdevice.h>
  17 #include <linux/netpoll.h>
  18 #include <linux/etherdevice.h>
  19 #include <linux/ethtool.h>
  20 #include <linux/list.h>
  21 #include <linux/netfilter_bridge.h>
  22
  23 #include <asm/uaccess.h>
  24 #include "br_private.h"
  25
  26 #include <typedefs.h>
  27 #include <bcmdefs.h>
  28
  29 /* net device transmit always called with BH disabled */
  30 netdev_tx_t BCMFASTPATH_HOST br_dev_xmit(struct sk_buff *skb, struct net_device *dev)
  31 {
  32         struct net_bridge *br = netdev_priv(dev);
  33         const unsigned char *dest = skb->data;
  34         struct net_bridge_fdb_entry *dst;
  35         struct net_bridge_mdb_entry *mdst;
  36         struct br_cpu_netstats *brstats = this_cpu_ptr(br->stats);
  37
  38 #ifdef CONFIG_BRIDGE_NETFILTER
  39         if (skb->nf_bridge && (skb->nf_bridge->mask & BRNF_BRIDGED_DNAT)) {
  40                 br_nf_pre_routing_finish_bridge_slow(skb);
  41                 return NETDEV_TX_OK;
  42         }
  43 #endif
  44
  45         u64_stats_update_begin(&brstats->syncp);
  46         brstats->tx_packets++;
  47         brstats->tx_bytes += skb->len;
  48         u64_stats_update_end(&brstats->syncp);
  49
  50         BR_INPUT_SKB_CB(skb)->brdev = dev;
  51
  52         skb_reset_mac_header(skb);
  53         skb_pull(skb, ETH_HLEN);
  54
  55         rcu_read_lock();
  56         if (is_multicast_ether_addr(dest)) {
  57                 if (unlikely(netpoll_tx_running(dev))) {
  58                         br_flood_deliver(br, skb);
  59                         goto out;
  60                 }
  61                 if (br_multicast_rcv(br, NULL, skb)) {
  62                         kfree_skb(skb);
  63                         goto out;
  64                 }
  65
  66                 mdst = br_mdb_get(br, skb);
  67                 if (mdst || BR_INPUT_SKB_CB_MROUTERS_ONLY(skb))
  68                         br_multicast_deliver(mdst, skb);
  69                 else
  70                         br_flood_deliver(br, skb);
  71         } else if ((dst = __br_fdb_get(br, dest)) != NULL)
  72                 br_deliver(dst->dst, skb);
  73         else
  74                 br_flood_deliver(br, skb);
  75
  76 out:
  77         rcu_read_unlock();
  78         return NETDEV_TX_OK;
  79 }
  80
  81 static int br_dev_open(struct net_device *dev)
  82 {
  83         struct net_bridge *br = netdev_priv(dev);
  84
  85         br_features_recompute(br);
  86         netif_start_queue(dev);
  87         br_stp_enable_bridge(br);
  88         br_multicast_open(br);
  89
  90         return 0;
  91 }
  92
  93 static void br_dev_set_multicast_list(struct net_device *dev)
  94 {
  95 }
  96
  97 static int br_dev_stop(struct net_device *dev)
  98 {
  99         struct net_bridge *br = netdev_priv(dev);
 100
 101         br_stp_disable_bridge(br);
 102         br_multicast_stop(br);
 103
 104         netif_stop_queue(dev);
 105
 106         return 0;
 107 }
 108
 109 static struct rtnl_link_stats64 *br_get_stats64(struct net_device *dev,
 110                                                 struct rtnl_link_stats64 *stats)
 111 {
 112         struct net_bridge *br = netdev_priv(dev);
 113         struct br_cpu_netstats tmp, sum = { 0 };
 114         unsigned int cpu;
 115
 116         for_each_possible_cpu(cpu) {
 117                 unsigned int start;
 118                 const struct br_cpu_netstats *bstats
 119                         = per_cpu_ptr(br->stats, cpu);
 120                 do {
 121                         start = u64_stats_fetch_begin(&bstats->syncp);
 122                         memcpy(&tmp, bstats, sizeof(tmp));
 123                 } while (u64_stats_fetch_retry(&bstats->syncp, start));
 124                 sum.tx_bytes   += tmp.tx_bytes;
 125                 sum.tx_packets += tmp.tx_packets;
 126                 sum.rx_bytes   += tmp.rx_bytes;
 127                 sum.rx_packets += tmp.rx_packets;
 128         }
 129
 130         stats->tx_bytes   = sum.tx_bytes;
 131         stats->tx_packets = sum.tx_packets;
 132         stats->rx_bytes   = sum.rx_bytes;
 133         stats->rx_packets = sum.rx_packets;
 134
 135         return stats;
 136 }
 137
 138 static int br_change_mtu(struct net_device *dev, int new_mtu)
 139 {
 140         struct net_bridge *br = netdev_priv(dev);
 141         if (new_mtu < 68 || new_mtu > br_min_mtu(br))
 142                 return -EINVAL;
 143
 144         dev->mtu = new_mtu;
 145
 146 #ifdef CONFIG_BRIDGE_NETFILTER
 147         /* remember the MTU in the rtable for PMTU */
 148         br->fake_rtable.dst.metrics[RTAX_MTU - 1] = new_mtu;
 149 #endif
 150
 151         return 0;
 152 }
 153
 154 /* Allow setting mac address to any valid ethernet address. */
 155 static int br_set_mac_address(struct net_device *dev, void *p)
 156 {
 157         struct net_bridge *br = netdev_priv(dev);
 158         struct sockaddr *addr = p;
 159
 160         if (!is_valid_ether_addr(addr->sa_data))
 161                 return -EINVAL;
 162
 163         spin_lock_bh(&br->lock);
 164         memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN);
 165         br_stp_change_bridge_id(br, addr->sa_data);
 166         br->flags |= BR_SET_MAC_ADDR;
 167         spin_unlock_bh(&br->lock);
 168
 169         return 0;
 170 }
 171
 172 static void br_getinfo(struct net_device *dev, struct ethtool_drvinfo *info)
 173 {
 174         strcpy(info->driver, "bridge");
 175         strcpy(info->version, BR_VERSION);
 176         strcpy(info->fw_version, "N/A");
 177         strcpy(info->bus_info, "N/A");
 178 }
 179
 180 static int br_set_sg(struct net_device *dev, u32 data)
 181 {
 182         struct net_bridge *br = netdev_priv(dev);
 183
 184         if (data)
 185                 br->feature_mask |= NETIF_F_SG;
 186         else
 187                 br->feature_mask &= ~NETIF_F_SG;
 188
 189         br_features_recompute(br);
 190         return 0;
 191 }
 192
 193 static int br_set_tso(struct net_device *dev, u32 data)
 194 {
 195         struct net_bridge *br = netdev_priv(dev);
 196
 197         if (data)
 198                 br->feature_mask |= NETIF_F_TSO;
 199         else
 200                 br->feature_mask &= ~NETIF_F_TSO;
 201
 202         br_features_recompute(br);
 203         return 0;
 204 }
 205
 206 static int br_set_tx_csum(struct net_device *dev, u32 data)
 207 {
 208         struct net_bridge *br = netdev_priv(dev);
 209
 210         if (data)
 211                 br->feature_mask |= NETIF_F_NO_CSUM;
 212         else
 213                 br->feature_mask &= ~NETIF_F_ALL_CSUM;
 214
 215         br_features_recompute(br);
 216         return 0;
 217 }
 218
 219 #ifdef CONFIG_NET_POLL_CONTROLLER
 220 static void br_poll_controller(struct net_device *br_dev)
 221 {
 222 }
 223
 224 static void br_netpoll_cleanup(struct net_device *dev)
 225 {
 226         struct net_bridge *br = netdev_priv(dev);
 227         struct net_bridge_port *p, *n;
 228
 229         list_for_each_entry_safe(p, n, &br->port_list, list) {
 230                 br_netpoll_disable(p);
 231         }
 232 }
 233
 234 static int br_netpoll_setup(struct net_device *dev, struct netpoll_info *ni)
 235 {
 236         struct net_bridge *br = netdev_priv(dev);
 237         struct net_bridge_port *p, *n;
 238         int err = 0;
 239
 240         list_for_each_entry_safe(p, n, &br->port_list, list) {
 241                 if (!p->dev)
 242                         continue;
 243
 244                 err = br_netpoll_enable(p);
 245                 if (err)
 246                         goto fail;
 247         }
 248
 249 out:
 250         return err;
 251
 252 fail:
 253         br_netpoll_cleanup(dev);
 254         goto out;
 255 }
 256
 257 int br_netpoll_enable(struct net_bridge_port *p)
 258 {
 259         struct netpoll *np;
 260         int err = 0;
 261
 262         np = kzalloc(sizeof(*p->np), GFP_KERNEL);
 263         err = -ENOMEM;
 264         if (!np)
 265                 goto out;
 266
 267         np->dev = p->dev;
 268
 269         err = __netpoll_setup(np);
 270         if (err) {
 271                 kfree(np);
 272                 goto out;
 273         }
 274
 275         p->np = np;
 276
 277 out:
 278         return err;
 279 }
 280
 281 void br_netpoll_disable(struct net_bridge_port *p)
 282 {
 283         struct netpoll *np = p->np;
 284
 285         if (!np)
 286                 return;
 287
 288         p->np = NULL;
 289
 290         /* Wait for transmitting packets to finish before freeing. */
 291         synchronize_rcu_bh();
 292
 293         __netpoll_cleanup(np);
 294         kfree(np);
 295 }
 296
 297 #endif
 298
 299 static const struct ethtool_ops br_ethtool_ops = {
 300         .get_drvinfo    = br_getinfo,
 301         .get_link       = ethtool_op_get_link,
 302         .get_tx_csum    = ethtool_op_get_tx_csum,
 303         .set_tx_csum    = br_set_tx_csum,
 304         .get_sg         = ethtool_op_get_sg,
 305         .set_sg         = br_set_sg,
 306         .get_tso        = ethtool_op_get_tso,
 307         .set_tso        = br_set_tso,
 308         .get_ufo        = ethtool_op_get_ufo,
 309         .set_ufo        = ethtool_op_set_ufo,
 310         .get_flags      = ethtool_op_get_flags,
 311 };
 312
 313 static const struct net_device_ops br_netdev_ops = {
 314         .ndo_open                = br_dev_open,
 315         .ndo_stop                = br_dev_stop,
 316         .ndo_start_xmit          = br_dev_xmit,
 317         .ndo_get_stats64         = br_get_stats64,
 318         .ndo_set_mac_address     = br_set_mac_address,
 319         .ndo_set_multicast_list  = br_dev_set_multicast_list,
 320         .ndo_change_mtu          = br_change_mtu,
 321         .ndo_do_ioctl            = br_dev_ioctl,
 322 #ifdef CONFIG_NET_POLL_CONTROLLER
 323         .ndo_netpoll_setup       = br_netpoll_setup,
 324         .ndo_netpoll_cleanup     = br_netpoll_cleanup,
 325         .ndo_poll_controller     = br_poll_controller,
 326 #endif
 327 };
 328
 329 static void br_dev_free(struct net_device *dev)
 330 {
 331         struct net_bridge *br = netdev_priv(dev);
 332
 333         free_percpu(br->stats);
 334         free_netdev(dev);
 335 }
 336
 337 void br_dev_setup(struct net_device *dev)
 338 {
 339         random_ether_addr(dev->dev_addr);
 340         ether_setup(dev);
 341
 342         dev->netdev_ops = &br_netdev_ops;
 343         dev->destructor = br_dev_free;
 344         SET_ETHTOOL_OPS(dev, &br_ethtool_ops);
 345         dev->tx_queue_len = 0;
 346         dev->priv_flags = IFF_EBRIDGE;
 347
 348         dev->features = NETIF_F_SG | NETIF_F_FRAGLIST | NETIF_F_HIGHDMA |
 349                         NETIF_F_GSO_MASK | NETIF_F_NO_CSUM | NETIF_F_LLTX |
 350                         NETIF_F_NETNS_LOCAL | NETIF_F_GSO;
 351 }