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