projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
cpufreq: cpufreq-dt: avoid uninitialized variable warnings:
[linux-2.6-block.git] / net / dsa / slave.c
CommitLineData
91da11f8
LB		 1/*
2 * net/dsa/slave.c - Slave device handling
e84665c9 3 * Copyright (c) 2008-2009 Marvell Semiconductor
91da11f8
LB		 4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 */
10
11#include <linux/list.h>
df02c6ff 12#include <linux/etherdevice.h>
b73adef6 13#include <linux/netdevice.h>
91da11f8 14#include <linux/phy.h>
a2820543 15#include <linux/phy_fixed.h>
0d8bcdd3
FF		 16#include <linux/of_net.h>
17#include <linux/of_mdio.h>
b73adef6 18#include <net/rtnetlink.h>
98237d43 19#include <net/switchdev.h>
b73adef6 20#include <linux/if_bridge.h>
04ff53f9 21#include <linux/netpoll.h>
91da11f8
LB		 22#include "dsa_priv.h"
23
24/* slave mii_bus handling ***************************************************/
25static int dsa_slave_phy_read(struct mii_bus *bus, int addr, int reg)
26{
27 struct dsa_switch *ds = bus->priv;
28
0d8bcdd3 29 if (ds->phys_mii_mask & (1 << addr))
91da11f8
LB		 30 return ds->drv->phy_read(ds, addr, reg);
31
32 return 0xffff;
33}
34
35static int dsa_slave_phy_write(struct mii_bus *bus, int addr, int reg, u16 val)
36{
37 struct dsa_switch *ds = bus->priv;
38
0d8bcdd3 39 if (ds->phys_mii_mask & (1 << addr))
91da11f8
LB		 40 return ds->drv->phy_write(ds, addr, reg, val);
41
42 return 0;
43}
44
45void dsa_slave_mii_bus_init(struct dsa_switch *ds)
46{
47 ds->slave_mii_bus->priv = (void *)ds;
48 ds->slave_mii_bus->name = "dsa slave smi";
49 ds->slave_mii_bus->read = dsa_slave_phy_read;
50 ds->slave_mii_bus->write = dsa_slave_phy_write;
f490be04
FF		 51 snprintf(ds->slave_mii_bus->id, MII_BUS_ID_SIZE, "dsa-%d:%.2x",
52 ds->index, ds->pd->sw_addr);
b4d2394d 53 ds->slave_mii_bus->parent = ds->master_dev;
24df8986 54 ds->slave_mii_bus->phy_mask = ~ds->phys_mii_mask;
91da11f8
LB		 55}
56
57
58/* slave device handling ****************************************************/
abd2be00 59static int dsa_slave_get_iflink(const struct net_device *dev)
c0840801
LB		 60{
61 struct dsa_slave_priv *p = netdev_priv(dev);
c0840801 62
abd2be00 63 return p->parent->dst->master_netdev->ifindex;
c0840801
LB		 64}
65
b73adef6
FF		 66static inline bool dsa_port_is_bridged(struct dsa_slave_priv *p)
67{
68 return !!p->bridge_dev;
69}
70
91da11f8
LB		 71static int dsa_slave_open(struct net_device *dev)
72{
df02c6ff 73 struct dsa_slave_priv *p = netdev_priv(dev);
e84665c9 74 struct net_device *master = p->parent->dst->master_netdev;
b2f2af21 75 struct dsa_switch *ds = p->parent;
b73adef6
FF		 76 u8 stp_state = dsa_port_is_bridged(p) ?
77 BR_STATE_BLOCKING : BR_STATE_FORWARDING;
df02c6ff
LB		 78 int err;
79
80 if (!(master->flags & IFF_UP))
81 return -ENETDOWN;
82
8feedbb4 83 if (!ether_addr_equal(dev->dev_addr, master->dev_addr)) {
a748ee24 84 err = dev_uc_add(master, dev->dev_addr);
df02c6ff
LB		 85 if (err < 0)
86 goto out;
87 }
88
89 if (dev->flags & IFF_ALLMULTI) {
90 err = dev_set_allmulti(master, 1);
91 if (err < 0)
92 goto del_unicast;
93 }
94 if (dev->flags & IFF_PROMISC) {
95 err = dev_set_promiscuity(master, 1);
96 if (err < 0)
97 goto clear_allmulti;
98 }
99
b2f2af21
FF		 100 if (ds->drv->port_enable) {
101 err = ds->drv->port_enable(ds, p->port, p->phy);
102 if (err)
103 goto clear_promisc;
104 }
105
b73adef6
FF		 106 if (ds->drv->port_stp_update)
107 ds->drv->port_stp_update(ds, p->port, stp_state);
108
f7f1de51
FF		 109 if (p->phy)
110 phy_start(p->phy);
111
91da11f8 112 return 0;
df02c6ff 113
b2f2af21
FF		 114clear_promisc:
115 if (dev->flags & IFF_PROMISC)
4fdeddfe 116 dev_set_promiscuity(master, -1);
df02c6ff
LB		 117clear_allmulti:
118 if (dev->flags & IFF_ALLMULTI)
119 dev_set_allmulti(master, -1);
120del_unicast:
8feedbb4 121 if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
a748ee24 122 dev_uc_del(master, dev->dev_addr);
df02c6ff
LB		 123out:
124 return err;
91da11f8
LB		 125}
126
127static int dsa_slave_close(struct net_device *dev)
128{
df02c6ff 129 struct dsa_slave_priv *p = netdev_priv(dev);
e84665c9 130 struct net_device *master = p->parent->dst->master_netdev;
b2f2af21 131 struct dsa_switch *ds = p->parent;
df02c6ff 132
f7f1de51
FF		 133 if (p->phy)
134 phy_stop(p->phy);
135
df02c6ff 136 dev_mc_unsync(master, dev);
a748ee24 137 dev_uc_unsync(master, dev);
df02c6ff
LB		 138 if (dev->flags & IFF_ALLMULTI)
139 dev_set_allmulti(master, -1);
140 if (dev->flags & IFF_PROMISC)
141 dev_set_promiscuity(master, -1);
142
8feedbb4 143 if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
a748ee24 144 dev_uc_del(master, dev->dev_addr);
df02c6ff 145
b2f2af21
FF		 146 if (ds->drv->port_disable)
147 ds->drv->port_disable(ds, p->port, p->phy);
148
b73adef6
FF		 149 if (ds->drv->port_stp_update)
150 ds->drv->port_stp_update(ds, p->port, BR_STATE_DISABLED);
151
91da11f8
LB		 152 return 0;
153}
154
155static void dsa_slave_change_rx_flags(struct net_device *dev, int change)
156{
157 struct dsa_slave_priv *p = netdev_priv(dev);
e84665c9 158 struct net_device *master = p->parent->dst->master_netdev;
91da11f8
LB		 159
160 if (change & IFF_ALLMULTI)
161 dev_set_allmulti(master, dev->flags & IFF_ALLMULTI ? 1 : -1);
162 if (change & IFF_PROMISC)
163 dev_set_promiscuity(master, dev->flags & IFF_PROMISC ? 1 : -1);
164}
165
166static void dsa_slave_set_rx_mode(struct net_device *dev)
167{
168 struct dsa_slave_priv *p = netdev_priv(dev);
e84665c9 169 struct net_device *master = p->parent->dst->master_netdev;
91da11f8
LB		 170
171 dev_mc_sync(master, dev);
a748ee24 172 dev_uc_sync(master, dev);
91da11f8
LB		 173}
174
df02c6ff 175static int dsa_slave_set_mac_address(struct net_device *dev, void *a)
91da11f8 176{
df02c6ff 177 struct dsa_slave_priv *p = netdev_priv(dev);
e84665c9 178 struct net_device *master = p->parent->dst->master_netdev;
df02c6ff
LB		 179 struct sockaddr *addr = a;
180 int err;
181
182 if (!is_valid_ether_addr(addr->sa_data))
183 return -EADDRNOTAVAIL;
184
185 if (!(dev->flags & IFF_UP))
186 goto out;
187
8feedbb4 188 if (!ether_addr_equal(addr->sa_data, master->dev_addr)) {
a748ee24 189 err = dev_uc_add(master, addr->sa_data);
df02c6ff
LB		 190 if (err < 0)
191 return err;
192 }
193
8feedbb4 194 if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
a748ee24 195 dev_uc_del(master, dev->dev_addr);
df02c6ff
LB		 196
197out:
d08f161a 198 ether_addr_copy(dev->dev_addr, addr->sa_data);
91da11f8
LB		 199
200 return 0;
201}
202
11149536
VD		 203static int dsa_bridge_check_vlan_range(struct dsa_switch *ds,
204 const struct net_device *bridge,
205 u16 vid_begin, u16 vid_end)
206{
207 struct dsa_slave_priv *p;
208 struct net_device *dev, *vlan_br;
209 DECLARE_BITMAP(members, DSA_MAX_PORTS);
210 DECLARE_BITMAP(untagged, DSA_MAX_PORTS);
211 u16 vid;
212 int member, err;
213
214 if (!ds->drv->vlan_getnext || !vid_begin)
215 return -EOPNOTSUPP;
216
217 vid = vid_begin - 1;
218
219 do {
220 err = ds->drv->vlan_getnext(ds, &vid, members, untagged);
221 if (err)
222 break;
223
224 if (vid > vid_end)
225 break;
226
227 member = find_first_bit(members, DSA_MAX_PORTS);
228 if (member == DSA_MAX_PORTS)
229 continue;
230
231 dev = ds->ports[member];
232 p = netdev_priv(dev);
233 vlan_br = p->bridge_dev;
234 if (vlan_br == bridge)
235 continue;
236
237 netdev_dbg(vlan_br, "hardware VLAN %d already in use\n", vid);
238 return -EOPNOTSUPP;
239 } while (vid < vid_end);
240
241 return err == -ENOENT ? 0 : err;
242}
243
244static int dsa_slave_port_vlan_add(struct net_device *dev,
8f24f309 245 const struct switchdev_obj_port_vlan *vlan,
f8db8348 246 struct switchdev_trans *trans)
11149536 247{
11149536
VD		 248 struct dsa_slave_priv *p = netdev_priv(dev);
249 struct dsa_switch *ds = p->parent;
11149536
VD		 250 int err;
251
79a62eb2 252 if (switchdev_trans_ph_prepare(trans)) {
76e398a6 253 if (!ds->drv->port_vlan_prepare || !ds->drv->port_vlan_add)
11149536
VD		 254 return -EOPNOTSUPP;
255
256 /* If the requested port doesn't belong to the same bridge as
257 * the VLAN members, fallback to software VLAN (hopefully).
258 */
259 err = dsa_bridge_check_vlan_range(ds, p->bridge_dev,
260 vlan->vid_begin,
261 vlan->vid_end);
262 if (err)
263 return err;
76e398a6
VD		 264
265 err = ds->drv->port_vlan_prepare(ds, p->port, vlan, trans);
266 if (err)
267 return err;
79a62eb2 268 } else {
76e398a6
VD		 269 err = ds->drv->port_vlan_add(ds, p->port, vlan, trans);
270 if (err)
271 return err;
11149536
VD		 272 }
273
274 return 0;
275}
276
277static int dsa_slave_port_vlan_del(struct net_device *dev,
8f24f309 278 const struct switchdev_obj_port_vlan *vlan)
11149536 279{
11149536
VD		 280 struct dsa_slave_priv *p = netdev_priv(dev);
281 struct dsa_switch *ds = p->parent;
11149536
VD		 282
283 if (!ds->drv->port_vlan_del)
284 return -EOPNOTSUPP;
285
76e398a6 286 return ds->drv->port_vlan_del(ds, p->port, vlan);
11149536
VD		 287}
288
289static int dsa_slave_port_vlan_dump(struct net_device *dev,
8f24f309 290 struct switchdev_obj_port_vlan *vlan,
648b4a99 291 switchdev_obj_dump_cb_t *cb)
11149536 292{
11149536
VD		 293 struct dsa_slave_priv *p = netdev_priv(dev);
294 struct dsa_switch *ds = p->parent;
295 DECLARE_BITMAP(members, DSA_MAX_PORTS);
296 DECLARE_BITMAP(untagged, DSA_MAX_PORTS);
297 u16 pvid, vid = 0;
298 int err;
299
300 if (!ds->drv->vlan_getnext || !ds->drv->port_pvid_get)
301 return -EOPNOTSUPP;
302
303 err = ds->drv->port_pvid_get(ds, p->port, &pvid);
304 if (err)
305 return err;
306
307 for (;;) {
308 err = ds->drv->vlan_getnext(ds, &vid, members, untagged);
309 if (err)
310 break;
311
312 if (!test_bit(p->port, members))
313 continue;
314
315 memset(vlan, 0, sizeof(*vlan));
316 vlan->vid_begin = vlan->vid_end = vid;
317
318 if (vid == pvid)
319 vlan->flags |= BRIDGE_VLAN_INFO_PVID;
320
321 if (test_bit(p->port, untagged))
322 vlan->flags |= BRIDGE_VLAN_INFO_UNTAGGED;
323
648b4a99 324 err = cb(&vlan->obj);
11149536
VD		 325 if (err)
326 break;
327 }
328
329 return err == -ENOENT ? 0 : err;
330}
331
ba14d9eb 332static int dsa_slave_port_fdb_add(struct net_device *dev,
52ba57cf 333 const struct switchdev_obj_port_fdb *fdb,
f8db8348 334 struct switchdev_trans *trans)
cdf09697
DM		 335{
336 struct dsa_slave_priv *p = netdev_priv(dev);
337 struct dsa_switch *ds = p->parent;
146a3206
VD		 338 int ret;
339
340 if (!ds->drv->port_fdb_prepare || !ds->drv->port_fdb_add)
341 return -EOPNOTSUPP;
cdf09697 342
79a62eb2 343 if (switchdev_trans_ph_prepare(trans))
146a3206 344 ret = ds->drv->port_fdb_prepare(ds, p->port, fdb, trans);
79a62eb2 345 else
1f36faf2 346 ret = ds->drv->port_fdb_add(ds, p->port, fdb, trans);
cdf09697
DM		 347
348 return ret;
349}
350
ba14d9eb 351static int dsa_slave_port_fdb_del(struct net_device *dev,
52ba57cf 352 const struct switchdev_obj_port_fdb *fdb)
cdf09697
DM		 353{
354 struct dsa_slave_priv *p = netdev_priv(dev);
355 struct dsa_switch *ds = p->parent;
356 int ret = -EOPNOTSUPP;
357
2a778e1b 358 if (ds->drv->port_fdb_del)
8057b3e7 359 ret = ds->drv->port_fdb_del(ds, p->port, fdb);
cdf09697
DM		 360
361 return ret;
362}
363
ba14d9eb 364static int dsa_slave_port_fdb_dump(struct net_device *dev,
52ba57cf 365 struct switchdev_obj_port_fdb *fdb,
648b4a99 366 switchdev_obj_dump_cb_t *cb)
cdf09697
DM		 367{
368 struct dsa_slave_priv *p = netdev_priv(dev);
369 struct dsa_switch *ds = p->parent;
cdf09697 370
ea70ba98
VD		 371 if (ds->drv->port_fdb_dump)
372 return ds->drv->port_fdb_dump(ds, p->port, fdb, cb);
373
1a49a2fb 374 return -EOPNOTSUPP;
cdf09697
DM		 375}
376
91da11f8
LB		 377static int dsa_slave_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
378{
379 struct dsa_slave_priv *p = netdev_priv(dev);
91da11f8
LB		 380
381 if (p->phy != NULL)
28b04113 382 return phy_mii_ioctl(p->phy, ifr, cmd);
91da11f8
LB		 383
384 return -EOPNOTSUPP;
385}
386
b73adef6
FF		 387/* Return a bitmask of all ports being currently bridged within a given bridge
388 * device. Note that on leave, the mask will still return the bitmask of ports
389 * currently bridged, prior to port removal, and this is exactly what we want.
390 */
391static u32 dsa_slave_br_port_mask(struct dsa_switch *ds,
392 struct net_device *bridge)
393{
394 struct dsa_slave_priv *p;
395 unsigned int port;
396 u32 mask = 0;
397
398 for (port = 0; port < DSA_MAX_PORTS; port++) {
d79d2107 399 if (!dsa_is_port_initialized(ds, port))
b73adef6
FF		 400 continue;
401
402 p = netdev_priv(ds->ports[port]);
403
404 if (ds->ports[port]->priv_flags & IFF_BRIDGE_PORT &&
405 p->bridge_dev == bridge)
406 mask |= 1 << port;
407 }
408
409 return mask;
410}
411
412static int dsa_slave_stp_update(struct net_device *dev, u8 state)
413{
414 struct dsa_slave_priv *p = netdev_priv(dev);
415 struct dsa_switch *ds = p->parent;
416 int ret = -EOPNOTSUPP;
417
418 if (ds->drv->port_stp_update)
419 ret = ds->drv->port_stp_update(ds, p->port, state);
420
421 return ret;
422}
423
35636062 424static int dsa_slave_port_attr_set(struct net_device *dev,
f7fadf30 425 const struct switchdev_attr *attr,
7ea6eb3f 426 struct switchdev_trans *trans)
35636062 427{
b8d866ac
VD		 428 struct dsa_slave_priv *p = netdev_priv(dev);
429 struct dsa_switch *ds = p->parent;
430 int ret;
35636062
SF		 431
432 switch (attr->id) {
1f868398 433 case SWITCHDEV_ATTR_ID_PORT_STP_STATE:
b8d866ac
VD		 434 if (switchdev_trans_ph_prepare(trans))
435 ret = ds->drv->port_stp_update ? 0 : -EOPNOTSUPP;
436 else
437 ret = ds->drv->port_stp_update(ds, p->port,
438 attr->u.stp_state);
35636062
SF		 439 break;
440 default:
441 ret = -EOPNOTSUPP;
442 break;
443 }
444
445 return ret;
446}
447
ba14d9eb 448static int dsa_slave_port_obj_add(struct net_device *dev,
648b4a99 449 const struct switchdev_obj *obj,
7ea6eb3f 450 struct switchdev_trans *trans)
ba14d9eb
VD		 451{
452 int err;
453
454 /* For the prepare phase, ensure the full set of changes is feasable in
455 * one go in order to signal a failure properly. If an operation is not
456 * supported, return -EOPNOTSUPP.
457 */
458
9e8f4a54 459 switch (obj->id) {
57d80838 460 case SWITCHDEV_OBJ_ID_PORT_FDB:
648b4a99
JP		 461 err = dsa_slave_port_fdb_add(dev,
462 SWITCHDEV_OBJ_PORT_FDB(obj),
463 trans);
ba14d9eb 464 break;
57d80838 465 case SWITCHDEV_OBJ_ID_PORT_VLAN:
648b4a99
JP		 466 err = dsa_slave_port_vlan_add(dev,
467 SWITCHDEV_OBJ_PORT_VLAN(obj),
468 trans);
11149536 469 break;
ba14d9eb
VD		 470 default:
471 err = -EOPNOTSUPP;
472 break;
473 }
474
475 return err;
476}
477
478static int dsa_slave_port_obj_del(struct net_device *dev,
648b4a99 479 const struct switchdev_obj *obj)
ba14d9eb
VD		 480{
481 int err;
482
9e8f4a54 483 switch (obj->id) {
57d80838 484 case SWITCHDEV_OBJ_ID_PORT_FDB:
648b4a99
JP		 485 err = dsa_slave_port_fdb_del(dev,
486 SWITCHDEV_OBJ_PORT_FDB(obj));
ba14d9eb 487 break;
57d80838 488 case SWITCHDEV_OBJ_ID_PORT_VLAN:
648b4a99
JP		 489 err = dsa_slave_port_vlan_del(dev,
490 SWITCHDEV_OBJ_PORT_VLAN(obj));
11149536 491 break;
ba14d9eb
VD		 492 default:
493 err = -EOPNOTSUPP;
494 break;
495 }
496
497 return err;
498}
499
500static int dsa_slave_port_obj_dump(struct net_device *dev,
648b4a99
JP		 501 struct switchdev_obj *obj,
502 switchdev_obj_dump_cb_t *cb)
ba14d9eb
VD		 503{
504 int err;
505
9e8f4a54 506 switch (obj->id) {
57d80838 507 case SWITCHDEV_OBJ_ID_PORT_FDB:
648b4a99
JP		 508 err = dsa_slave_port_fdb_dump(dev,
509 SWITCHDEV_OBJ_PORT_FDB(obj),
510 cb);
ba14d9eb 511 break;
57d80838 512 case SWITCHDEV_OBJ_ID_PORT_VLAN:
648b4a99
JP		 513 err = dsa_slave_port_vlan_dump(dev,
514 SWITCHDEV_OBJ_PORT_VLAN(obj),
515 cb);
11149536 516 break;
ba14d9eb
VD		 517 default:
518 err = -EOPNOTSUPP;
519 break;
520 }
521
522 return err;
523}
524
b73adef6
FF		 525static int dsa_slave_bridge_port_join(struct net_device *dev,
526 struct net_device *br)
527{
528 struct dsa_slave_priv *p = netdev_priv(dev);
529 struct dsa_switch *ds = p->parent;
530 int ret = -EOPNOTSUPP;
531
532 p->bridge_dev = br;
533
534 if (ds->drv->port_join_bridge)
535 ret = ds->drv->port_join_bridge(ds, p->port,
536 dsa_slave_br_port_mask(ds, br));
537
538 return ret;
539}
540
541static int dsa_slave_bridge_port_leave(struct net_device *dev)
542{
543 struct dsa_slave_priv *p = netdev_priv(dev);
544 struct dsa_switch *ds = p->parent;
545 int ret = -EOPNOTSUPP;
546
547
548 if (ds->drv->port_leave_bridge)
549 ret = ds->drv->port_leave_bridge(ds, p->port,
550 dsa_slave_br_port_mask(ds, p->bridge_dev));
551
552 p->bridge_dev = NULL;
553
554 /* Port left the bridge, put in BR_STATE_DISABLED by the bridge layer,
555 * so allow it to be in BR_STATE_FORWARDING to be kept functional
556 */
557 dsa_slave_stp_update(dev, BR_STATE_FORWARDING);
558
559 return ret;
560}
561
f8e20a9f
SF		 562static int dsa_slave_port_attr_get(struct net_device *dev,
563 struct switchdev_attr *attr)
b73adef6
FF		 564{
565 struct dsa_slave_priv *p = netdev_priv(dev);
566 struct dsa_switch *ds = p->parent;
567
f8e20a9f 568 switch (attr->id) {
1f868398 569 case SWITCHDEV_ATTR_ID_PORT_PARENT_ID:
42275bd8
SF		 570 attr->u.ppid.id_len = sizeof(ds->index);
571 memcpy(&attr->u.ppid.id, &ds->index, attr->u.ppid.id_len);
f8e20a9f
SF		 572 break;
573 default:
574 return -EOPNOTSUPP;
575 }
b73adef6
FF		 576
577 return 0;
578}
579
04ff53f9
FF		 580static inline netdev_tx_t dsa_netpoll_send_skb(struct dsa_slave_priv *p,
581 struct sk_buff *skb)
582{
583#ifdef CONFIG_NET_POLL_CONTROLLER
584 if (p->netpoll)
585 netpoll_send_skb(p->netpoll, skb);
586#else
587 BUG();
588#endif
589 return NETDEV_TX_OK;
590}
591
3e8a72d1
FF		 592static netdev_tx_t dsa_slave_xmit(struct sk_buff *skb, struct net_device *dev)
593{
594 struct dsa_slave_priv *p = netdev_priv(dev);
4ed70ce9 595 struct sk_buff *nskb;
3e8a72d1 596
4ed70ce9
FF		 597 dev->stats.tx_packets++;
598 dev->stats.tx_bytes += skb->len;
3e8a72d1 599
4ed70ce9
FF		 600 /* Transmit function may have to reallocate the original SKB */
601 nskb = p->xmit(skb, dev);
602 if (!nskb)
603 return NETDEV_TX_OK;
5aed85ce 604
04ff53f9
FF		 605 /* SKB for netpoll still need to be mangled with the protocol-specific
606 * tag to be successfully transmitted
607 */
608 if (unlikely(netpoll_tx_running(dev)))
609 return dsa_netpoll_send_skb(p, nskb);
610
4ed70ce9
FF		 611 /* Queue the SKB for transmission on the parent interface, but
612 * do not modify its EtherType
613 */
614 nskb->dev = p->parent->dst->master_netdev;
615 dev_queue_xmit(nskb);
5aed85ce
FF		 616
617 return NETDEV_TX_OK;
618}
619
4ed70ce9
FF		 620static struct sk_buff *dsa_slave_notag_xmit(struct sk_buff *skb,
621 struct net_device *dev)
622{
623 /* Just return the original SKB */
624 return skb;
625}
626
91da11f8
LB		 627
628/* ethtool operations *******************************************************/
629static int
630dsa_slave_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
631{
632 struct dsa_slave_priv *p = netdev_priv(dev);
633 int err;
634
635 err = -EOPNOTSUPP;
636 if (p->phy != NULL) {
637 err = phy_read_status(p->phy);
638 if (err == 0)
639 err = phy_ethtool_gset(p->phy, cmd);
640 }
641
642 return err;
643}
644
645static int
646dsa_slave_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
647{
648 struct dsa_slave_priv *p = netdev_priv(dev);
649
650 if (p->phy != NULL)
651 return phy_ethtool_sset(p->phy, cmd);
652
653 return -EOPNOTSUPP;
654}
655
656static void dsa_slave_get_drvinfo(struct net_device *dev,
657 struct ethtool_drvinfo *drvinfo)
658{
7826d43f
JP		 659 strlcpy(drvinfo->driver, "dsa", sizeof(drvinfo->driver));
660 strlcpy(drvinfo->version, dsa_driver_version, sizeof(drvinfo->version));
661 strlcpy(drvinfo->fw_version, "N/A", sizeof(drvinfo->fw_version));
662 strlcpy(drvinfo->bus_info, "platform", sizeof(drvinfo->bus_info));
91da11f8
LB		 663}
664
3d762a0f
GR		 665static int dsa_slave_get_regs_len(struct net_device *dev)
666{
667 struct dsa_slave_priv *p = netdev_priv(dev);
668 struct dsa_switch *ds = p->parent;
669
670 if (ds->drv->get_regs_len)
671 return ds->drv->get_regs_len(ds, p->port);
672
673 return -EOPNOTSUPP;
674}
675
676static void
677dsa_slave_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *_p)
678{
679 struct dsa_slave_priv *p = netdev_priv(dev);
680 struct dsa_switch *ds = p->parent;
681
682 if (ds->drv->get_regs)
683 ds->drv->get_regs(ds, p->port, regs, _p);
684}
685
91da11f8
LB		 686static int dsa_slave_nway_reset(struct net_device *dev)
687{
688 struct dsa_slave_priv *p = netdev_priv(dev);
689
690 if (p->phy != NULL)
691 return genphy_restart_aneg(p->phy);
692
693 return -EOPNOTSUPP;
694}
695
696static u32 dsa_slave_get_link(struct net_device *dev)
697{
698 struct dsa_slave_priv *p = netdev_priv(dev);
699
700 if (p->phy != NULL) {
701 genphy_update_link(p->phy);
702 return p->phy->link;
703 }
704
705 return -EOPNOTSUPP;
706}
707
6793abb4
GR		 708static int dsa_slave_get_eeprom_len(struct net_device *dev)
709{
710 struct dsa_slave_priv *p = netdev_priv(dev);
711 struct dsa_switch *ds = p->parent;
712
713 if (ds->pd->eeprom_len)
714 return ds->pd->eeprom_len;
715
716 if (ds->drv->get_eeprom_len)
717 return ds->drv->get_eeprom_len(ds);
718
719 return 0;
720}
721
722static int dsa_slave_get_eeprom(struct net_device *dev,
723 struct ethtool_eeprom *eeprom, u8 *data)
724{
725 struct dsa_slave_priv *p = netdev_priv(dev);
726 struct dsa_switch *ds = p->parent;
727
728 if (ds->drv->get_eeprom)
729 return ds->drv->get_eeprom(ds, eeprom, data);
730
731 return -EOPNOTSUPP;
732}
733
734static int dsa_slave_set_eeprom(struct net_device *dev,
735 struct ethtool_eeprom *eeprom, u8 *data)
736{
737 struct dsa_slave_priv *p = netdev_priv(dev);
738 struct dsa_switch *ds = p->parent;
739
740 if (ds->drv->set_eeprom)
741 return ds->drv->set_eeprom(ds, eeprom, data);
742
743 return -EOPNOTSUPP;
744}
745
91da11f8
LB		 746static void dsa_slave_get_strings(struct net_device *dev,
747 uint32_t stringset, uint8_t *data)
748{
749 struct dsa_slave_priv *p = netdev_priv(dev);
750 struct dsa_switch *ds = p->parent;
751
752 if (stringset == ETH_SS_STATS) {
753 int len = ETH_GSTRING_LEN;
754
755 strncpy(data, "tx_packets", len);
756 strncpy(data + len, "tx_bytes", len);
757 strncpy(data + 2 * len, "rx_packets", len);
758 strncpy(data + 3 * len, "rx_bytes", len);
759 if (ds->drv->get_strings != NULL)
760 ds->drv->get_strings(ds, p->port, data + 4 * len);
761 }
762}
763
764static void dsa_slave_get_ethtool_stats(struct net_device *dev,
765 struct ethtool_stats *stats,
766 uint64_t *data)
767{
768 struct dsa_slave_priv *p = netdev_priv(dev);
769 struct dsa_switch *ds = p->parent;
770
771 data[0] = p->dev->stats.tx_packets;
772 data[1] = p->dev->stats.tx_bytes;
773 data[2] = p->dev->stats.rx_packets;
774 data[3] = p->dev->stats.rx_bytes;
775 if (ds->drv->get_ethtool_stats != NULL)
776 ds->drv->get_ethtool_stats(ds, p->port, data + 4);
777}
778
779static int dsa_slave_get_sset_count(struct net_device *dev, int sset)
780{
781 struct dsa_slave_priv *p = netdev_priv(dev);
782 struct dsa_switch *ds = p->parent;
783
784 if (sset == ETH_SS_STATS) {
785 int count;
786
787 count = 4;
788 if (ds->drv->get_sset_count != NULL)
789 count += ds->drv->get_sset_count(ds);
790
791 return count;
792 }
793
794 return -EOPNOTSUPP;
795}
796
19e57c4e
FF		 797static void dsa_slave_get_wol(struct net_device *dev, struct ethtool_wolinfo *w)
798{
799 struct dsa_slave_priv *p = netdev_priv(dev);
800 struct dsa_switch *ds = p->parent;
801
802 if (ds->drv->get_wol)
803 ds->drv->get_wol(ds, p->port, w);
804}
805
806static int dsa_slave_set_wol(struct net_device *dev, struct ethtool_wolinfo *w)
807{
808 struct dsa_slave_priv *p = netdev_priv(dev);
809 struct dsa_switch *ds = p->parent;
810 int ret = -EOPNOTSUPP;
811
812 if (ds->drv->set_wol)
813 ret = ds->drv->set_wol(ds, p->port, w);
814
815 return ret;
816}
817
7905288f
FF		 818static int dsa_slave_set_eee(struct net_device *dev, struct ethtool_eee *e)
819{
820 struct dsa_slave_priv *p = netdev_priv(dev);
821 struct dsa_switch *ds = p->parent;
822 int ret;
823
824 if (!ds->drv->set_eee)
825 return -EOPNOTSUPP;
826
827 ret = ds->drv->set_eee(ds, p->port, p->phy, e);
828 if (ret)
829 return ret;
830
831 if (p->phy)
832 ret = phy_ethtool_set_eee(p->phy, e);
833
834 return ret;
835}
836
837static int dsa_slave_get_eee(struct net_device *dev, struct ethtool_eee *e)
838{
839 struct dsa_slave_priv *p = netdev_priv(dev);
840 struct dsa_switch *ds = p->parent;
841 int ret;
842
843 if (!ds->drv->get_eee)
844 return -EOPNOTSUPP;
845
846 ret = ds->drv->get_eee(ds, p->port, e);
847 if (ret)
848 return ret;
849
850 if (p->phy)
851 ret = phy_ethtool_get_eee(p->phy, e);
852
853 return ret;
854}
855
04ff53f9
FF		 856#ifdef CONFIG_NET_POLL_CONTROLLER
857static int dsa_slave_netpoll_setup(struct net_device *dev,
858 struct netpoll_info *ni)
859{
860 struct dsa_slave_priv *p = netdev_priv(dev);
861 struct dsa_switch *ds = p->parent;
862 struct net_device *master = ds->dst->master_netdev;
863 struct netpoll *netpoll;
864 int err = 0;
865
866 netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL);
867 if (!netpoll)
868 return -ENOMEM;
869
870 err = __netpoll_setup(netpoll, master);
871 if (err) {
872 kfree(netpoll);
873 goto out;
874 }
875
876 p->netpoll = netpoll;
877out:
878 return err;
879}
880
881static void dsa_slave_netpoll_cleanup(struct net_device *dev)
882{
883 struct dsa_slave_priv *p = netdev_priv(dev);
884 struct netpoll *netpoll = p->netpoll;
885
886 if (!netpoll)
887 return;
888
889 p->netpoll = NULL;
890
891 __netpoll_free_async(netpoll);
892}
893
894static void dsa_slave_poll_controller(struct net_device *dev)
895{
896}
897#endif
898
91da11f8
LB		 899static const struct ethtool_ops dsa_slave_ethtool_ops = {
900 .get_settings = dsa_slave_get_settings,
901 .set_settings = dsa_slave_set_settings,
902 .get_drvinfo = dsa_slave_get_drvinfo,
3d762a0f
GR		 903 .get_regs_len = dsa_slave_get_regs_len,
904 .get_regs = dsa_slave_get_regs,
91da11f8
LB		 905 .nway_reset = dsa_slave_nway_reset,
906 .get_link = dsa_slave_get_link,
6793abb4
GR		 907 .get_eeprom_len = dsa_slave_get_eeprom_len,
908 .get_eeprom = dsa_slave_get_eeprom,
909 .set_eeprom = dsa_slave_set_eeprom,
91da11f8
LB		 910 .get_strings = dsa_slave_get_strings,
911 .get_ethtool_stats = dsa_slave_get_ethtool_stats,
912 .get_sset_count = dsa_slave_get_sset_count,
19e57c4e
FF		 913 .set_wol = dsa_slave_set_wol,
914 .get_wol = dsa_slave_get_wol,
7905288f
FF		 915 .set_eee = dsa_slave_set_eee,
916 .get_eee = dsa_slave_get_eee,
91da11f8
LB		 917};
918
3e8a72d1 919static const struct net_device_ops dsa_slave_netdev_ops = {
d442ad4a
SH		 920 .ndo_open = dsa_slave_open,
921 .ndo_stop = dsa_slave_close,
3e8a72d1 922 .ndo_start_xmit = dsa_slave_xmit,
d442ad4a
SH		 923 .ndo_change_rx_flags = dsa_slave_change_rx_flags,
924 .ndo_set_rx_mode = dsa_slave_set_rx_mode,
d442ad4a 925 .ndo_set_mac_address = dsa_slave_set_mac_address,
ba14d9eb
VD		 926 .ndo_fdb_add = switchdev_port_fdb_add,
927 .ndo_fdb_del = switchdev_port_fdb_del,
928 .ndo_fdb_dump = switchdev_port_fdb_dump,
d442ad4a 929 .ndo_do_ioctl = dsa_slave_ioctl,
abd2be00 930 .ndo_get_iflink = dsa_slave_get_iflink,
04ff53f9
FF		 931#ifdef CONFIG_NET_POLL_CONTROLLER
932 .ndo_netpoll_setup = dsa_slave_netpoll_setup,
933 .ndo_netpoll_cleanup = dsa_slave_netpoll_cleanup,
934 .ndo_poll_controller = dsa_slave_poll_controller,
935#endif
11149536
VD		 936 .ndo_bridge_getlink = switchdev_port_bridge_getlink,
937 .ndo_bridge_setlink = switchdev_port_bridge_setlink,
938 .ndo_bridge_dellink = switchdev_port_bridge_dellink,
98237d43
SF		 939};
940
9d47c0a2 941static const struct switchdev_ops dsa_slave_switchdev_ops = {
f8e20a9f 942 .switchdev_port_attr_get = dsa_slave_port_attr_get,
35636062 943 .switchdev_port_attr_set = dsa_slave_port_attr_set,
ba14d9eb
VD		 944 .switchdev_port_obj_add = dsa_slave_port_obj_add,
945 .switchdev_port_obj_del = dsa_slave_port_obj_del,
946 .switchdev_port_obj_dump = dsa_slave_port_obj_dump,
d442ad4a 947};
91da11f8 948
f37db85d
FF		 949static struct device_type dsa_type = {
950 .name = "dsa",
951};
952
0d8bcdd3
FF		 953static void dsa_slave_adjust_link(struct net_device *dev)
954{
955 struct dsa_slave_priv *p = netdev_priv(dev);
ec9436ba 956 struct dsa_switch *ds = p->parent;
0d8bcdd3
FF		 957 unsigned int status_changed = 0;
958
959 if (p->old_link != p->phy->link) {
960 status_changed = 1;
961 p->old_link = p->phy->link;
962 }
963
964 if (p->old_duplex != p->phy->duplex) {
965 status_changed = 1;
966 p->old_duplex = p->phy->duplex;
967 }
968
969 if (p->old_pause != p->phy->pause) {
970 status_changed = 1;
971 p->old_pause = p->phy->pause;
972 }
973
ec9436ba
FF		 974 if (ds->drv->adjust_link && status_changed)
975 ds->drv->adjust_link(ds, p->port, p->phy);
976
0d8bcdd3
FF		 977 if (status_changed)
978 phy_print_status(p->phy);
979}
980
ce31b31c
FF		 981static int dsa_slave_fixed_link_update(struct net_device *dev,
982 struct fixed_phy_status *status)
983{
984 struct dsa_slave_priv *p = netdev_priv(dev);
985 struct dsa_switch *ds = p->parent;
986
987 if (ds->drv->fixed_link_update)
988 ds->drv->fixed_link_update(ds, p->port, status);
989
990 return 0;
991}
992
91da11f8 993/* slave device setup *******************************************************/
c305c165 994static int dsa_slave_phy_connect(struct dsa_slave_priv *p,
cd28a1a9
FF		 995 struct net_device *slave_dev,
996 int addr)
c305c165
FF		 997{
998 struct dsa_switch *ds = p->parent;
999
cd28a1a9 1000 p->phy = ds->slave_mii_bus->phy_map[addr];
d25b8e74
RK		 1001 if (!p->phy) {
1002 netdev_err(slave_dev, "no phy at %d\n", addr);
c305c165 1003 return -ENODEV;
d25b8e74 1004 }
c305c165
FF		 1005
1006 /* Use already configured phy mode */
211c504a
FF		 1007 if (p->phy_interface == PHY_INTERFACE_MODE_NA)
1008 p->phy_interface = p->phy->interface;
c305c165
FF		 1009 phy_connect_direct(slave_dev, p->phy, dsa_slave_adjust_link,
1010 p->phy_interface);
1011
1012 return 0;
1013}
1014
9697f1cd 1015static int dsa_slave_phy_setup(struct dsa_slave_priv *p,
0d8bcdd3
FF		 1016 struct net_device *slave_dev)
1017{
1018 struct dsa_switch *ds = p->parent;
1019 struct dsa_chip_data *cd = ds->pd;
1020 struct device_node *phy_dn, *port_dn;
ce31b31c 1021 bool phy_is_fixed = false;
6819563e 1022 u32 phy_flags = 0;
19334920 1023 int mode, ret;
0d8bcdd3
FF		 1024
1025 port_dn = cd->port_dn[p->port];
19334920
GR		 1026 mode = of_get_phy_mode(port_dn);
1027 if (mode < 0)
1028 mode = PHY_INTERFACE_MODE_NA;
1029 p->phy_interface = mode;
0d8bcdd3
FF		 1030
1031 phy_dn = of_parse_phandle(port_dn, "phy-handle", 0);
1032 if (of_phy_is_fixed_link(port_dn)) {
1033 /* In the case of a fixed PHY, the DT node associated
1034 * to the fixed PHY is the Port DT node
1035 */
1036 ret = of_phy_register_fixed_link(port_dn);
1037 if (ret) {
d25b8e74 1038 netdev_err(slave_dev, "failed to register fixed PHY: %d\n", ret);
9697f1cd 1039 return ret;
0d8bcdd3 1040 }
ce31b31c 1041 phy_is_fixed = true;
0d8bcdd3
FF		 1042 phy_dn = port_dn;
1043 }
1044
6819563e
FF		 1045 if (ds->drv->get_phy_flags)
1046 phy_flags = ds->drv->get_phy_flags(ds, p->port);
1047
cd28a1a9 1048 if (phy_dn) {
d25b8e74
RK		 1049 int phy_id = of_mdio_parse_addr(&slave_dev->dev, phy_dn);
1050
cd28a1a9
FF		 1051 /* If this PHY address is part of phys_mii_mask, which means
1052 * that we need to divert reads and writes to/from it, then we
1053 * want to bind this device using the slave MII bus created by
1054 * DSA to make that happen.
1055 */
d25b8e74
RK		 1056 if (!phy_is_fixed && phy_id >= 0 &&
1057 (ds->phys_mii_mask & (1 << phy_id))) {
1058 ret = dsa_slave_phy_connect(p, slave_dev, phy_id);
1059 if (ret) {
1060 netdev_err(slave_dev, "failed to connect to phy%d: %d\n", phy_id, ret);
cd28a1a9 1061 return ret;
d25b8e74 1062 }
cd28a1a9
FF		 1063 } else {
1064 p->phy = of_phy_connect(slave_dev, phy_dn,
1065 dsa_slave_adjust_link,
1066 phy_flags,
1067 p->phy_interface);
1068 }
1069 }
0d8bcdd3 1070
ce31b31c
FF		 1071 if (p->phy && phy_is_fixed)
1072 fixed_phy_set_link_update(p->phy, dsa_slave_fixed_link_update);
1073
0d8bcdd3
FF		 1074 /* We could not connect to a designated PHY, so use the switch internal
1075 * MDIO bus instead
1076 */
b31f65fb 1077 if (!p->phy) {
cd28a1a9 1078 ret = dsa_slave_phy_connect(p, slave_dev, p->port);
d25b8e74
RK		 1079 if (ret) {
1080 netdev_err(slave_dev, "failed to connect to port %d: %d\n", p->port, ret);
c305c165 1081 return ret;
d25b8e74 1082 }
b31f65fb 1083 } else {
a2ae6007
JP		 1084 netdev_info(slave_dev, "attached PHY at address %d [%s]\n",
1085 p->phy->addr, p->phy->drv->name);
b31f65fb 1086 }
9697f1cd
FF		 1087
1088 return 0;
0d8bcdd3
FF		 1089}
1090
448b4482
AL		 1091static struct lock_class_key dsa_slave_netdev_xmit_lock_key;
1092static void dsa_slave_set_lockdep_class_one(struct net_device *dev,
1093 struct netdev_queue *txq,
1094 void *_unused)
1095{
1096 lockdep_set_class(&txq->_xmit_lock,
1097 &dsa_slave_netdev_xmit_lock_key);
1098}
1099
24462549
FF		 1100int dsa_slave_suspend(struct net_device *slave_dev)
1101{
1102 struct dsa_slave_priv *p = netdev_priv(slave_dev);
1103
24462549
FF		 1104 if (p->phy) {
1105 phy_stop(p->phy);
1106 p->old_pause = -1;
1107 p->old_link = -1;
1108 p->old_duplex = -1;
1109 phy_suspend(p->phy);
1110 }
1111
1112 return 0;
1113}
1114
1115int dsa_slave_resume(struct net_device *slave_dev)
1116{
1117 struct dsa_slave_priv *p = netdev_priv(slave_dev);
1118
1119 netif_device_attach(slave_dev);
1120
1121 if (p->phy) {
1122 phy_resume(p->phy);
1123 phy_start(p->phy);
1124 }
1125
1126 return 0;
1127}
1128
d87d6f44
GR		 1129int dsa_slave_create(struct dsa_switch *ds, struct device *parent,
1130 int port, char *name)
91da11f8 1131{
e84665c9 1132 struct net_device *master = ds->dst->master_netdev;
91da11f8
LB		 1133 struct net_device *slave_dev;
1134 struct dsa_slave_priv *p;
1135 int ret;
1136
c835a677
TG		 1137 slave_dev = alloc_netdev(sizeof(struct dsa_slave_priv), name,
1138 NET_NAME_UNKNOWN, ether_setup);
91da11f8 1139 if (slave_dev == NULL)
d87d6f44 1140 return -ENOMEM;
91da11f8
LB		 1141
1142 slave_dev->features = master->vlan_features;
7ad24ea4 1143 slave_dev->ethtool_ops = &dsa_slave_ethtool_ops;
2fcc8005 1144 eth_hw_addr_inherit(slave_dev, master);
0a5f107b 1145 slave_dev->priv_flags |= IFF_NO_QUEUE;
3e8a72d1 1146 slave_dev->netdev_ops = &dsa_slave_netdev_ops;
9d47c0a2 1147 slave_dev->switchdev_ops = &dsa_slave_switchdev_ops;
f37db85d 1148 SET_NETDEV_DEVTYPE(slave_dev, &dsa_type);
d442ad4a 1149
448b4482
AL		 1150 netdev_for_each_tx_queue(slave_dev, dsa_slave_set_lockdep_class_one,
1151 NULL);
1152
5075314e
AD		 1153 SET_NETDEV_DEV(slave_dev, parent);
1154 slave_dev->dev.of_node = ds->pd->port_dn[port];
1155 slave_dev->vlan_features = master->vlan_features;
1156
1157 p = netdev_priv(slave_dev);
1158 p->dev = slave_dev;
1159 p->parent = ds;
1160 p->port = port;
1161
e84665c9 1162 switch (ds->dst->tag_protocol) {
cf85d08f 1163#ifdef CONFIG_NET_DSA_TAG_DSA
ac7a04c3 1164 case DSA_TAG_PROTO_DSA:
5075314e 1165 p->xmit = dsa_netdev_ops.xmit;
cf85d08f
LB		 1166 break;
1167#endif
91da11f8 1168#ifdef CONFIG_NET_DSA_TAG_EDSA
ac7a04c3 1169 case DSA_TAG_PROTO_EDSA:
5075314e 1170 p->xmit = edsa_netdev_ops.xmit;
91da11f8 1171 break;
396138f0
LB		 1172#endif
1173#ifdef CONFIG_NET_DSA_TAG_TRAILER
ac7a04c3 1174 case DSA_TAG_PROTO_TRAILER:
5075314e 1175 p->xmit = trailer_netdev_ops.xmit;
396138f0 1176 break;
5037d532
FF		 1177#endif
1178#ifdef CONFIG_NET_DSA_TAG_BRCM
ac7a04c3 1179 case DSA_TAG_PROTO_BRCM:
5075314e 1180 p->xmit = brcm_netdev_ops.xmit;
5037d532 1181 break;
91da11f8
LB		 1182#endif
1183 default:
5075314e 1184 p->xmit = dsa_slave_notag_xmit;
5aed85ce 1185 break;
91da11f8 1186 }
d442ad4a 1187
0d8bcdd3
FF		 1188 p->old_pause = -1;
1189 p->old_link = -1;
1190 p->old_duplex = -1;
1191
9697f1cd
FF		 1192 ret = dsa_slave_phy_setup(p, slave_dev);
1193 if (ret) {
d25b8e74 1194 netdev_err(master, "error %d setting up slave phy\n", ret);
9697f1cd 1195 free_netdev(slave_dev);
d87d6f44 1196 return ret;
9697f1cd 1197 }
91da11f8 1198
d87d6f44 1199 ds->ports[port] = slave_dev;
91da11f8
LB		 1200 ret = register_netdev(slave_dev);
1201 if (ret) {
a2ae6007
JP		 1202 netdev_err(master, "error %d registering interface %s\n",
1203 ret, slave_dev->name);
9697f1cd 1204 phy_disconnect(p->phy);
d87d6f44 1205 ds->ports[port] = NULL;
91da11f8 1206 free_netdev(slave_dev);
d87d6f44 1207 return ret;
91da11f8
LB		 1208 }
1209
1210 netif_carrier_off(slave_dev);
1211
d87d6f44 1212 return 0;
91da11f8 1213}
b73adef6
FF		 1214
1215static bool dsa_slave_dev_check(struct net_device *dev)
1216{
1217 return dev->netdev_ops == &dsa_slave_netdev_ops;
1218}
1219
1220static int dsa_slave_master_changed(struct net_device *dev)
1221{
1222 struct net_device *master = netdev_master_upper_dev_get(dev);
b06b107a 1223 struct dsa_slave_priv *p = netdev_priv(dev);
b73adef6
FF		 1224 int err = 0;
1225
1226 if (master && master->rtnl_link_ops &&
1227 !strcmp(master->rtnl_link_ops->kind, "bridge"))
1228 err = dsa_slave_bridge_port_join(dev, master);
b06b107a 1229 else if (dsa_port_is_bridged(p))
b73adef6
FF		 1230 err = dsa_slave_bridge_port_leave(dev);
1231
1232 return err;
1233}
1234
1235int dsa_slave_netdevice_event(struct notifier_block *unused,
1236 unsigned long event, void *ptr)
1237{
1238 struct net_device *dev;
1239 int err = 0;
1240
1241 switch (event) {
1242 case NETDEV_CHANGEUPPER:
1243 dev = netdev_notifier_info_to_dev(ptr);
1244 if (!dsa_slave_dev_check(dev))
1245 goto out;
1246
1247 err = dsa_slave_master_changed(dev);
efd29b3d 1248 if (err && err != -EOPNOTSUPP)
b73adef6
FF		 1249 netdev_warn(dev, "failed to reflect master change\n");
1250
1251 break;
1252 }
1253
1254out:
1255 return NOTIFY_DONE;
1256}
Linux 6.x block layer and io_uring tree(s)