slave.c 34.2 KB
Newer Older
1 2
/*
 * net/dsa/slave.c - Slave device handling
3
 * Copyright (c) 2008-2009 Marvell Semiconductor
4 5 6 7 8 9 10 11
 *
 * 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.
 */

#include <linux/list.h>
12
#include <linux/etherdevice.h>
13
#include <linux/netdevice.h>
14
#include <linux/phy.h>
15
#include <linux/phy_fixed.h>
16 17
#include <linux/of_net.h>
#include <linux/of_mdio.h>
18
#include <linux/mdio.h>
19
#include <linux/list.h>
20
#include <net/rtnetlink.h>
21 22
#include <net/pkt_cls.h>
#include <net/tc_act/tc_mirred.h>
23
#include <linux/if_bridge.h>
24
#include <linux/netpoll.h>
25

26 27
#include "dsa_priv.h"

28 29
static bool dsa_slave_dev_check(struct net_device *dev);

30 31 32 33 34
/* slave mii_bus handling ***************************************************/
static int dsa_slave_phy_read(struct mii_bus *bus, int addr, int reg)
{
	struct dsa_switch *ds = bus->priv;

35
	if (ds->phys_mii_mask & (1 << addr))
36
		return ds->ops->phy_read(ds, addr, reg);
37 38 39 40 41 42 43 44

	return 0xffff;
}

static int dsa_slave_phy_write(struct mii_bus *bus, int addr, int reg, u16 val)
{
	struct dsa_switch *ds = bus->priv;

45
	if (ds->phys_mii_mask & (1 << addr))
46
		return ds->ops->phy_write(ds, addr, reg, val);
47 48 49 50 51 52 53 54 55 56

	return 0;
}

void dsa_slave_mii_bus_init(struct dsa_switch *ds)
{
	ds->slave_mii_bus->priv = (void *)ds;
	ds->slave_mii_bus->name = "dsa slave smi";
	ds->slave_mii_bus->read = dsa_slave_phy_read;
	ds->slave_mii_bus->write = dsa_slave_phy_write;
57 58
	snprintf(ds->slave_mii_bus->id, MII_BUS_ID_SIZE, "dsa-%d.%d",
		 ds->dst->tree, ds->index);
59
	ds->slave_mii_bus->parent = ds->dev;
60
	ds->slave_mii_bus->phy_mask = ~ds->phys_mii_mask;
61 62 63 64
}


/* slave device handling ****************************************************/
N
Nicolas Dichtel 已提交
65
static int dsa_slave_get_iflink(const struct net_device *dev)
66 67 68
{
	struct dsa_slave_priv *p = netdev_priv(dev);

69
	return dsa_master_netdev(p)->ifindex;
70 71
}

72 73
static int dsa_slave_open(struct net_device *dev)
{
74
	struct dsa_slave_priv *p = netdev_priv(dev);
75 76
	struct dsa_port *dp = p->dp;
	struct dsa_switch *ds = dp->ds;
77
	struct net_device *master = dsa_master_netdev(p);
78
	u8 stp_state = dp->bridge_dev ? BR_STATE_BLOCKING : BR_STATE_FORWARDING;
79 80 81 82 83
	int err;

	if (!(master->flags & IFF_UP))
		return -ENETDOWN;

84
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr)) {
85
		err = dev_uc_add(master, dev->dev_addr);
86 87 88 89 90 91 92 93 94 95 96 97 98 99 100
		if (err < 0)
			goto out;
	}

	if (dev->flags & IFF_ALLMULTI) {
		err = dev_set_allmulti(master, 1);
		if (err < 0)
			goto del_unicast;
	}
	if (dev->flags & IFF_PROMISC) {
		err = dev_set_promiscuity(master, 1);
		if (err < 0)
			goto clear_allmulti;
	}

101
	if (ds->ops->port_enable) {
102
		err = ds->ops->port_enable(ds, p->dp->index, p->phy);
103 104 105 106
		if (err)
			goto clear_promisc;
	}

107
	dsa_port_set_state_now(p->dp, stp_state);
108

109 110 111
	if (p->phy)
		phy_start(p->phy);

112
	return 0;
113

114 115
clear_promisc:
	if (dev->flags & IFF_PROMISC)
116
		dev_set_promiscuity(master, -1);
117 118 119 120
clear_allmulti:
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(master, -1);
del_unicast:
121
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
122
		dev_uc_del(master, dev->dev_addr);
123 124
out:
	return err;
125 126 127 128
}

static int dsa_slave_close(struct net_device *dev)
{
129
	struct dsa_slave_priv *p = netdev_priv(dev);
130
	struct net_device *master = dsa_master_netdev(p);
131
	struct dsa_switch *ds = p->dp->ds;
132

133 134 135
	if (p->phy)
		phy_stop(p->phy);

136
	dev_mc_unsync(master, dev);
137
	dev_uc_unsync(master, dev);
138 139 140 141 142
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(master, -1);
	if (dev->flags & IFF_PROMISC)
		dev_set_promiscuity(master, -1);

143
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
144
		dev_uc_del(master, dev->dev_addr);
145

146
	if (ds->ops->port_disable)
147
		ds->ops->port_disable(ds, p->dp->index, p->phy);
148

149
	dsa_port_set_state_now(p->dp, BR_STATE_DISABLED);
150

151 152 153 154 155 156
	return 0;
}

static void dsa_slave_change_rx_flags(struct net_device *dev, int change)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
157
	struct net_device *master = dsa_master_netdev(p);
158 159 160 161 162 163 164 165 166 167

	if (change & IFF_ALLMULTI)
		dev_set_allmulti(master, dev->flags & IFF_ALLMULTI ? 1 : -1);
	if (change & IFF_PROMISC)
		dev_set_promiscuity(master, dev->flags & IFF_PROMISC ? 1 : -1);
}

static void dsa_slave_set_rx_mode(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
168
	struct net_device *master = dsa_master_netdev(p);
169 170

	dev_mc_sync(master, dev);
171
	dev_uc_sync(master, dev);
172 173
}

174
static int dsa_slave_set_mac_address(struct net_device *dev, void *a)
175
{
176
	struct dsa_slave_priv *p = netdev_priv(dev);
177
	struct net_device *master = dsa_master_netdev(p);
178 179 180 181 182 183 184 185 186
	struct sockaddr *addr = a;
	int err;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	if (!(dev->flags & IFF_UP))
		goto out;

187
	if (!ether_addr_equal(addr->sa_data, master->dev_addr)) {
188
		err = dev_uc_add(master, addr->sa_data);
189 190 191 192
		if (err < 0)
			return err;
	}

193
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
194
		dev_uc_del(master, dev->dev_addr);
195 196

out:
J
Joe Perches 已提交
197
	ether_addr_copy(dev->dev_addr, addr->sa_data);
198 199 200 201

	return 0;
}

202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278
struct dsa_slave_dump_ctx {
	struct net_device *dev;
	struct sk_buff *skb;
	struct netlink_callback *cb;
	int idx;
};

static int
dsa_slave_port_fdb_do_dump(const unsigned char *addr, u16 vid,
			   bool is_static, void *data)
{
	struct dsa_slave_dump_ctx *dump = data;
	u32 portid = NETLINK_CB(dump->cb->skb).portid;
	u32 seq = dump->cb->nlh->nlmsg_seq;
	struct nlmsghdr *nlh;
	struct ndmsg *ndm;

	if (dump->idx < dump->cb->args[2])
		goto skip;

	nlh = nlmsg_put(dump->skb, portid, seq, RTM_NEWNEIGH,
			sizeof(*ndm), NLM_F_MULTI);
	if (!nlh)
		return -EMSGSIZE;

	ndm = nlmsg_data(nlh);
	ndm->ndm_family  = AF_BRIDGE;
	ndm->ndm_pad1    = 0;
	ndm->ndm_pad2    = 0;
	ndm->ndm_flags   = NTF_SELF;
	ndm->ndm_type    = 0;
	ndm->ndm_ifindex = dump->dev->ifindex;
	ndm->ndm_state   = is_static ? NUD_NOARP : NUD_REACHABLE;

	if (nla_put(dump->skb, NDA_LLADDR, ETH_ALEN, addr))
		goto nla_put_failure;

	if (vid && nla_put_u16(dump->skb, NDA_VLAN, vid))
		goto nla_put_failure;

	nlmsg_end(dump->skb, nlh);

skip:
	dump->idx++;
	return 0;

nla_put_failure:
	nlmsg_cancel(dump->skb, nlh);
	return -EMSGSIZE;
}

static int
dsa_slave_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb,
		   struct net_device *dev, struct net_device *filter_dev,
		   int *idx)
{
	struct dsa_slave_dump_ctx dump = {
		.dev = dev,
		.skb = skb,
		.cb = cb,
		.idx = *idx,
	};
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_port *dp = p->dp;
	struct dsa_switch *ds = dp->ds;
	int err;

	if (!ds->ops->port_fdb_dump)
		return -EOPNOTSUPP;

	err = ds->ops->port_fdb_dump(ds, dp->index,
				     dsa_slave_port_fdb_do_dump,
				     &dump);
	*idx = dump.idx;
	return err;
}

279 280 281 282 283
static int dsa_slave_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL)
284
		return phy_mii_ioctl(p->phy, ifr, cmd);
285 286 287 288

	return -EOPNOTSUPP;
}

289
static int dsa_slave_port_attr_set(struct net_device *dev,
290
				   const struct switchdev_attr *attr,
291
				   struct switchdev_trans *trans)
292
{
293 294
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_port *dp = p->dp;
295
	int ret;
296 297

	switch (attr->id) {
298
	case SWITCHDEV_ATTR_ID_PORT_STP_STATE:
299
		ret = dsa_port_set_state(dp, attr->u.stp_state, trans);
300
		break;
301
	case SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING:
302 303
		ret = dsa_port_vlan_filtering(dp, attr->u.vlan_filtering,
					      trans);
304
		break;
305
	case SWITCHDEV_ATTR_ID_BRIDGE_AGEING_TIME:
306
		ret = dsa_port_ageing_time(dp, attr->u.ageing_time, trans);
307
		break;
308 309 310 311 312 313 314 315
	default:
		ret = -EOPNOTSUPP;
		break;
	}

	return ret;
}

316
static int dsa_slave_port_obj_add(struct net_device *dev,
317
				  const struct switchdev_obj *obj,
318
				  struct switchdev_trans *trans)
319
{
320 321
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_port *dp = p->dp;
322 323 324 325 326 327 328
	int err;

	/* For the prepare phase, ensure the full set of changes is feasable in
	 * one go in order to signal a failure properly. If an operation is not
	 * supported, return -EOPNOTSUPP.
	 */

329
	switch (obj->id) {
V
Vivien Didelot 已提交
330
	case SWITCHDEV_OBJ_ID_PORT_MDB:
331
		err = dsa_port_mdb_add(dp, SWITCHDEV_OBJ_PORT_MDB(obj), trans);
V
Vivien Didelot 已提交
332
		break;
333
	case SWITCHDEV_OBJ_ID_PORT_VLAN:
334 335
		err = dsa_port_vlan_add(dp, SWITCHDEV_OBJ_PORT_VLAN(obj),
					trans);
336
		break;
337 338 339 340 341 342 343 344 345
	default:
		err = -EOPNOTSUPP;
		break;
	}

	return err;
}

static int dsa_slave_port_obj_del(struct net_device *dev,
346
				  const struct switchdev_obj *obj)
347
{
348 349
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_port *dp = p->dp;
350 351
	int err;

352
	switch (obj->id) {
V
Vivien Didelot 已提交
353
	case SWITCHDEV_OBJ_ID_PORT_MDB:
354
		err = dsa_port_mdb_del(dp, SWITCHDEV_OBJ_PORT_MDB(obj));
V
Vivien Didelot 已提交
355
		break;
356
	case SWITCHDEV_OBJ_ID_PORT_VLAN:
357
		err = dsa_port_vlan_del(dp, SWITCHDEV_OBJ_PORT_VLAN(obj));
358
		break;
359 360 361 362 363 364 365 366
	default:
		err = -EOPNOTSUPP;
		break;
	}

	return err;
}

367 368
static int dsa_slave_port_attr_get(struct net_device *dev,
				   struct switchdev_attr *attr)
369 370
{
	struct dsa_slave_priv *p = netdev_priv(dev);
371
	struct dsa_switch *ds = p->dp->ds;
372

373
	switch (attr->id) {
374
	case SWITCHDEV_ATTR_ID_PORT_PARENT_ID:
375 376
		attr->u.ppid.id_len = sizeof(ds->index);
		memcpy(&attr->u.ppid.id, &ds->index, attr->u.ppid.id_len);
377
		break;
378 379 380
	case SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS_SUPPORT:
		attr->u.brport_flags_support = 0;
		break;
381 382 383
	default:
		return -EOPNOTSUPP;
	}
384 385 386 387

	return 0;
}

388 389 390 391 392 393 394 395 396 397 398 399
static inline netdev_tx_t dsa_netpoll_send_skb(struct dsa_slave_priv *p,
					       struct sk_buff *skb)
{
#ifdef CONFIG_NET_POLL_CONTROLLER
	if (p->netpoll)
		netpoll_send_skb(p->netpoll, skb);
#else
	BUG();
#endif
	return NETDEV_TX_OK;
}

400 401 402
static netdev_tx_t dsa_slave_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
403
	struct pcpu_sw_netstats *s;
404
	struct sk_buff *nskb;
405

406 407 408 409 410
	s = this_cpu_ptr(p->stats64);
	u64_stats_update_begin(&s->syncp);
	s->tx_packets++;
	s->tx_bytes += skb->len;
	u64_stats_update_end(&s->syncp);
411

412 413 414
	/* Transmit function may have to reallocate the original SKB,
	 * in which case it must have freed it. Only free it here on error.
	 */
415
	nskb = p->xmit(skb, dev);
416 417
	if (!nskb) {
		kfree_skb(skb);
418
		return NETDEV_TX_OK;
419
	}
420

421 422 423 424 425 426
	/* SKB for netpoll still need to be mangled with the protocol-specific
	 * tag to be successfully transmitted
	 */
	if (unlikely(netpoll_tx_running(dev)))
		return dsa_netpoll_send_skb(p, nskb);

427 428 429
	/* Queue the SKB for transmission on the parent interface, but
	 * do not modify its EtherType
	 */
430
	nskb->dev = dsa_master_netdev(p);
431
	dev_queue_xmit(nskb);
432 433 434 435

	return NETDEV_TX_OK;
}

436 437
/* ethtool operations *******************************************************/
static int
438 439
dsa_slave_get_link_ksettings(struct net_device *dev,
			     struct ethtool_link_ksettings *cmd)
440 441 442
{
	struct dsa_slave_priv *p = netdev_priv(dev);

443 444
	if (!p->phy)
		return -EOPNOTSUPP;
445

446 447 448
	phy_ethtool_ksettings_get(p->phy, cmd);

	return 0;
449 450 451
}

static int
452 453
dsa_slave_set_link_ksettings(struct net_device *dev,
			     const struct ethtool_link_ksettings *cmd)
454 455 456 457
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL)
458
		return phy_ethtool_ksettings_set(p->phy, cmd);
459 460 461 462 463 464 465

	return -EOPNOTSUPP;
}

static void dsa_slave_get_drvinfo(struct net_device *dev,
				  struct ethtool_drvinfo *drvinfo)
{
466 467 468
	strlcpy(drvinfo->driver, "dsa", sizeof(drvinfo->driver));
	strlcpy(drvinfo->fw_version, "N/A", sizeof(drvinfo->fw_version));
	strlcpy(drvinfo->bus_info, "platform", sizeof(drvinfo->bus_info));
469 470
}

471 472 473
static int dsa_slave_get_regs_len(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
474
	struct dsa_switch *ds = p->dp->ds;
475

476
	if (ds->ops->get_regs_len)
477
		return ds->ops->get_regs_len(ds, p->dp->index);
478 479 480 481 482 483 484 485

	return -EOPNOTSUPP;
}

static void
dsa_slave_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *_p)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
486
	struct dsa_switch *ds = p->dp->ds;
487

488
	if (ds->ops->get_regs)
489
		ds->ops->get_regs(ds, p->dp->index, regs, _p);
490 491
}

492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513
static int dsa_slave_nway_reset(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL)
		return genphy_restart_aneg(p->phy);

	return -EOPNOTSUPP;
}

static u32 dsa_slave_get_link(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL) {
		genphy_update_link(p->phy);
		return p->phy->link;
	}

	return -EOPNOTSUPP;
}

514 515 516
static int dsa_slave_get_eeprom_len(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
517
	struct dsa_switch *ds = p->dp->ds;
518

519
	if (ds->cd && ds->cd->eeprom_len)
A
Andrew Lunn 已提交
520
		return ds->cd->eeprom_len;
521

522 523
	if (ds->ops->get_eeprom_len)
		return ds->ops->get_eeprom_len(ds);
524 525 526 527 528 529 530 531

	return 0;
}

static int dsa_slave_get_eeprom(struct net_device *dev,
				struct ethtool_eeprom *eeprom, u8 *data)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
532
	struct dsa_switch *ds = p->dp->ds;
533

534 535
	if (ds->ops->get_eeprom)
		return ds->ops->get_eeprom(ds, eeprom, data);
536 537 538 539 540 541 542 543

	return -EOPNOTSUPP;
}

static int dsa_slave_set_eeprom(struct net_device *dev,
				struct ethtool_eeprom *eeprom, u8 *data)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
544
	struct dsa_switch *ds = p->dp->ds;
545

546 547
	if (ds->ops->set_eeprom)
		return ds->ops->set_eeprom(ds, eeprom, data);
548 549 550 551

	return -EOPNOTSUPP;
}

552 553 554 555
static void dsa_slave_get_strings(struct net_device *dev,
				  uint32_t stringset, uint8_t *data)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
556
	struct dsa_switch *ds = p->dp->ds;
557 558 559 560 561 562 563 564

	if (stringset == ETH_SS_STATS) {
		int len = ETH_GSTRING_LEN;

		strncpy(data, "tx_packets", len);
		strncpy(data + len, "tx_bytes", len);
		strncpy(data + 2 * len, "rx_packets", len);
		strncpy(data + 3 * len, "rx_bytes", len);
565
		if (ds->ops->get_strings)
566
			ds->ops->get_strings(ds, p->dp->index, data + 4 * len);
567 568 569 570 571 572 573 574
	}
}

static void dsa_slave_get_ethtool_stats(struct net_device *dev,
					struct ethtool_stats *stats,
					uint64_t *data)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
575
	struct dsa_switch *ds = p->dp->ds;
576
	struct pcpu_sw_netstats *s;
577
	unsigned int start;
578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595
	int i;

	for_each_possible_cpu(i) {
		u64 tx_packets, tx_bytes, rx_packets, rx_bytes;

		s = per_cpu_ptr(p->stats64, i);
		do {
			start = u64_stats_fetch_begin_irq(&s->syncp);
			tx_packets = s->tx_packets;
			tx_bytes = s->tx_bytes;
			rx_packets = s->rx_packets;
			rx_bytes = s->rx_bytes;
		} while (u64_stats_fetch_retry_irq(&s->syncp, start));
		data[0] += tx_packets;
		data[1] += tx_bytes;
		data[2] += rx_packets;
		data[3] += rx_bytes;
	}
596
	if (ds->ops->get_ethtool_stats)
597
		ds->ops->get_ethtool_stats(ds, p->dp->index, data + 4);
598 599 600 601 602
}

static int dsa_slave_get_sset_count(struct net_device *dev, int sset)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
603
	struct dsa_switch *ds = p->dp->ds;
604 605 606 607 608

	if (sset == ETH_SS_STATS) {
		int count;

		count = 4;
609 610
		if (ds->ops->get_sset_count)
			count += ds->ops->get_sset_count(ds);
611 612 613 614 615 616 617

		return count;
	}

	return -EOPNOTSUPP;
}

618 619 620
static void dsa_slave_get_wol(struct net_device *dev, struct ethtool_wolinfo *w)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
621
	struct dsa_switch *ds = p->dp->ds;
622

623
	if (ds->ops->get_wol)
624
		ds->ops->get_wol(ds, p->dp->index, w);
625 626 627 628 629
}

static int dsa_slave_set_wol(struct net_device *dev, struct ethtool_wolinfo *w)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
630
	struct dsa_switch *ds = p->dp->ds;
631 632
	int ret = -EOPNOTSUPP;

633
	if (ds->ops->set_wol)
634
		ret = ds->ops->set_wol(ds, p->dp->index, w);
635 636 637 638

	return ret;
}

639 640 641
static int dsa_slave_set_eee(struct net_device *dev, struct ethtool_eee *e)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
642
	struct dsa_switch *ds = p->dp->ds;
643 644
	int ret;

645 646 647 648
	/* Port's PHY and MAC both need to be EEE capable */
	if (!p->phy)
		return -ENODEV;

V
Vivien Didelot 已提交
649
	if (!ds->ops->set_mac_eee)
650 651
		return -EOPNOTSUPP;

V
Vivien Didelot 已提交
652
	ret = ds->ops->set_mac_eee(ds, p->dp->index, e);
653 654 655
	if (ret)
		return ret;

656 657 658 659 660 661
	if (e->eee_enabled) {
		ret = phy_init_eee(p->phy, 0);
		if (ret)
			return ret;
	}

662
	return phy_ethtool_set_eee(p->phy, e);
663 664 665 666 667
}

static int dsa_slave_get_eee(struct net_device *dev, struct ethtool_eee *e)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
668
	struct dsa_switch *ds = p->dp->ds;
669 670
	int ret;

671 672 673 674
	/* Port's PHY and MAC both need to be EEE capable */
	if (!p->phy)
		return -ENODEV;

V
Vivien Didelot 已提交
675
	if (!ds->ops->get_mac_eee)
676 677
		return -EOPNOTSUPP;

V
Vivien Didelot 已提交
678
	ret = ds->ops->get_mac_eee(ds, p->dp->index, e);
679 680 681
	if (ret)
		return ret;

682
	return phy_ethtool_get_eee(p->phy, e);
683 684
}

685 686 687 688 689
#ifdef CONFIG_NET_POLL_CONTROLLER
static int dsa_slave_netpoll_setup(struct net_device *dev,
				   struct netpoll_info *ni)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
690
	struct net_device *master = dsa_master_netdev(p);
691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726
	struct netpoll *netpoll;
	int err = 0;

	netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL);
	if (!netpoll)
		return -ENOMEM;

	err = __netpoll_setup(netpoll, master);
	if (err) {
		kfree(netpoll);
		goto out;
	}

	p->netpoll = netpoll;
out:
	return err;
}

static void dsa_slave_netpoll_cleanup(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct netpoll *netpoll = p->netpoll;

	if (!netpoll)
		return;

	p->netpoll = NULL;

	__netpoll_free_async(netpoll);
}

static void dsa_slave_poll_controller(struct net_device *dev)
{
}
#endif

727 728 729 730 731
static int dsa_slave_get_phys_port_name(struct net_device *dev,
					char *name, size_t len)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

732
	if (snprintf(name, len, "p%d", p->dp->index) >= len)
733
		return -EINVAL;
734 735 736 737

	return 0;
}

738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756
static struct dsa_mall_tc_entry *
dsa_slave_mall_tc_entry_find(struct dsa_slave_priv *p,
			     unsigned long cookie)
{
	struct dsa_mall_tc_entry *mall_tc_entry;

	list_for_each_entry(mall_tc_entry, &p->mall_tc_list, list)
		if (mall_tc_entry->cookie == cookie)
			return mall_tc_entry;

	return NULL;
}

static int dsa_slave_add_cls_matchall(struct net_device *dev,
				      struct tc_cls_matchall_offload *cls,
				      bool ingress)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_mall_tc_entry *mall_tc_entry;
757
	__be16 protocol = cls->common.protocol;
758 759 760 761 762 763 764 765 766 767 768 769
	struct dsa_switch *ds = p->dp->ds;
	struct net *net = dev_net(dev);
	struct dsa_slave_priv *to_p;
	struct net_device *to_dev;
	const struct tc_action *a;
	int err = -EOPNOTSUPP;
	LIST_HEAD(actions);
	int ifindex;

	if (!ds->ops->port_mirror_add)
		return err;

770
	if (!tcf_exts_has_one_action(cls->exts))
771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840
		return err;

	tcf_exts_to_list(cls->exts, &actions);
	a = list_first_entry(&actions, struct tc_action, list);

	if (is_tcf_mirred_egress_mirror(a) && protocol == htons(ETH_P_ALL)) {
		struct dsa_mall_mirror_tc_entry *mirror;

		ifindex = tcf_mirred_ifindex(a);
		to_dev = __dev_get_by_index(net, ifindex);
		if (!to_dev)
			return -EINVAL;

		if (!dsa_slave_dev_check(to_dev))
			return -EOPNOTSUPP;

		mall_tc_entry = kzalloc(sizeof(*mall_tc_entry), GFP_KERNEL);
		if (!mall_tc_entry)
			return -ENOMEM;

		mall_tc_entry->cookie = cls->cookie;
		mall_tc_entry->type = DSA_PORT_MALL_MIRROR;
		mirror = &mall_tc_entry->mirror;

		to_p = netdev_priv(to_dev);

		mirror->to_local_port = to_p->dp->index;
		mirror->ingress = ingress;

		err = ds->ops->port_mirror_add(ds, p->dp->index, mirror,
					       ingress);
		if (err) {
			kfree(mall_tc_entry);
			return err;
		}

		list_add_tail(&mall_tc_entry->list, &p->mall_tc_list);
	}

	return 0;
}

static void dsa_slave_del_cls_matchall(struct net_device *dev,
				       struct tc_cls_matchall_offload *cls)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_mall_tc_entry *mall_tc_entry;
	struct dsa_switch *ds = p->dp->ds;

	if (!ds->ops->port_mirror_del)
		return;

	mall_tc_entry = dsa_slave_mall_tc_entry_find(p, cls->cookie);
	if (!mall_tc_entry)
		return;

	list_del(&mall_tc_entry->list);

	switch (mall_tc_entry->type) {
	case DSA_PORT_MALL_MIRROR:
		ds->ops->port_mirror_del(ds, p->dp->index,
					 &mall_tc_entry->mirror);
		break;
	default:
		WARN_ON(1);
	}

	kfree(mall_tc_entry);
}

841 842
static int dsa_slave_setup_tc_cls_matchall(struct net_device *dev,
					   struct tc_cls_matchall_offload *cls)
843
{
844 845 846 847 848 849 850 851
	bool ingress;

	if (is_classid_clsact_ingress(cls->common.classid))
		ingress = true;
	else if (is_classid_clsact_egress(cls->common.classid))
		ingress = false;
	else
		return -EOPNOTSUPP;
852

853
	if (cls->common.chain_index)
854
		return -EOPNOTSUPP;
855

856 857
	switch (cls->command) {
	case TC_CLSMATCHALL_REPLACE:
858
		return dsa_slave_add_cls_matchall(dev, cls, ingress);
859 860 861 862 863 864 865 866 867
	case TC_CLSMATCHALL_DESTROY:
		dsa_slave_del_cls_matchall(dev, cls);
		return 0;
	default:
		return -EOPNOTSUPP;
	}
}

static int dsa_slave_setup_tc(struct net_device *dev, enum tc_setup_type type,
868
			      void *type_data)
869
{
870
	switch (type) {
871
	case TC_SETUP_CLSMATCHALL:
872
		return dsa_slave_setup_tc_cls_matchall(dev, type_data);
873
	default:
874
		return -EOPNOTSUPP;
875 876 877
	}
}

878 879 880 881
static void dsa_slave_get_stats64(struct net_device *dev,
				  struct rtnl_link_stats64 *stats)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
882
	struct pcpu_sw_netstats *s;
883
	unsigned int start;
884
	int i;
885 886

	netdev_stats_to_stats64(stats, &dev->stats);
887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903
	for_each_possible_cpu(i) {
		u64 tx_packets, tx_bytes, rx_packets, rx_bytes;

		s = per_cpu_ptr(p->stats64, i);
		do {
			start = u64_stats_fetch_begin_irq(&s->syncp);
			tx_packets = s->tx_packets;
			tx_bytes = s->tx_bytes;
			rx_packets = s->rx_packets;
			rx_bytes = s->rx_bytes;
		} while (u64_stats_fetch_retry_irq(&s->syncp, start));

		stats->tx_packets += tx_packets;
		stats->tx_bytes += tx_bytes;
		stats->rx_packets += rx_packets;
		stats->rx_bytes += rx_bytes;
	}
904 905
}

906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929
static int dsa_slave_get_rxnfc(struct net_device *dev,
			       struct ethtool_rxnfc *nfc, u32 *rule_locs)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_switch *ds = p->dp->ds;

	if (!ds->ops->get_rxnfc)
		return -EOPNOTSUPP;

	return ds->ops->get_rxnfc(ds, p->dp->index, nfc, rule_locs);
}

static int dsa_slave_set_rxnfc(struct net_device *dev,
			       struct ethtool_rxnfc *nfc)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_switch *ds = p->dp->ds;

	if (!ds->ops->set_rxnfc)
		return -EOPNOTSUPP;

	return ds->ops->set_rxnfc(ds, p->dp->index, nfc);
}

930 931
static const struct ethtool_ops dsa_slave_ethtool_ops = {
	.get_drvinfo		= dsa_slave_get_drvinfo,
932 933
	.get_regs_len		= dsa_slave_get_regs_len,
	.get_regs		= dsa_slave_get_regs,
934 935
	.nway_reset		= dsa_slave_nway_reset,
	.get_link		= dsa_slave_get_link,
936 937 938
	.get_eeprom_len		= dsa_slave_get_eeprom_len,
	.get_eeprom		= dsa_slave_get_eeprom,
	.set_eeprom		= dsa_slave_set_eeprom,
939 940 941
	.get_strings		= dsa_slave_get_strings,
	.get_ethtool_stats	= dsa_slave_get_ethtool_stats,
	.get_sset_count		= dsa_slave_get_sset_count,
942 943
	.set_wol		= dsa_slave_set_wol,
	.get_wol		= dsa_slave_get_wol,
944 945
	.set_eee		= dsa_slave_set_eee,
	.get_eee		= dsa_slave_get_eee,
946 947
	.get_link_ksettings	= dsa_slave_get_link_ksettings,
	.set_link_ksettings	= dsa_slave_set_link_ksettings,
948 949
	.get_rxnfc		= dsa_slave_get_rxnfc,
	.set_rxnfc		= dsa_slave_set_rxnfc,
950 951
};

952
static const struct net_device_ops dsa_slave_netdev_ops = {
953 954
	.ndo_open	 	= dsa_slave_open,
	.ndo_stop		= dsa_slave_close,
955
	.ndo_start_xmit		= dsa_slave_xmit,
956 957 958
	.ndo_change_rx_flags	= dsa_slave_change_rx_flags,
	.ndo_set_rx_mode	= dsa_slave_set_rx_mode,
	.ndo_set_mac_address	= dsa_slave_set_mac_address,
959 960
	.ndo_fdb_add		= dsa_legacy_fdb_add,
	.ndo_fdb_del		= dsa_legacy_fdb_del,
961
	.ndo_fdb_dump		= dsa_slave_fdb_dump,
962
	.ndo_do_ioctl		= dsa_slave_ioctl,
N
Nicolas Dichtel 已提交
963
	.ndo_get_iflink		= dsa_slave_get_iflink,
964 965 966 967 968
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_netpoll_setup	= dsa_slave_netpoll_setup,
	.ndo_netpoll_cleanup	= dsa_slave_netpoll_cleanup,
	.ndo_poll_controller	= dsa_slave_poll_controller,
#endif
969
	.ndo_get_phys_port_name	= dsa_slave_get_phys_port_name,
970
	.ndo_setup_tc		= dsa_slave_setup_tc,
971
	.ndo_get_stats64	= dsa_slave_get_stats64,
S
Scott Feldman 已提交
972 973
};

J
Jiri Pirko 已提交
974
static const struct switchdev_ops dsa_slave_switchdev_ops = {
975
	.switchdev_port_attr_get	= dsa_slave_port_attr_get,
976
	.switchdev_port_attr_set	= dsa_slave_port_attr_set,
977 978
	.switchdev_port_obj_add		= dsa_slave_port_obj_add,
	.switchdev_port_obj_del		= dsa_slave_port_obj_del,
979
};
980

981 982 983 984
static struct device_type dsa_type = {
	.name	= "dsa",
};

985 986 987
static void dsa_slave_adjust_link(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
988
	struct dsa_switch *ds = p->dp->ds;
989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005
	unsigned int status_changed = 0;

	if (p->old_link != p->phy->link) {
		status_changed = 1;
		p->old_link = p->phy->link;
	}

	if (p->old_duplex != p->phy->duplex) {
		status_changed = 1;
		p->old_duplex = p->phy->duplex;
	}

	if (p->old_pause != p->phy->pause) {
		status_changed = 1;
		p->old_pause = p->phy->pause;
	}

1006
	if (ds->ops->adjust_link && status_changed)
1007
		ds->ops->adjust_link(ds, p->dp->index, p->phy);
1008

1009 1010 1011 1012
	if (status_changed)
		phy_print_status(p->phy);
}

1013 1014 1015
static int dsa_slave_fixed_link_update(struct net_device *dev,
				       struct fixed_phy_status *status)
{
1016 1017 1018 1019 1020
	struct dsa_slave_priv *p;
	struct dsa_switch *ds;

	if (dev) {
		p = netdev_priv(dev);
1021
		ds = p->dp->ds;
1022
		if (ds->ops->fixed_link_update)
1023
			ds->ops->fixed_link_update(ds, p->dp->index, status);
1024
	}
1025 1026 1027 1028

	return 0;
}

1029
/* slave device setup *******************************************************/
1030
static int dsa_slave_phy_connect(struct dsa_slave_priv *p,
1031 1032
				 struct net_device *slave_dev,
				 int addr)
1033
{
1034
	struct dsa_switch *ds = p->dp->ds;
1035

1036
	p->phy = mdiobus_get_phy(ds->slave_mii_bus, addr);
R
Russell King 已提交
1037 1038
	if (!p->phy) {
		netdev_err(slave_dev, "no phy at %d\n", addr);
1039
		return -ENODEV;
R
Russell King 已提交
1040
	}
1041 1042

	/* Use already configured phy mode */
1043 1044
	if (p->phy_interface == PHY_INTERFACE_MODE_NA)
		p->phy_interface = p->phy->interface;
1045 1046
	return phy_connect_direct(slave_dev, p->phy, dsa_slave_adjust_link,
				  p->phy_interface);
1047 1048
}

1049
static int dsa_slave_phy_setup(struct dsa_slave_priv *p,
1050 1051
				struct net_device *slave_dev)
{
1052
	struct dsa_switch *ds = p->dp->ds;
1053
	struct device_node *phy_dn, *port_dn;
1054
	bool phy_is_fixed = false;
1055
	u32 phy_flags = 0;
1056
	int mode, ret;
1057

1058
	port_dn = p->dp->dn;
1059 1060 1061 1062
	mode = of_get_phy_mode(port_dn);
	if (mode < 0)
		mode = PHY_INTERFACE_MODE_NA;
	p->phy_interface = mode;
1063 1064

	phy_dn = of_parse_phandle(port_dn, "phy-handle", 0);
1065
	if (!phy_dn && of_phy_is_fixed_link(port_dn)) {
1066 1067 1068 1069 1070
		/* In the case of a fixed PHY, the DT node associated
		 * to the fixed PHY is the Port DT node
		 */
		ret = of_phy_register_fixed_link(port_dn);
		if (ret) {
R
Russell King 已提交
1071
			netdev_err(slave_dev, "failed to register fixed PHY: %d\n", ret);
1072
			return ret;
1073
		}
1074
		phy_is_fixed = true;
1075
		phy_dn = of_node_get(port_dn);
1076 1077
	}

1078
	if (ds->ops->get_phy_flags)
1079
		phy_flags = ds->ops->get_phy_flags(ds, p->dp->index);
1080

1081
	if (phy_dn) {
R
Russell King 已提交
1082 1083
		int phy_id = of_mdio_parse_addr(&slave_dev->dev, phy_dn);

1084 1085 1086 1087 1088
		/* If this PHY address is part of phys_mii_mask, which means
		 * that we need to divert reads and writes to/from it, then we
		 * want to bind this device using the slave MII bus created by
		 * DSA to make that happen.
		 */
R
Russell King 已提交
1089 1090 1091 1092 1093
		if (!phy_is_fixed && phy_id >= 0 &&
		    (ds->phys_mii_mask & (1 << phy_id))) {
			ret = dsa_slave_phy_connect(p, slave_dev, phy_id);
			if (ret) {
				netdev_err(slave_dev, "failed to connect to phy%d: %d\n", phy_id, ret);
1094
				of_node_put(phy_dn);
1095
				return ret;
R
Russell King 已提交
1096
			}
1097 1098 1099 1100 1101 1102
		} else {
			p->phy = of_phy_connect(slave_dev, phy_dn,
						dsa_slave_adjust_link,
						phy_flags,
						p->phy_interface);
		}
1103 1104

		of_node_put(phy_dn);
1105
	}
1106

1107 1108 1109
	if (p->phy && phy_is_fixed)
		fixed_phy_set_link_update(p->phy, dsa_slave_fixed_link_update);

1110 1111 1112
	/* We could not connect to a designated PHY, so use the switch internal
	 * MDIO bus instead
	 */
1113
	if (!p->phy) {
1114
		ret = dsa_slave_phy_connect(p, slave_dev, p->dp->index);
R
Russell King 已提交
1115
		if (ret) {
1116 1117
			netdev_err(slave_dev, "failed to connect to port %d: %d\n",
				   p->dp->index, ret);
1118 1119
			if (phy_is_fixed)
				of_phy_deregister_fixed_link(port_dn);
1120
			return ret;
R
Russell King 已提交
1121
		}
1122
	}
1123

1124 1125
	phy_attached_info(p->phy);

1126
	return 0;
1127 1128
}

1129 1130 1131 1132 1133 1134 1135 1136 1137
static struct lock_class_key dsa_slave_netdev_xmit_lock_key;
static void dsa_slave_set_lockdep_class_one(struct net_device *dev,
					    struct netdev_queue *txq,
					    void *_unused)
{
	lockdep_set_class(&txq->_xmit_lock,
			  &dsa_slave_netdev_xmit_lock_key);
}

1138 1139 1140 1141
int dsa_slave_suspend(struct net_device *slave_dev)
{
	struct dsa_slave_priv *p = netdev_priv(slave_dev);

1142 1143
	netif_device_detach(slave_dev);

1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168
	if (p->phy) {
		phy_stop(p->phy);
		p->old_pause = -1;
		p->old_link = -1;
		p->old_duplex = -1;
		phy_suspend(p->phy);
	}

	return 0;
}

int dsa_slave_resume(struct net_device *slave_dev)
{
	struct dsa_slave_priv *p = netdev_priv(slave_dev);

	netif_device_attach(slave_dev);

	if (p->phy) {
		phy_resume(p->phy);
		phy_start(p->phy);
	}

	return 0;
}

1169
int dsa_slave_create(struct dsa_port *port, const char *name)
1170
{
1171
	struct dsa_switch *ds = port->ds;
1172
	struct dsa_switch_tree *dst = ds->dst;
1173
	struct net_device *master;
1174 1175
	struct net_device *slave_dev;
	struct dsa_slave_priv *p;
1176
	struct dsa_port *cpu_dp;
1177 1178
	int ret;

1179 1180
	cpu_dp = ds->dst->cpu_dp;
	master = cpu_dp->netdev;
1181

1182 1183 1184 1185 1186 1187
	if (!ds->num_tx_queues)
		ds->num_tx_queues = 1;

	slave_dev = alloc_netdev_mqs(sizeof(struct dsa_slave_priv), name,
				     NET_NAME_UNKNOWN, ether_setup,
				     ds->num_tx_queues, 1);
1188
	if (slave_dev == NULL)
1189
		return -ENOMEM;
1190

1191 1192
	slave_dev->features = master->vlan_features | NETIF_F_HW_TC;
	slave_dev->hw_features |= NETIF_F_HW_TC;
1193
	slave_dev->ethtool_ops = &dsa_slave_ethtool_ops;
1194
	eth_hw_addr_inherit(slave_dev, master);
1195
	slave_dev->priv_flags |= IFF_NO_QUEUE;
1196
	slave_dev->netdev_ops = &dsa_slave_netdev_ops;
J
Jiri Pirko 已提交
1197
	slave_dev->switchdev_ops = &dsa_slave_switchdev_ops;
1198 1199
	slave_dev->min_mtu = 0;
	slave_dev->max_mtu = ETH_MAX_MTU;
1200
	SET_NETDEV_DEVTYPE(slave_dev, &dsa_type);
1201

1202 1203 1204
	netdev_for_each_tx_queue(slave_dev, dsa_slave_set_lockdep_class_one,
				 NULL);

1205 1206
	SET_NETDEV_DEV(slave_dev, port->ds->dev);
	slave_dev->dev.of_node = port->dn;
1207 1208 1209
	slave_dev->vlan_features = master->vlan_features;

	p = netdev_priv(slave_dev);
1210 1211 1212 1213 1214
	p->stats64 = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
	if (!p->stats64) {
		free_netdev(slave_dev);
		return -ENOMEM;
	}
1215
	p->dp = port;
1216
	INIT_LIST_HEAD(&p->mall_tc_list);
1217
	p->xmit = dst->tag_ops->xmit;
1218

1219 1220 1221 1222
	p->old_pause = -1;
	p->old_link = -1;
	p->old_duplex = -1;

1223
	port->netdev = slave_dev;
1224 1225
	ret = register_netdev(slave_dev);
	if (ret) {
1226 1227
		netdev_err(master, "error %d registering interface %s\n",
			   ret, slave_dev->name);
1228
		port->netdev = NULL;
1229
		free_percpu(p->stats64);
1230
		free_netdev(slave_dev);
1231
		return ret;
1232 1233 1234 1235
	}

	netif_carrier_off(slave_dev);

A
Andrew Lunn 已提交
1236 1237 1238
	ret = dsa_slave_phy_setup(p, slave_dev);
	if (ret) {
		netdev_err(master, "error %d setting up slave phy\n", ret);
1239
		unregister_netdev(slave_dev);
1240
		free_percpu(p->stats64);
A
Andrew Lunn 已提交
1241 1242 1243 1244
		free_netdev(slave_dev);
		return ret;
	}

1245
	return 0;
1246
}
1247

1248 1249 1250
void dsa_slave_destroy(struct net_device *slave_dev)
{
	struct dsa_slave_priv *p = netdev_priv(slave_dev);
1251 1252
	struct device_node *port_dn;

1253
	port_dn = p->dp->dn;
1254 1255

	netif_carrier_off(slave_dev);
1256
	if (p->phy) {
1257
		phy_disconnect(p->phy);
1258 1259 1260 1261

		if (of_phy_is_fixed_link(port_dn))
			of_phy_deregister_fixed_link(port_dn);
	}
1262
	unregister_netdev(slave_dev);
1263
	free_percpu(p->stats64);
1264 1265 1266
	free_netdev(slave_dev);
}

1267 1268 1269 1270 1271
static bool dsa_slave_dev_check(struct net_device *dev)
{
	return dev->netdev_ops == &dsa_slave_netdev_ops;
}

1272 1273
static int dsa_slave_changeupper(struct net_device *dev,
				 struct netdev_notifier_changeupper_info *info)
1274
{
1275 1276
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_port *dp = p->dp;
1277
	int err = NOTIFY_DONE;
1278

1279 1280
	if (netif_is_bridge_master(info->upper_dev)) {
		if (info->linking) {
1281
			err = dsa_port_bridge_join(dp, info->upper_dev);
1282 1283
			err = notifier_from_errno(err);
		} else {
1284
			dsa_port_bridge_leave(dp, info->upper_dev);
1285
			err = NOTIFY_OK;
1286 1287
		}
	}
1288

1289
	return err;
1290
}
1291

1292 1293
static int dsa_slave_netdevice_event(struct notifier_block *nb,
				     unsigned long event, void *ptr)
1294 1295 1296
{
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);

1297 1298 1299 1300 1301
	if (dev->netdev_ops != &dsa_slave_netdev_ops)
		return NOTIFY_DONE;

	if (event == NETDEV_CHANGEUPPER)
		return dsa_slave_changeupper(dev, ptr);
1302 1303 1304

	return NOTIFY_DONE;
}
1305

1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406
struct dsa_switchdev_event_work {
	struct work_struct work;
	struct switchdev_notifier_fdb_info fdb_info;
	struct net_device *dev;
	unsigned long event;
};

static void dsa_slave_switchdev_event_work(struct work_struct *work)
{
	struct dsa_switchdev_event_work *switchdev_work =
		container_of(work, struct dsa_switchdev_event_work, work);
	struct net_device *dev = switchdev_work->dev;
	struct switchdev_notifier_fdb_info *fdb_info;
	struct dsa_slave_priv *p = netdev_priv(dev);
	int err;

	rtnl_lock();
	switch (switchdev_work->event) {
	case SWITCHDEV_FDB_ADD_TO_DEVICE:
		fdb_info = &switchdev_work->fdb_info;
		err = dsa_port_fdb_add(p->dp, fdb_info->addr, fdb_info->vid);
		if (err) {
			netdev_dbg(dev, "fdb add failed err=%d\n", err);
			break;
		}
		call_switchdev_notifiers(SWITCHDEV_FDB_OFFLOADED, dev,
					 &fdb_info->info);
		break;

	case SWITCHDEV_FDB_DEL_TO_DEVICE:
		fdb_info = &switchdev_work->fdb_info;
		err = dsa_port_fdb_del(p->dp, fdb_info->addr, fdb_info->vid);
		if (err) {
			netdev_dbg(dev, "fdb del failed err=%d\n", err);
			dev_close(dev);
		}
		break;
	}
	rtnl_unlock();

	kfree(switchdev_work->fdb_info.addr);
	kfree(switchdev_work);
	dev_put(dev);
}

static int
dsa_slave_switchdev_fdb_work_init(struct dsa_switchdev_event_work *
				  switchdev_work,
				  const struct switchdev_notifier_fdb_info *
				  fdb_info)
{
	memcpy(&switchdev_work->fdb_info, fdb_info,
	       sizeof(switchdev_work->fdb_info));
	switchdev_work->fdb_info.addr = kzalloc(ETH_ALEN, GFP_ATOMIC);
	if (!switchdev_work->fdb_info.addr)
		return -ENOMEM;
	ether_addr_copy((u8 *)switchdev_work->fdb_info.addr,
			fdb_info->addr);
	return 0;
}

/* Called under rcu_read_lock() */
static int dsa_slave_switchdev_event(struct notifier_block *unused,
				     unsigned long event, void *ptr)
{
	struct net_device *dev = switchdev_notifier_info_to_dev(ptr);
	struct dsa_switchdev_event_work *switchdev_work;

	if (!dsa_slave_dev_check(dev))
		return NOTIFY_DONE;

	switchdev_work = kzalloc(sizeof(*switchdev_work), GFP_ATOMIC);
	if (!switchdev_work)
		return NOTIFY_BAD;

	INIT_WORK(&switchdev_work->work,
		  dsa_slave_switchdev_event_work);
	switchdev_work->dev = dev;
	switchdev_work->event = event;

	switch (event) {
	case SWITCHDEV_FDB_ADD_TO_DEVICE: /* fall through */
	case SWITCHDEV_FDB_DEL_TO_DEVICE:
		if (dsa_slave_switchdev_fdb_work_init(switchdev_work,
						      ptr))
			goto err_fdb_work_init;
		dev_hold(dev);
		break;
	default:
		kfree(switchdev_work);
		return NOTIFY_DONE;
	}

	dsa_schedule_work(&switchdev_work->work);
	return NOTIFY_OK;

err_fdb_work_init:
	kfree(switchdev_work);
	return NOTIFY_BAD;
}

1407
static struct notifier_block dsa_slave_nb __read_mostly = {
1408 1409 1410 1411 1412
	.notifier_call  = dsa_slave_netdevice_event,
};

static struct notifier_block dsa_slave_switchdev_notifier = {
	.notifier_call = dsa_slave_switchdev_event,
1413 1414 1415 1416
};

int dsa_slave_register_notifier(void)
{
1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431
	int err;

	err = register_netdevice_notifier(&dsa_slave_nb);
	if (err)
		return err;

	err = register_switchdev_notifier(&dsa_slave_switchdev_notifier);
	if (err)
		goto err_switchdev_nb;

	return 0;

err_switchdev_nb:
	unregister_netdevice_notifier(&dsa_slave_nb);
	return err;
1432 1433 1434 1435 1436 1437
}

void dsa_slave_unregister_notifier(void)
{
	int err;

1438 1439 1440 1441
	err = unregister_switchdev_notifier(&dsa_slave_switchdev_notifier);
	if (err)
		pr_err("DSA: failed to unregister switchdev notifier (%d)\n", err);

1442 1443 1444 1445
	err = unregister_netdevice_notifier(&dsa_slave_nb);
	if (err)
		pr_err("DSA: failed to unregister slave notifier (%d)\n", err);
}