2 * Handling of a single switch port
4 * Copyright (c) 2017 Savoir-faire Linux Inc.
5 * Vivien Didelot <vivien.didelot@savoirfairelinux.com>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
13 #include <linux/if_bridge.h>
14 #include <linux/notifier.h>
15 #include <linux/of_mdio.h>
16 #include <linux/of_net.h>
20 static int dsa_port_notify(const struct dsa_port *dp, unsigned long e, void *v)
22 struct raw_notifier_head *nh = &dp->ds->dst->nh;
25 err = raw_notifier_call_chain(nh, e, v);
27 return notifier_to_errno(err);
30 int dsa_port_set_state(struct dsa_port *dp, u8 state,
31 struct switchdev_trans *trans)
33 struct dsa_switch *ds = dp->ds;
36 if (switchdev_trans_ph_prepare(trans))
37 return ds->ops->port_stp_state_set ? 0 : -EOPNOTSUPP;
39 if (ds->ops->port_stp_state_set)
40 ds->ops->port_stp_state_set(ds, port, state);
42 if (ds->ops->port_fast_age) {
43 /* Fast age FDB entries or flush appropriate forwarding database
44 * for the given port, if we are moving it from Learning or
45 * Forwarding state, to Disabled or Blocking or Listening state.
48 if ((dp->stp_state == BR_STATE_LEARNING ||
49 dp->stp_state == BR_STATE_FORWARDING) &&
50 (state == BR_STATE_DISABLED ||
51 state == BR_STATE_BLOCKING ||
52 state == BR_STATE_LISTENING))
53 ds->ops->port_fast_age(ds, port);
56 dp->stp_state = state;
61 static void dsa_port_set_state_now(struct dsa_port *dp, u8 state)
65 err = dsa_port_set_state(dp, state, NULL);
67 pr_err("DSA: failed to set STP state %u (%d)\n", state, err);
70 int dsa_port_enable(struct dsa_port *dp, struct phy_device *phy)
72 struct dsa_switch *ds = dp->ds;
76 if (ds->ops->port_enable) {
77 err = ds->ops->port_enable(ds, port, phy);
83 dsa_port_set_state_now(dp, BR_STATE_FORWARDING);
88 void dsa_port_disable(struct dsa_port *dp)
90 struct dsa_switch *ds = dp->ds;
94 dsa_port_set_state_now(dp, BR_STATE_DISABLED);
96 if (ds->ops->port_disable)
97 ds->ops->port_disable(ds, port);
100 int dsa_port_bridge_join(struct dsa_port *dp, struct net_device *br)
102 struct dsa_notifier_bridge_info info = {
103 .sw_index = dp->ds->index,
109 /* Set the flooding mode before joining the port in the switch */
110 err = dsa_port_bridge_flags(dp, BR_FLOOD | BR_MCAST_FLOOD, NULL);
114 /* Here the interface is already bridged. Reflect the current
115 * configuration so that drivers can program their chips accordingly.
119 err = dsa_port_notify(dp, DSA_NOTIFIER_BRIDGE_JOIN, &info);
121 /* The bridging is rolled back on error */
123 dsa_port_bridge_flags(dp, 0, NULL);
124 dp->bridge_dev = NULL;
130 void dsa_port_bridge_leave(struct dsa_port *dp, struct net_device *br)
132 struct dsa_notifier_bridge_info info = {
133 .sw_index = dp->ds->index,
139 /* Here the port is already unbridged. Reflect the current configuration
140 * so that drivers can program their chips accordingly.
142 dp->bridge_dev = NULL;
144 err = dsa_port_notify(dp, DSA_NOTIFIER_BRIDGE_LEAVE, &info);
146 pr_err("DSA: failed to notify DSA_NOTIFIER_BRIDGE_LEAVE\n");
148 /* Port is leaving the bridge, disable flooding */
149 dsa_port_bridge_flags(dp, 0, NULL);
151 /* Port left the bridge, put in BR_STATE_DISABLED by the bridge layer,
152 * so allow it to be in BR_STATE_FORWARDING to be kept functional
154 dsa_port_set_state_now(dp, BR_STATE_FORWARDING);
157 static bool dsa_port_can_apply_vlan_filtering(struct dsa_port *dp,
160 struct dsa_switch *ds = dp->ds;
163 if (!ds->vlan_filtering_is_global)
166 /* For cases where enabling/disabling VLAN awareness is global to the
167 * switch, we need to handle the case where multiple bridges span
168 * different ports of the same switch device and one of them has a
169 * different setting than what is being requested.
171 for (i = 0; i < ds->num_ports; i++) {
172 struct net_device *other_bridge;
174 other_bridge = dsa_to_port(ds, i)->bridge_dev;
177 /* If it's the same bridge, it also has same
178 * vlan_filtering setting => no need to check
180 if (other_bridge == dp->bridge_dev)
182 if (br_vlan_enabled(other_bridge) != vlan_filtering) {
183 dev_err(ds->dev, "VLAN filtering is a global setting\n");
190 int dsa_port_vlan_filtering(struct dsa_port *dp, bool vlan_filtering,
191 struct switchdev_trans *trans)
193 struct dsa_switch *ds = dp->ds;
196 /* bridge skips -EOPNOTSUPP, so skip the prepare phase */
197 if (switchdev_trans_ph_prepare(trans))
200 if (!ds->ops->port_vlan_filtering)
203 if (!dsa_port_can_apply_vlan_filtering(dp, vlan_filtering))
206 if (dsa_port_is_vlan_filtering(dp) == vlan_filtering)
209 err = ds->ops->port_vlan_filtering(ds, dp->index,
214 if (ds->vlan_filtering_is_global)
215 ds->vlan_filtering = vlan_filtering;
217 dp->vlan_filtering = vlan_filtering;
221 int dsa_port_ageing_time(struct dsa_port *dp, clock_t ageing_clock,
222 struct switchdev_trans *trans)
224 unsigned long ageing_jiffies = clock_t_to_jiffies(ageing_clock);
225 unsigned int ageing_time = jiffies_to_msecs(ageing_jiffies);
226 struct dsa_notifier_ageing_time_info info = {
227 .ageing_time = ageing_time,
231 if (switchdev_trans_ph_prepare(trans))
232 return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info);
234 dp->ageing_time = ageing_time;
236 return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info);
239 int dsa_port_pre_bridge_flags(const struct dsa_port *dp, unsigned long flags,
240 struct switchdev_trans *trans)
242 struct dsa_switch *ds = dp->ds;
244 if (!ds->ops->port_egress_floods ||
245 (flags & ~(BR_FLOOD | BR_MCAST_FLOOD)))
251 int dsa_port_bridge_flags(const struct dsa_port *dp, unsigned long flags,
252 struct switchdev_trans *trans)
254 struct dsa_switch *ds = dp->ds;
255 int port = dp->index;
258 if (switchdev_trans_ph_prepare(trans))
261 if (ds->ops->port_egress_floods)
262 err = ds->ops->port_egress_floods(ds, port, flags & BR_FLOOD,
263 flags & BR_MCAST_FLOOD);
268 int dsa_port_fdb_add(struct dsa_port *dp, const unsigned char *addr,
271 struct dsa_notifier_fdb_info info = {
272 .sw_index = dp->ds->index,
278 return dsa_port_notify(dp, DSA_NOTIFIER_FDB_ADD, &info);
281 int dsa_port_fdb_del(struct dsa_port *dp, const unsigned char *addr,
284 struct dsa_notifier_fdb_info info = {
285 .sw_index = dp->ds->index,
292 return dsa_port_notify(dp, DSA_NOTIFIER_FDB_DEL, &info);
295 int dsa_port_fdb_dump(struct dsa_port *dp, dsa_fdb_dump_cb_t *cb, void *data)
297 struct dsa_switch *ds = dp->ds;
298 int port = dp->index;
300 if (!ds->ops->port_fdb_dump)
303 return ds->ops->port_fdb_dump(ds, port, cb, data);
306 int dsa_port_mdb_add(const struct dsa_port *dp,
307 const struct switchdev_obj_port_mdb *mdb,
308 struct switchdev_trans *trans)
310 struct dsa_notifier_mdb_info info = {
311 .sw_index = dp->ds->index,
317 return dsa_port_notify(dp, DSA_NOTIFIER_MDB_ADD, &info);
320 int dsa_port_mdb_del(const struct dsa_port *dp,
321 const struct switchdev_obj_port_mdb *mdb)
323 struct dsa_notifier_mdb_info info = {
324 .sw_index = dp->ds->index,
329 return dsa_port_notify(dp, DSA_NOTIFIER_MDB_DEL, &info);
332 int dsa_port_vlan_add(struct dsa_port *dp,
333 const struct switchdev_obj_port_vlan *vlan,
334 struct switchdev_trans *trans)
336 struct dsa_notifier_vlan_info info = {
337 .sw_index = dp->ds->index,
343 /* Can be called from dsa_slave_port_obj_add() or
344 * dsa_slave_vlan_rx_add_vid()
346 if (!dp->bridge_dev || br_vlan_enabled(dp->bridge_dev))
347 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_ADD, &info);
352 int dsa_port_vlan_del(struct dsa_port *dp,
353 const struct switchdev_obj_port_vlan *vlan)
355 struct dsa_notifier_vlan_info info = {
356 .sw_index = dp->ds->index,
361 if (vlan->obj.orig_dev && netif_is_bridge_master(vlan->obj.orig_dev))
364 /* Can be called from dsa_slave_port_obj_del() or
365 * dsa_slave_vlan_rx_kill_vid()
367 if (!dp->bridge_dev || br_vlan_enabled(dp->bridge_dev))
368 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info);
373 int dsa_port_vid_add(struct dsa_port *dp, u16 vid, u16 flags)
375 struct switchdev_obj_port_vlan vlan = {
376 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
381 struct switchdev_trans trans;
384 trans.ph_prepare = true;
385 err = dsa_port_vlan_add(dp, &vlan, &trans);
386 if (err == -EOPNOTSUPP)
389 trans.ph_prepare = false;
390 return dsa_port_vlan_add(dp, &vlan, &trans);
392 EXPORT_SYMBOL(dsa_port_vid_add);
394 int dsa_port_vid_del(struct dsa_port *dp, u16 vid)
396 struct switchdev_obj_port_vlan vlan = {
397 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
402 return dsa_port_vlan_del(dp, &vlan);
404 EXPORT_SYMBOL(dsa_port_vid_del);
406 static struct phy_device *dsa_port_get_phy_device(struct dsa_port *dp)
408 struct device_node *phy_dn;
409 struct phy_device *phydev;
411 phy_dn = of_parse_phandle(dp->dn, "phy-handle", 0);
415 phydev = of_phy_find_device(phy_dn);
418 return ERR_PTR(-EPROBE_DEFER);
425 void dsa_port_phylink_validate(struct phylink_config *config,
426 unsigned long *supported,
427 struct phylink_link_state *state)
429 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
430 struct dsa_switch *ds = dp->ds;
432 if (!ds->ops->phylink_validate)
435 ds->ops->phylink_validate(ds, dp->index, supported, state);
437 EXPORT_SYMBOL_GPL(dsa_port_phylink_validate);
439 int dsa_port_phylink_mac_link_state(struct phylink_config *config,
440 struct phylink_link_state *state)
442 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
443 struct dsa_switch *ds = dp->ds;
445 /* Only called for SGMII and 802.3z */
446 if (!ds->ops->phylink_mac_link_state)
449 return ds->ops->phylink_mac_link_state(ds, dp->index, state);
451 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_link_state);
453 void dsa_port_phylink_mac_config(struct phylink_config *config,
455 const struct phylink_link_state *state)
457 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
458 struct dsa_switch *ds = dp->ds;
460 if (!ds->ops->phylink_mac_config)
463 ds->ops->phylink_mac_config(ds, dp->index, mode, state);
465 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_config);
467 void dsa_port_phylink_mac_an_restart(struct phylink_config *config)
469 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
470 struct dsa_switch *ds = dp->ds;
472 if (!ds->ops->phylink_mac_an_restart)
475 ds->ops->phylink_mac_an_restart(ds, dp->index);
477 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_an_restart);
479 void dsa_port_phylink_mac_link_down(struct phylink_config *config,
481 phy_interface_t interface)
483 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
484 struct phy_device *phydev = NULL;
485 struct dsa_switch *ds = dp->ds;
487 if (dsa_is_user_port(ds, dp->index))
488 phydev = dp->slave->phydev;
490 if (!ds->ops->phylink_mac_link_down) {
491 if (ds->ops->adjust_link && phydev)
492 ds->ops->adjust_link(ds, dp->index, phydev);
496 ds->ops->phylink_mac_link_down(ds, dp->index, mode, interface);
498 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_link_down);
500 void dsa_port_phylink_mac_link_up(struct phylink_config *config,
502 phy_interface_t interface,
503 struct phy_device *phydev)
505 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
506 struct dsa_switch *ds = dp->ds;
508 if (!ds->ops->phylink_mac_link_up) {
509 if (ds->ops->adjust_link && phydev)
510 ds->ops->adjust_link(ds, dp->index, phydev);
514 ds->ops->phylink_mac_link_up(ds, dp->index, mode, interface, phydev);
516 EXPORT_SYMBOL_GPL(dsa_port_phylink_mac_link_up);
518 const struct phylink_mac_ops dsa_port_phylink_mac_ops = {
519 .validate = dsa_port_phylink_validate,
520 .mac_link_state = dsa_port_phylink_mac_link_state,
521 .mac_config = dsa_port_phylink_mac_config,
522 .mac_an_restart = dsa_port_phylink_mac_an_restart,
523 .mac_link_down = dsa_port_phylink_mac_link_down,
524 .mac_link_up = dsa_port_phylink_mac_link_up,
527 static int dsa_port_setup_phy_of(struct dsa_port *dp, bool enable)
529 struct dsa_switch *ds = dp->ds;
530 struct phy_device *phydev;
531 int port = dp->index;
534 phydev = dsa_port_get_phy_device(dp);
539 return PTR_ERR(phydev);
542 err = genphy_config_init(phydev);
546 err = genphy_resume(phydev);
550 err = genphy_read_status(phydev);
554 err = genphy_suspend(phydev);
559 if (ds->ops->adjust_link)
560 ds->ops->adjust_link(ds, port, phydev);
562 dev_dbg(ds->dev, "enabled port's phy: %s", phydev_name(phydev));
565 put_device(&phydev->mdio.dev);
569 static int dsa_port_fixed_link_register_of(struct dsa_port *dp)
571 struct device_node *dn = dp->dn;
572 struct dsa_switch *ds = dp->ds;
573 struct phy_device *phydev;
574 int port = dp->index;
578 err = of_phy_register_fixed_link(dn);
581 "failed to register the fixed PHY of port %d\n",
586 phydev = of_phy_find_device(dn);
588 mode = of_get_phy_mode(dn);
590 mode = PHY_INTERFACE_MODE_NA;
591 phydev->interface = mode;
593 genphy_config_init(phydev);
594 genphy_read_status(phydev);
596 if (ds->ops->adjust_link)
597 ds->ops->adjust_link(ds, port, phydev);
599 put_device(&phydev->mdio.dev);
604 static int dsa_port_phylink_register(struct dsa_port *dp)
606 struct dsa_switch *ds = dp->ds;
607 struct device_node *port_dn = dp->dn;
610 mode = of_get_phy_mode(port_dn);
612 mode = PHY_INTERFACE_MODE_NA;
614 dp->pl_config.dev = ds->dev;
615 dp->pl_config.type = PHYLINK_DEV;
617 dp->pl = phylink_create(&dp->pl_config, of_fwnode_handle(port_dn),
618 mode, &dsa_port_phylink_mac_ops);
619 if (IS_ERR(dp->pl)) {
620 pr_err("error creating PHYLINK: %ld\n", PTR_ERR(dp->pl));
621 return PTR_ERR(dp->pl);
624 err = phylink_of_phy_connect(dp->pl, port_dn, 0);
626 pr_err("could not attach to PHY: %d\n", err);
627 goto err_phy_connect;
631 phylink_start(dp->pl);
637 phylink_destroy(dp->pl);
641 int dsa_port_link_register_of(struct dsa_port *dp)
643 struct dsa_switch *ds = dp->ds;
645 if (!ds->ops->adjust_link)
646 return dsa_port_phylink_register(dp);
649 "Using legacy PHYLIB callbacks. Please migrate to PHYLINK!\n");
651 if (of_phy_is_fixed_link(dp->dn))
652 return dsa_port_fixed_link_register_of(dp);
654 return dsa_port_setup_phy_of(dp, true);
657 void dsa_port_link_unregister_of(struct dsa_port *dp)
659 struct dsa_switch *ds = dp->ds;
661 if (!ds->ops->adjust_link) {
663 phylink_disconnect_phy(dp->pl);
665 phylink_destroy(dp->pl);
669 if (of_phy_is_fixed_link(dp->dn))
670 of_phy_deregister_fixed_link(dp->dn);
672 dsa_port_setup_phy_of(dp, false);
675 int dsa_port_get_phy_strings(struct dsa_port *dp, uint8_t *data)
677 struct phy_device *phydev;
678 int ret = -EOPNOTSUPP;
680 if (of_phy_is_fixed_link(dp->dn))
683 phydev = dsa_port_get_phy_device(dp);
684 if (IS_ERR_OR_NULL(phydev))
687 ret = phy_ethtool_get_strings(phydev, data);
688 put_device(&phydev->mdio.dev);
692 EXPORT_SYMBOL_GPL(dsa_port_get_phy_strings);
694 int dsa_port_get_ethtool_phy_stats(struct dsa_port *dp, uint64_t *data)
696 struct phy_device *phydev;
697 int ret = -EOPNOTSUPP;
699 if (of_phy_is_fixed_link(dp->dn))
702 phydev = dsa_port_get_phy_device(dp);
703 if (IS_ERR_OR_NULL(phydev))
706 ret = phy_ethtool_get_stats(phydev, NULL, data);
707 put_device(&phydev->mdio.dev);
711 EXPORT_SYMBOL_GPL(dsa_port_get_ethtool_phy_stats);
713 int dsa_port_get_phy_sset_count(struct dsa_port *dp)
715 struct phy_device *phydev;
716 int ret = -EOPNOTSUPP;
718 if (of_phy_is_fixed_link(dp->dn))
721 phydev = dsa_port_get_phy_device(dp);
722 if (IS_ERR_OR_NULL(phydev))
725 ret = phy_ethtool_get_sset_count(phydev);
726 put_device(&phydev->mdio.dev);
730 EXPORT_SYMBOL_GPL(dsa_port_get_phy_sset_count);