net/dsa/port.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Handling of a single switch port
   4  *
   5  * Copyright (c) 2017 Savoir-faire Linux Inc.
   6  *      Vivien Didelot <vivien.didelot@savoirfairelinux.com>
   7  */
   8
   9 #include <linux/if_bridge.h>
  10 #include <linux/netdevice.h>
  11 #include <linux/notifier.h>
  12 #include <linux/of_mdio.h>
  13 #include <linux/of_net.h>
  14
  15 #include "dsa.h"
  16 #include "port.h"
  17 #include "switch.h"
  18 #include "tag_8021q.h"
  19 #include "user.h"
  20
  21 /**
  22  * dsa_port_notify - Notify the switching fabric of changes to a port
  23  * @dp: port on which change occurred
  24  * @e: event, must be of type DSA_NOTIFIER_*
  25  * @v: event-specific value.
  26  *
  27  * Notify all switches in the DSA tree that this port's switch belongs to,
  28  * including this switch itself, of an event. Allows the other switches to
  29  * reconfigure themselves for cross-chip operations. Can also be used to
  30  * reconfigure ports without net_devices (CPU ports, DSA links) whenever
  31  * a user port's state changes.
  32  */
  33 static int dsa_port_notify(const struct dsa_port *dp, unsigned long e, void *v)
  34 {
  35         return dsa_tree_notify(dp->ds->dst, e, v);
  36 }
  37
  38 static void dsa_port_notify_bridge_fdb_flush(const struct dsa_port *dp, u16 vid)
  39 {
  40         struct net_device *brport_dev = dsa_port_to_bridge_port(dp);
  41         struct switchdev_notifier_fdb_info info = {
  42                 .vid = vid,
  43         };
  44
  45         /* When the port becomes standalone it has already left the bridge.
  46          * Don't notify the bridge in that case.
  47          */
  48         if (!brport_dev)
  49                 return;
  50
  51         call_switchdev_notifiers(SWITCHDEV_FDB_FLUSH_TO_BRIDGE,
  52                                  brport_dev, &info.info, NULL);
  53 }
  54
  55 static void dsa_port_fast_age(const struct dsa_port *dp)
  56 {
  57         struct dsa_switch *ds = dp->ds;
  58
  59         if (!ds->ops->port_fast_age)
  60                 return;
  61
  62         ds->ops->port_fast_age(ds, dp->index);
  63
  64         /* flush all VLANs */
  65         dsa_port_notify_bridge_fdb_flush(dp, 0);
  66 }
  67
  68 static int dsa_port_vlan_fast_age(const struct dsa_port *dp, u16 vid)
  69 {
  70         struct dsa_switch *ds = dp->ds;
  71         int err;
  72
  73         if (!ds->ops->port_vlan_fast_age)
  74                 return -EOPNOTSUPP;
  75
  76         err = ds->ops->port_vlan_fast_age(ds, dp->index, vid);
  77
  78         if (!err)
  79                 dsa_port_notify_bridge_fdb_flush(dp, vid);
  80
  81         return err;
  82 }
  83
  84 static int dsa_port_msti_fast_age(const struct dsa_port *dp, u16 msti)
  85 {
  86         DECLARE_BITMAP(vids, VLAN_N_VID) = { 0 };
  87         int err, vid;
  88
  89         err = br_mst_get_info(dsa_port_bridge_dev_get(dp), msti, vids);
  90         if (err)
  91                 return err;
  92
  93         for_each_set_bit(vid, vids, VLAN_N_VID) {
  94                 err = dsa_port_vlan_fast_age(dp, vid);
  95                 if (err)
  96                         return err;
  97         }
  98
  99         return 0;
 100 }
 101
 102 static bool dsa_port_can_configure_learning(struct dsa_port *dp)
 103 {
 104         struct switchdev_brport_flags flags = {
 105                 .mask = BR_LEARNING,
 106         };
 107         struct dsa_switch *ds = dp->ds;
 108         int err;
 109
 110         if (!ds->ops->port_bridge_flags || !ds->ops->port_pre_bridge_flags)
 111                 return false;
 112
 113         err = ds->ops->port_pre_bridge_flags(ds, dp->index, flags, NULL);
 114         return !err;
 115 }
 116
 117 bool dsa_port_supports_hwtstamp(struct dsa_port *dp)
 118 {
 119         struct dsa_switch *ds = dp->ds;
 120         struct ifreq ifr = {};
 121         int err;
 122
 123         if (!ds->ops->port_hwtstamp_get || !ds->ops->port_hwtstamp_set)
 124                 return false;
 125
 126         /* "See through" shim implementations of the "get" method.
 127          * Since we can't cook up a complete ioctl request structure, this will
 128          * fail in copy_to_user() with -EFAULT, which hopefully is enough to
 129          * detect a valid implementation.
 130          */
 131         err = ds->ops->port_hwtstamp_get(ds, dp->index, &ifr);
 132         return err != -EOPNOTSUPP;
 133 }
 134
 135 int dsa_port_set_state(struct dsa_port *dp, u8 state, bool do_fast_age)
 136 {
 137         struct dsa_switch *ds = dp->ds;
 138         int port = dp->index;
 139
 140         if (!ds->ops->port_stp_state_set)
 141                 return -EOPNOTSUPP;
 142
 143         ds->ops->port_stp_state_set(ds, port, state);
 144
 145         if (!dsa_port_can_configure_learning(dp) ||
 146             (do_fast_age && dp->learning)) {
 147                 /* Fast age FDB entries or flush appropriate forwarding database
 148                  * for the given port, if we are moving it from Learning or
 149                  * Forwarding state, to Disabled or Blocking or Listening state.
 150                  * Ports that were standalone before the STP state change don't
 151                  * need to fast age the FDB, since address learning is off in
 152                  * standalone mode.
 153                  */
 154
 155                 if ((dp->stp_state == BR_STATE_LEARNING ||
 156                      dp->stp_state == BR_STATE_FORWARDING) &&
 157                     (state == BR_STATE_DISABLED ||
 158                      state == BR_STATE_BLOCKING ||
 159                      state == BR_STATE_LISTENING))
 160                         dsa_port_fast_age(dp);
 161         }
 162
 163         dp->stp_state = state;
 164
 165         return 0;
 166 }
 167
 168 static void dsa_port_set_state_now(struct dsa_port *dp, u8 state,
 169                                    bool do_fast_age)
 170 {
 171         struct dsa_switch *ds = dp->ds;
 172         int err;
 173
 174         err = dsa_port_set_state(dp, state, do_fast_age);
 175         if (err && err != -EOPNOTSUPP) {
 176                 dev_err(ds->dev, "port %d failed to set STP state %u: %pe\n",
 177                         dp->index, state, ERR_PTR(err));
 178         }
 179 }
 180
 181 int dsa_port_set_mst_state(struct dsa_port *dp,
 182                            const struct switchdev_mst_state *state,
 183                            struct netlink_ext_ack *extack)
 184 {
 185         struct dsa_switch *ds = dp->ds;
 186         u8 prev_state;
 187         int err;
 188
 189         if (!ds->ops->port_mst_state_set)
 190                 return -EOPNOTSUPP;
 191
 192         err = br_mst_get_state(dsa_port_to_bridge_port(dp), state->msti,
 193                                &prev_state);
 194         if (err)
 195                 return err;
 196
 197         err = ds->ops->port_mst_state_set(ds, dp->index, state);
 198         if (err)
 199                 return err;
 200
 201         if (!(dp->learning &&
 202               (prev_state == BR_STATE_LEARNING ||
 203                prev_state == BR_STATE_FORWARDING) &&
 204               (state->state == BR_STATE_DISABLED ||
 205                state->state == BR_STATE_BLOCKING ||
 206                state->state == BR_STATE_LISTENING)))
 207                 return 0;
 208
 209         err = dsa_port_msti_fast_age(dp, state->msti);
 210         if (err)
 211                 NL_SET_ERR_MSG_MOD(extack,
 212                                    "Unable to flush associated VLANs");
 213
 214         return 0;
 215 }
 216
 217 int dsa_port_enable_rt(struct dsa_port *dp, struct phy_device *phy)
 218 {
 219         struct dsa_switch *ds = dp->ds;
 220         int port = dp->index;
 221         int err;
 222
 223         if (ds->ops->port_enable) {
 224                 err = ds->ops->port_enable(ds, port, phy);
 225                 if (err)
 226                         return err;
 227         }
 228
 229         if (!dp->bridge)
 230                 dsa_port_set_state_now(dp, BR_STATE_FORWARDING, false);
 231
 232         if (dp->pl)
 233                 phylink_start(dp->pl);
 234
 235         return 0;
 236 }
 237
 238 int dsa_port_enable(struct dsa_port *dp, struct phy_device *phy)
 239 {
 240         int err;
 241
 242         rtnl_lock();
 243         err = dsa_port_enable_rt(dp, phy);
 244         rtnl_unlock();
 245
 246         return err;
 247 }
 248
 249 void dsa_port_disable_rt(struct dsa_port *dp)
 250 {
 251         struct dsa_switch *ds = dp->ds;
 252         int port = dp->index;
 253
 254         if (dp->pl)
 255                 phylink_stop(dp->pl);
 256
 257         if (!dp->bridge)
 258                 dsa_port_set_state_now(dp, BR_STATE_DISABLED, false);
 259
 260         if (ds->ops->port_disable)
 261                 ds->ops->port_disable(ds, port);
 262 }
 263
 264 void dsa_port_disable(struct dsa_port *dp)
 265 {
 266         rtnl_lock();
 267         dsa_port_disable_rt(dp);
 268         rtnl_unlock();
 269 }
 270
 271 static void dsa_port_reset_vlan_filtering(struct dsa_port *dp,
 272                                           struct dsa_bridge bridge)
 273 {
 274         struct netlink_ext_ack extack = {0};
 275         bool change_vlan_filtering = false;
 276         struct dsa_switch *ds = dp->ds;
 277         struct dsa_port *other_dp;
 278         bool vlan_filtering;
 279         int err;
 280
 281         if (ds->needs_standalone_vlan_filtering &&
 282             !br_vlan_enabled(bridge.dev)) {
 283                 change_vlan_filtering = true;
 284                 vlan_filtering = true;
 285         } else if (!ds->needs_standalone_vlan_filtering &&
 286                    br_vlan_enabled(bridge.dev)) {
 287                 change_vlan_filtering = true;
 288                 vlan_filtering = false;
 289         }
 290
 291         /* If the bridge was vlan_filtering, the bridge core doesn't trigger an
 292          * event for changing vlan_filtering setting upon user ports leaving
 293          * it. That is a good thing, because that lets us handle it and also
 294          * handle the case where the switch's vlan_filtering setting is global
 295          * (not per port). When that happens, the correct moment to trigger the
 296          * vlan_filtering callback is only when the last port leaves the last
 297          * VLAN-aware bridge.
 298          */
 299         if (change_vlan_filtering && ds->vlan_filtering_is_global) {
 300                 dsa_switch_for_each_port(other_dp, ds) {
 301                         struct net_device *br = dsa_port_bridge_dev_get(other_dp);
 302
 303                         if (br && br_vlan_enabled(br)) {
 304                                 change_vlan_filtering = false;
 305                                 break;
 306                         }
 307                 }
 308         }
 309
 310         if (!change_vlan_filtering)
 311                 return;
 312
 313         err = dsa_port_vlan_filtering(dp, vlan_filtering, &extack);
 314         if (extack._msg) {
 315                 dev_err(ds->dev, "port %d: %s\n", dp->index,
 316                         extack._msg);
 317         }
 318         if (err && err != -EOPNOTSUPP) {
 319                 dev_err(ds->dev,
 320                         "port %d failed to reset VLAN filtering to %d: %pe\n",
 321                        dp->index, vlan_filtering, ERR_PTR(err));
 322         }
 323 }
 324
 325 static int dsa_port_inherit_brport_flags(struct dsa_port *dp,
 326                                          struct netlink_ext_ack *extack)
 327 {
 328         const unsigned long mask = BR_LEARNING | BR_FLOOD | BR_MCAST_FLOOD |
 329                                    BR_BCAST_FLOOD | BR_PORT_LOCKED;
 330         struct net_device *brport_dev = dsa_port_to_bridge_port(dp);
 331         int flag, err;
 332
 333         for_each_set_bit(flag, &mask, 32) {
 334                 struct switchdev_brport_flags flags = {0};
 335
 336                 flags.mask = BIT(flag);
 337
 338                 if (br_port_flag_is_set(brport_dev, BIT(flag)))
 339                         flags.val = BIT(flag);
 340
 341                 err = dsa_port_bridge_flags(dp, flags, extack);
 342                 if (err && err != -EOPNOTSUPP)
 343                         return err;
 344         }
 345
 346         return 0;
 347 }
 348
 349 static void dsa_port_clear_brport_flags(struct dsa_port *dp)
 350 {
 351         const unsigned long val = BR_FLOOD | BR_MCAST_FLOOD | BR_BCAST_FLOOD;
 352         const unsigned long mask = BR_LEARNING | BR_FLOOD | BR_MCAST_FLOOD |
 353                                    BR_BCAST_FLOOD | BR_PORT_LOCKED;
 354         int flag, err;
 355
 356         for_each_set_bit(flag, &mask, 32) {
 357                 struct switchdev_brport_flags flags = {0};
 358
 359                 flags.mask = BIT(flag);
 360                 flags.val = val & BIT(flag);
 361
 362                 err = dsa_port_bridge_flags(dp, flags, NULL);
 363                 if (err && err != -EOPNOTSUPP)
 364                         dev_err(dp->ds->dev,
 365                                 "failed to clear bridge port flag %lu: %pe\n",
 366                                 flags.val, ERR_PTR(err));
 367         }
 368 }
 369
 370 static int dsa_port_switchdev_sync_attrs(struct dsa_port *dp,
 371                                          struct netlink_ext_ack *extack)
 372 {
 373         struct net_device *brport_dev = dsa_port_to_bridge_port(dp);
 374         struct net_device *br = dsa_port_bridge_dev_get(dp);
 375         int err;
 376
 377         err = dsa_port_inherit_brport_flags(dp, extack);
 378         if (err)
 379                 return err;
 380
 381         err = dsa_port_set_state(dp, br_port_get_stp_state(brport_dev), false);
 382         if (err && err != -EOPNOTSUPP)
 383                 return err;
 384
 385         err = dsa_port_vlan_filtering(dp, br_vlan_enabled(br), extack);
 386         if (err && err != -EOPNOTSUPP)
 387                 return err;
 388
 389         err = dsa_port_ageing_time(dp, br_get_ageing_time(br));
 390         if (err && err != -EOPNOTSUPP)
 391                 return err;
 392
 393         return 0;
 394 }
 395
 396 static void dsa_port_switchdev_unsync_attrs(struct dsa_port *dp,
 397                                             struct dsa_bridge bridge)
 398 {
 399         /* Configure the port for standalone mode (no address learning,
 400          * flood everything).
 401          * The bridge only emits SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS events
 402          * when the user requests it through netlink or sysfs, but not
 403          * automatically at port join or leave, so we need to handle resetting
 404          * the brport flags ourselves. But we even prefer it that way, because
 405          * otherwise, some setups might never get the notification they need,
 406          * for example, when a port leaves a LAG that offloads the bridge,
 407          * it becomes standalone, but as far as the bridge is concerned, no
 408          * port ever left.
 409          */
 410         dsa_port_clear_brport_flags(dp);
 411
 412         /* Port left the bridge, put in BR_STATE_DISABLED by the bridge layer,
 413          * so allow it to be in BR_STATE_FORWARDING to be kept functional
 414          */
 415         dsa_port_set_state_now(dp, BR_STATE_FORWARDING, true);
 416
 417         dsa_port_reset_vlan_filtering(dp, bridge);
 418
 419         /* Ageing time may be global to the switch chip, so don't change it
 420          * here because we have no good reason (or value) to change it to.
 421          */
 422 }
 423
 424 static int dsa_port_bridge_create(struct dsa_port *dp,
 425                                   struct net_device *br,
 426                                   struct netlink_ext_ack *extack)
 427 {
 428         struct dsa_switch *ds = dp->ds;
 429         struct dsa_bridge *bridge;
 430
 431         bridge = dsa_tree_bridge_find(ds->dst, br);
 432         if (bridge) {
 433                 refcount_inc(&bridge->refcount);
 434                 dp->bridge = bridge;
 435                 return 0;
 436         }
 437
 438         bridge = kzalloc(sizeof(*bridge), GFP_KERNEL);
 439         if (!bridge)
 440                 return -ENOMEM;
 441
 442         refcount_set(&bridge->refcount, 1);
 443
 444         bridge->dev = br;
 445
 446         bridge->num = dsa_bridge_num_get(br, ds->max_num_bridges);
 447         if (ds->max_num_bridges && !bridge->num) {
 448                 NL_SET_ERR_MSG_MOD(extack,
 449                                    "Range of offloadable bridges exceeded");
 450                 kfree(bridge);
 451                 return -EOPNOTSUPP;
 452         }
 453
 454         dp->bridge = bridge;
 455
 456         return 0;
 457 }
 458
 459 static void dsa_port_bridge_destroy(struct dsa_port *dp,
 460                                     const struct net_device *br)
 461 {
 462         struct dsa_bridge *bridge = dp->bridge;
 463
 464         dp->bridge = NULL;
 465
 466         if (!refcount_dec_and_test(&bridge->refcount))
 467                 return;
 468
 469         if (bridge->num)
 470                 dsa_bridge_num_put(br, bridge->num);
 471
 472         kfree(bridge);
 473 }
 474
 475 static bool dsa_port_supports_mst(struct dsa_port *dp)
 476 {
 477         struct dsa_switch *ds = dp->ds;
 478
 479         return ds->ops->vlan_msti_set &&
 480                 ds->ops->port_mst_state_set &&
 481                 ds->ops->port_vlan_fast_age &&
 482                 dsa_port_can_configure_learning(dp);
 483 }
 484
 485 int dsa_port_bridge_join(struct dsa_port *dp, struct net_device *br,
 486                          struct netlink_ext_ack *extack)
 487 {
 488         struct dsa_notifier_bridge_info info = {
 489                 .dp = dp,
 490                 .extack = extack,
 491         };
 492         struct net_device *dev = dp->user;
 493         struct net_device *brport_dev;
 494         int err;
 495
 496         if (br_mst_enabled(br) && !dsa_port_supports_mst(dp))
 497                 return -EOPNOTSUPP;
 498
 499         /* Here the interface is already bridged. Reflect the current
 500          * configuration so that drivers can program their chips accordingly.
 501          */
 502         err = dsa_port_bridge_create(dp, br, extack);
 503         if (err)
 504                 return err;
 505
 506         brport_dev = dsa_port_to_bridge_port(dp);
 507
 508         info.bridge = *dp->bridge;
 509         err = dsa_broadcast(DSA_NOTIFIER_BRIDGE_JOIN, &info);
 510         if (err)
 511                 goto out_rollback;
 512
 513         /* Drivers which support bridge TX forwarding should set this */
 514         dp->bridge->tx_fwd_offload = info.tx_fwd_offload;
 515
 516         err = switchdev_bridge_port_offload(brport_dev, dev, dp,
 517                                             &dsa_user_switchdev_notifier,
 518                                             &dsa_user_switchdev_blocking_notifier,
 519                                             dp->bridge->tx_fwd_offload, extack);
 520         if (err)
 521                 goto out_rollback_unbridge;
 522
 523         err = dsa_port_switchdev_sync_attrs(dp, extack);
 524         if (err)
 525                 goto out_rollback_unoffload;
 526
 527         return 0;
 528
 529 out_rollback_unoffload:
 530         switchdev_bridge_port_unoffload(brport_dev, dp,
 531                                         &dsa_user_switchdev_notifier,
 532                                         &dsa_user_switchdev_blocking_notifier);
 533         dsa_flush_workqueue();
 534 out_rollback_unbridge:
 535         dsa_broadcast(DSA_NOTIFIER_BRIDGE_LEAVE, &info);
 536 out_rollback:
 537         dsa_port_bridge_destroy(dp, br);
 538         return err;
 539 }
 540
 541 void dsa_port_pre_bridge_leave(struct dsa_port *dp, struct net_device *br)
 542 {
 543         struct net_device *brport_dev = dsa_port_to_bridge_port(dp);
 544
 545         /* Don't try to unoffload something that is not offloaded */
 546         if (!brport_dev)
 547                 return;
 548
 549         switchdev_bridge_port_unoffload(brport_dev, dp,
 550                                         &dsa_user_switchdev_notifier,
 551                                         &dsa_user_switchdev_blocking_notifier);
 552
 553         dsa_flush_workqueue();
 554 }
 555
 556 void dsa_port_bridge_leave(struct dsa_port *dp, struct net_device *br)
 557 {
 558         struct dsa_notifier_bridge_info info = {
 559                 .dp = dp,
 560         };
 561         int err;
 562
 563         /* If the port could not be offloaded to begin with, then
 564          * there is nothing to do.
 565          */
 566         if (!dp->bridge)
 567                 return;
 568
 569         info.bridge = *dp->bridge;
 570
 571         /* Here the port is already unbridged. Reflect the current configuration
 572          * so that drivers can program their chips accordingly.
 573          */
 574         dsa_port_bridge_destroy(dp, br);
 575
 576         err = dsa_broadcast(DSA_NOTIFIER_BRIDGE_LEAVE, &info);
 577         if (err)
 578                 dev_err(dp->ds->dev,
 579                         "port %d failed to notify DSA_NOTIFIER_BRIDGE_LEAVE: %pe\n",
 580                         dp->index, ERR_PTR(err));
 581
 582         dsa_port_switchdev_unsync_attrs(dp, info.bridge);
 583 }
 584
 585 int dsa_port_lag_change(struct dsa_port *dp,
 586                         struct netdev_lag_lower_state_info *linfo)
 587 {
 588         struct dsa_notifier_lag_info info = {
 589                 .dp = dp,
 590         };
 591         bool tx_enabled;
 592
 593         if (!dp->lag)
 594                 return 0;
 595
 596         /* On statically configured aggregates (e.g. loadbalance
 597          * without LACP) ports will always be tx_enabled, even if the
 598          * link is down. Thus we require both link_up and tx_enabled
 599          * in order to include it in the tx set.
 600          */
 601         tx_enabled = linfo->link_up && linfo->tx_enabled;
 602
 603         if (tx_enabled == dp->lag_tx_enabled)
 604                 return 0;
 605
 606         dp->lag_tx_enabled = tx_enabled;
 607
 608         return dsa_port_notify(dp, DSA_NOTIFIER_LAG_CHANGE, &info);
 609 }
 610
 611 static int dsa_port_lag_create(struct dsa_port *dp,
 612                                struct net_device *lag_dev)
 613 {
 614         struct dsa_switch *ds = dp->ds;
 615         struct dsa_lag *lag;
 616
 617         lag = dsa_tree_lag_find(ds->dst, lag_dev);
 618         if (lag) {
 619                 refcount_inc(&lag->refcount);
 620                 dp->lag = lag;
 621                 return 0;
 622         }
 623
 624         lag = kzalloc(sizeof(*lag), GFP_KERNEL);
 625         if (!lag)
 626                 return -ENOMEM;
 627
 628         refcount_set(&lag->refcount, 1);
 629         mutex_init(&lag->fdb_lock);
 630         INIT_LIST_HEAD(&lag->fdbs);
 631         lag->dev = lag_dev;
 632         dsa_lag_map(ds->dst, lag);
 633         dp->lag = lag;
 634
 635         return 0;
 636 }
 637
 638 static void dsa_port_lag_destroy(struct dsa_port *dp)
 639 {
 640         struct dsa_lag *lag = dp->lag;
 641
 642         dp->lag = NULL;
 643         dp->lag_tx_enabled = false;
 644
 645         if (!refcount_dec_and_test(&lag->refcount))
 646                 return;
 647
 648         WARN_ON(!list_empty(&lag->fdbs));
 649         dsa_lag_unmap(dp->ds->dst, lag);
 650         kfree(lag);
 651 }
 652
 653 int dsa_port_lag_join(struct dsa_port *dp, struct net_device *lag_dev,
 654                       struct netdev_lag_upper_info *uinfo,
 655                       struct netlink_ext_ack *extack)
 656 {
 657         struct dsa_notifier_lag_info info = {
 658                 .dp = dp,
 659                 .info = uinfo,
 660                 .extack = extack,
 661         };
 662         struct net_device *bridge_dev;
 663         int err;
 664
 665         err = dsa_port_lag_create(dp, lag_dev);
 666         if (err)
 667                 goto err_lag_create;
 668
 669         info.lag = *dp->lag;
 670         err = dsa_port_notify(dp, DSA_NOTIFIER_LAG_JOIN, &info);
 671         if (err)
 672                 goto err_lag_join;
 673
 674         bridge_dev = netdev_master_upper_dev_get(lag_dev);
 675         if (!bridge_dev || !netif_is_bridge_master(bridge_dev))
 676                 return 0;
 677
 678         err = dsa_port_bridge_join(dp, bridge_dev, extack);
 679         if (err)
 680                 goto err_bridge_join;
 681
 682         return 0;
 683
 684 err_bridge_join:
 685         dsa_port_notify(dp, DSA_NOTIFIER_LAG_LEAVE, &info);
 686 err_lag_join:
 687         dsa_port_lag_destroy(dp);
 688 err_lag_create:
 689         return err;
 690 }
 691
 692 void dsa_port_pre_lag_leave(struct dsa_port *dp, struct net_device *lag_dev)
 693 {
 694         struct net_device *br = dsa_port_bridge_dev_get(dp);
 695
 696         if (br)
 697                 dsa_port_pre_bridge_leave(dp, br);
 698 }
 699
 700 void dsa_port_lag_leave(struct dsa_port *dp, struct net_device *lag_dev)
 701 {
 702         struct net_device *br = dsa_port_bridge_dev_get(dp);
 703         struct dsa_notifier_lag_info info = {
 704                 .dp = dp,
 705         };
 706         int err;
 707
 708         if (!dp->lag)
 709                 return;
 710
 711         /* Port might have been part of a LAG that in turn was
 712          * attached to a bridge.
 713          */
 714         if (br)
 715                 dsa_port_bridge_leave(dp, br);
 716
 717         info.lag = *dp->lag;
 718
 719         dsa_port_lag_destroy(dp);
 720
 721         err = dsa_port_notify(dp, DSA_NOTIFIER_LAG_LEAVE, &info);
 722         if (err)
 723                 dev_err(dp->ds->dev,
 724                         "port %d failed to notify DSA_NOTIFIER_LAG_LEAVE: %pe\n",
 725                         dp->index, ERR_PTR(err));
 726 }
 727
 728 /* Must be called under rcu_read_lock() */
 729 static bool dsa_port_can_apply_vlan_filtering(struct dsa_port *dp,
 730                                               bool vlan_filtering,
 731                                               struct netlink_ext_ack *extack)
 732 {
 733         struct dsa_switch *ds = dp->ds;
 734         struct dsa_port *other_dp;
 735         int err;
 736
 737         /* VLAN awareness was off, so the question is "can we turn it on".
 738          * We may have had 8021q uppers, those need to go. Make sure we don't
 739          * enter an inconsistent state: deny changing the VLAN awareness state
 740          * as long as we have 8021q uppers.
 741          */
 742         if (vlan_filtering && dsa_port_is_user(dp)) {
 743                 struct net_device *br = dsa_port_bridge_dev_get(dp);
 744                 struct net_device *upper_dev, *user = dp->user;
 745                 struct list_head *iter;
 746
 747                 netdev_for_each_upper_dev_rcu(user, upper_dev, iter) {
 748                         struct bridge_vlan_info br_info;
 749                         u16 vid;
 750
 751                         if (!is_vlan_dev(upper_dev))
 752                                 continue;
 753
 754                         vid = vlan_dev_vlan_id(upper_dev);
 755
 756                         /* br_vlan_get_info() returns -EINVAL or -ENOENT if the
 757                          * device, respectively the VID is not found, returning
 758                          * 0 means success, which is a failure for us here.
 759                          */
 760                         err = br_vlan_get_info(br, vid, &br_info);
 761                         if (err == 0) {
 762                                 NL_SET_ERR_MSG_MOD(extack,
 763                                                    "Must first remove VLAN uppers having VIDs also present in bridge");
 764                                 return false;
 765                         }
 766                 }
 767         }
 768
 769         if (!ds->vlan_filtering_is_global)
 770                 return true;
 771
 772         /* For cases where enabling/disabling VLAN awareness is global to the
 773          * switch, we need to handle the case where multiple bridges span
 774          * different ports of the same switch device and one of them has a
 775          * different setting than what is being requested.
 776          */
 777         dsa_switch_for_each_port(other_dp, ds) {
 778                 struct net_device *other_br = dsa_port_bridge_dev_get(other_dp);
 779
 780                 /* If it's the same bridge, it also has same
 781                  * vlan_filtering setting => no need to check
 782                  */
 783                 if (!other_br || other_br == dsa_port_bridge_dev_get(dp))
 784                         continue;
 785
 786                 if (br_vlan_enabled(other_br) != vlan_filtering) {
 787                         NL_SET_ERR_MSG_MOD(extack,
 788                                            "VLAN filtering is a global setting");
 789                         return false;
 790                 }
 791         }
 792         return true;
 793 }
 794
 795 int dsa_port_vlan_filtering(struct dsa_port *dp, bool vlan_filtering,
 796                             struct netlink_ext_ack *extack)
 797 {
 798         bool old_vlan_filtering = dsa_port_is_vlan_filtering(dp);
 799         struct dsa_switch *ds = dp->ds;
 800         bool apply;
 801         int err;
 802
 803         if (!ds->ops->port_vlan_filtering)
 804                 return -EOPNOTSUPP;
 805
 806         /* We are called from dsa_user_switchdev_blocking_event(),
 807          * which is not under rcu_read_lock(), unlike
 808          * dsa_user_switchdev_event().
 809          */
 810         rcu_read_lock();
 811         apply = dsa_port_can_apply_vlan_filtering(dp, vlan_filtering, extack);
 812         rcu_read_unlock();
 813         if (!apply)
 814                 return -EINVAL;
 815
 816         if (dsa_port_is_vlan_filtering(dp) == vlan_filtering)
 817                 return 0;
 818
 819         err = ds->ops->port_vlan_filtering(ds, dp->index, vlan_filtering,
 820                                            extack);
 821         if (err)
 822                 return err;
 823
 824         if (ds->vlan_filtering_is_global) {
 825                 struct dsa_port *other_dp;
 826
 827                 ds->vlan_filtering = vlan_filtering;
 828
 829                 dsa_switch_for_each_user_port(other_dp, ds) {
 830                         struct net_device *user = other_dp->user;
 831
 832                         /* We might be called in the unbind path, so not
 833                          * all user devices might still be registered.
 834                          */
 835                         if (!user)
 836                                 continue;
 837
 838                         err = dsa_user_manage_vlan_filtering(user,
 839                                                              vlan_filtering);
 840                         if (err)
 841                                 goto restore;
 842                 }
 843         } else {
 844                 dp->vlan_filtering = vlan_filtering;
 845
 846                 err = dsa_user_manage_vlan_filtering(dp->user,
 847                                                      vlan_filtering);
 848                 if (err)
 849                         goto restore;
 850         }
 851
 852         return 0;
 853
 854 restore:
 855         ds->ops->port_vlan_filtering(ds, dp->index, old_vlan_filtering, NULL);
 856
 857         if (ds->vlan_filtering_is_global)
 858                 ds->vlan_filtering = old_vlan_filtering;
 859         else
 860                 dp->vlan_filtering = old_vlan_filtering;
 861
 862         return err;
 863 }
 864
 865 /* This enforces legacy behavior for switch drivers which assume they can't
 866  * receive VLAN configuration when joining a bridge with vlan_filtering=0
 867  */
 868 bool dsa_port_skip_vlan_configuration(struct dsa_port *dp)
 869 {
 870         struct net_device *br = dsa_port_bridge_dev_get(dp);
 871         struct dsa_switch *ds = dp->ds;
 872
 873         if (!br)
 874                 return false;
 875
 876         return !ds->configure_vlan_while_not_filtering && !br_vlan_enabled(br);
 877 }
 878
 879 int dsa_port_ageing_time(struct dsa_port *dp, clock_t ageing_clock)
 880 {
 881         unsigned long ageing_jiffies = clock_t_to_jiffies(ageing_clock);
 882         unsigned int ageing_time = jiffies_to_msecs(ageing_jiffies);
 883         struct dsa_notifier_ageing_time_info info;
 884         int err;
 885
 886         info.ageing_time = ageing_time;
 887
 888         err = dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info);
 889         if (err)
 890                 return err;
 891
 892         dp->ageing_time = ageing_time;
 893
 894         return 0;
 895 }
 896
 897 int dsa_port_mst_enable(struct dsa_port *dp, bool on,
 898                         struct netlink_ext_ack *extack)
 899 {
 900         if (on && !dsa_port_supports_mst(dp)) {
 901                 NL_SET_ERR_MSG_MOD(extack, "Hardware does not support MST");
 902                 return -EINVAL;
 903         }
 904
 905         return 0;
 906 }
 907
 908 int dsa_port_pre_bridge_flags(const struct dsa_port *dp,
 909                               struct switchdev_brport_flags flags,
 910                               struct netlink_ext_ack *extack)
 911 {
 912         struct dsa_switch *ds = dp->ds;
 913
 914         if (!ds->ops->port_pre_bridge_flags)
 915                 return -EINVAL;
 916
 917         return ds->ops->port_pre_bridge_flags(ds, dp->index, flags, extack);
 918 }
 919
 920 int dsa_port_bridge_flags(struct dsa_port *dp,
 921                           struct switchdev_brport_flags flags,
 922                           struct netlink_ext_ack *extack)
 923 {
 924         struct dsa_switch *ds = dp->ds;
 925         int err;
 926
 927         if (!ds->ops->port_bridge_flags)
 928                 return -EOPNOTSUPP;
 929
 930         err = ds->ops->port_bridge_flags(ds, dp->index, flags, extack);
 931         if (err)
 932                 return err;
 933
 934         if (flags.mask & BR_LEARNING) {
 935                 bool learning = flags.val & BR_LEARNING;
 936
 937                 if (learning == dp->learning)
 938                         return 0;
 939
 940                 if ((dp->learning && !learning) &&
 941                     (dp->stp_state == BR_STATE_LEARNING ||
 942                      dp->stp_state == BR_STATE_FORWARDING))
 943                         dsa_port_fast_age(dp);
 944
 945                 dp->learning = learning;
 946         }
 947
 948         return 0;
 949 }
 950
 951 void dsa_port_set_host_flood(struct dsa_port *dp, bool uc, bool mc)
 952 {
 953         struct dsa_switch *ds = dp->ds;
 954
 955         if (ds->ops->port_set_host_flood)
 956                 ds->ops->port_set_host_flood(ds, dp->index, uc, mc);
 957 }
 958
 959 int dsa_port_vlan_msti(struct dsa_port *dp,
 960                        const struct switchdev_vlan_msti *msti)
 961 {
 962         struct dsa_switch *ds = dp->ds;
 963
 964         if (!ds->ops->vlan_msti_set)
 965                 return -EOPNOTSUPP;
 966
 967         return ds->ops->vlan_msti_set(ds, *dp->bridge, msti);
 968 }
 969
 970 int dsa_port_mtu_change(struct dsa_port *dp, int new_mtu)
 971 {
 972         struct dsa_notifier_mtu_info info = {
 973                 .dp = dp,
 974                 .mtu = new_mtu,
 975         };
 976
 977         return dsa_port_notify(dp, DSA_NOTIFIER_MTU, &info);
 978 }
 979
 980 int dsa_port_fdb_add(struct dsa_port *dp, const unsigned char *addr,
 981                      u16 vid)
 982 {
 983         struct dsa_notifier_fdb_info info = {
 984                 .dp = dp,
 985                 .addr = addr,
 986                 .vid = vid,
 987                 .db = {
 988                         .type = DSA_DB_BRIDGE,
 989                         .bridge = *dp->bridge,
 990                 },
 991         };
 992
 993         /* Refcounting takes bridge.num as a key, and should be global for all
 994          * bridges in the absence of FDB isolation, and per bridge otherwise.
 995          * Force the bridge.num to zero here in the absence of FDB isolation.
 996          */
 997         if (!dp->ds->fdb_isolation)
 998                 info.db.bridge.num = 0;
 999
1000         return dsa_port_notify(dp, DSA_NOTIFIER_FDB_ADD, &info);
1001 }
1002
1003 int dsa_port_fdb_del(struct dsa_port *dp, const unsigned char *addr,
1004                      u16 vid)
1005 {
1006         struct dsa_notifier_fdb_info info = {
1007                 .dp = dp,
1008                 .addr = addr,
1009                 .vid = vid,
1010                 .db = {
1011                         .type = DSA_DB_BRIDGE,
1012                         .bridge = *dp->bridge,
1013                 },
1014         };
1015
1016         if (!dp->ds->fdb_isolation)
1017                 info.db.bridge.num = 0;
1018
1019         return dsa_port_notify(dp, DSA_NOTIFIER_FDB_DEL, &info);
1020 }
1021
1022 static int dsa_port_host_fdb_add(struct dsa_port *dp,
1023                                  const unsigned char *addr, u16 vid,
1024                                  struct dsa_db db)
1025 {
1026         struct dsa_notifier_fdb_info info = {
1027                 .dp = dp,
1028                 .addr = addr,
1029                 .vid = vid,
1030                 .db = db,
1031         };
1032
1033         return dsa_port_notify(dp, DSA_NOTIFIER_HOST_FDB_ADD, &info);
1034 }
1035
1036 int dsa_port_standalone_host_fdb_add(struct dsa_port *dp,
1037                                      const unsigned char *addr, u16 vid)
1038 {
1039         struct dsa_db db = {
1040                 .type = DSA_DB_PORT,
1041                 .dp = dp,
1042         };
1043
1044         return dsa_port_host_fdb_add(dp, addr, vid, db);
1045 }
1046
1047 int dsa_port_bridge_host_fdb_add(struct dsa_port *dp,
1048                                  const unsigned char *addr, u16 vid)
1049 {
1050         struct net_device *conduit = dsa_port_to_conduit(dp);
1051         struct dsa_db db = {
1052                 .type = DSA_DB_BRIDGE,
1053                 .bridge = *dp->bridge,
1054         };
1055         int err;
1056
1057         if (!dp->ds->fdb_isolation)
1058                 db.bridge.num = 0;
1059
1060         /* Avoid a call to __dev_set_promiscuity() on the conduit, which
1061          * requires rtnl_lock(), since we can't guarantee that is held here,
1062          * and we can't take it either.
1063          */
1064         if (conduit->priv_flags & IFF_UNICAST_FLT) {
1065                 err = dev_uc_add(conduit, addr);
1066                 if (err)
1067                         return err;
1068         }
1069
1070         return dsa_port_host_fdb_add(dp, addr, vid, db);
1071 }
1072
1073 static int dsa_port_host_fdb_del(struct dsa_port *dp,
1074                                  const unsigned char *addr, u16 vid,
1075                                  struct dsa_db db)
1076 {
1077         struct dsa_notifier_fdb_info info = {
1078                 .dp = dp,
1079                 .addr = addr,
1080                 .vid = vid,
1081                 .db = db,
1082         };
1083
1084         return dsa_port_notify(dp, DSA_NOTIFIER_HOST_FDB_DEL, &info);
1085 }
1086
1087 int dsa_port_standalone_host_fdb_del(struct dsa_port *dp,
1088                                      const unsigned char *addr, u16 vid)
1089 {
1090         struct dsa_db db = {
1091                 .type = DSA_DB_PORT,
1092                 .dp = dp,
1093         };
1094
1095         return dsa_port_host_fdb_del(dp, addr, vid, db);
1096 }
1097
1098 int dsa_port_bridge_host_fdb_del(struct dsa_port *dp,
1099                                  const unsigned char *addr, u16 vid)
1100 {
1101         struct net_device *conduit = dsa_port_to_conduit(dp);
1102         struct dsa_db db = {
1103                 .type = DSA_DB_BRIDGE,
1104                 .bridge = *dp->bridge,
1105         };
1106         int err;
1107
1108         if (!dp->ds->fdb_isolation)
1109                 db.bridge.num = 0;
1110
1111         if (conduit->priv_flags & IFF_UNICAST_FLT) {
1112                 err = dev_uc_del(conduit, addr);
1113                 if (err)
1114                         return err;
1115         }
1116
1117         return dsa_port_host_fdb_del(dp, addr, vid, db);
1118 }
1119
1120 int dsa_port_lag_fdb_add(struct dsa_port *dp, const unsigned char *addr,
1121                          u16 vid)
1122 {
1123         struct dsa_notifier_lag_fdb_info info = {
1124                 .lag = dp->lag,
1125                 .addr = addr,
1126                 .vid = vid,
1127                 .db = {
1128                         .type = DSA_DB_BRIDGE,
1129                         .bridge = *dp->bridge,
1130                 },
1131         };
1132
1133         if (!dp->ds->fdb_isolation)
1134                 info.db.bridge.num = 0;
1135
1136         return dsa_port_notify(dp, DSA_NOTIFIER_LAG_FDB_ADD, &info);
1137 }
1138
1139 int dsa_port_lag_fdb_del(struct dsa_port *dp, const unsigned char *addr,
1140                          u16 vid)
1141 {
1142         struct dsa_notifier_lag_fdb_info info = {
1143                 .lag = dp->lag,
1144                 .addr = addr,
1145                 .vid = vid,
1146                 .db = {
1147                         .type = DSA_DB_BRIDGE,
1148                         .bridge = *dp->bridge,
1149                 },
1150         };
1151
1152         if (!dp->ds->fdb_isolation)
1153                 info.db.bridge.num = 0;
1154
1155         return dsa_port_notify(dp, DSA_NOTIFIER_LAG_FDB_DEL, &info);
1156 }
1157
1158 int dsa_port_fdb_dump(struct dsa_port *dp, dsa_fdb_dump_cb_t *cb, void *data)
1159 {
1160         struct dsa_switch *ds = dp->ds;
1161         int port = dp->index;
1162
1163         if (!ds->ops->port_fdb_dump)
1164                 return -EOPNOTSUPP;
1165
1166         return ds->ops->port_fdb_dump(ds, port, cb, data);
1167 }
1168
1169 int dsa_port_mdb_add(const struct dsa_port *dp,
1170                      const struct switchdev_obj_port_mdb *mdb)
1171 {
1172         struct dsa_notifier_mdb_info info = {
1173                 .dp = dp,
1174                 .mdb = mdb,
1175                 .db = {
1176                         .type = DSA_DB_BRIDGE,
1177                         .bridge = *dp->bridge,
1178                 },
1179         };
1180
1181         if (!dp->ds->fdb_isolation)
1182                 info.db.bridge.num = 0;
1183
1184         return dsa_port_notify(dp, DSA_NOTIFIER_MDB_ADD, &info);
1185 }
1186
1187 int dsa_port_mdb_del(const struct dsa_port *dp,
1188                      const struct switchdev_obj_port_mdb *mdb)
1189 {
1190         struct dsa_notifier_mdb_info info = {
1191                 .dp = dp,
1192                 .mdb = mdb,
1193                 .db = {
1194                         .type = DSA_DB_BRIDGE,
1195                         .bridge = *dp->bridge,
1196                 },
1197         };
1198
1199         if (!dp->ds->fdb_isolation)
1200                 info.db.bridge.num = 0;
1201
1202         return dsa_port_notify(dp, DSA_NOTIFIER_MDB_DEL, &info);
1203 }
1204
1205 static int dsa_port_host_mdb_add(const struct dsa_port *dp,
1206                                  const struct switchdev_obj_port_mdb *mdb,
1207                                  struct dsa_db db)
1208 {
1209         struct dsa_notifier_mdb_info info = {
1210                 .dp = dp,
1211                 .mdb = mdb,
1212                 .db = db,
1213         };
1214
1215         return dsa_port_notify(dp, DSA_NOTIFIER_HOST_MDB_ADD, &info);
1216 }
1217
1218 int dsa_port_standalone_host_mdb_add(const struct dsa_port *dp,
1219                                      const struct switchdev_obj_port_mdb *mdb)
1220 {
1221         struct dsa_db db = {
1222                 .type = DSA_DB_PORT,
1223                 .dp = dp,
1224         };
1225
1226         return dsa_port_host_mdb_add(dp, mdb, db);
1227 }
1228
1229 int dsa_port_bridge_host_mdb_add(const struct dsa_port *dp,
1230                                  const struct switchdev_obj_port_mdb *mdb)
1231 {
1232         struct net_device *conduit = dsa_port_to_conduit(dp);
1233         struct dsa_db db = {
1234                 .type = DSA_DB_BRIDGE,
1235                 .bridge = *dp->bridge,
1236         };
1237         int err;
1238
1239         if (!dp->ds->fdb_isolation)
1240                 db.bridge.num = 0;
1241
1242         err = dev_mc_add(conduit, mdb->addr);
1243         if (err)
1244                 return err;
1245
1246         return dsa_port_host_mdb_add(dp, mdb, db);
1247 }
1248
1249 static int dsa_port_host_mdb_del(const struct dsa_port *dp,
1250                                  const struct switchdev_obj_port_mdb *mdb,
1251                                  struct dsa_db db)
1252 {
1253         struct dsa_notifier_mdb_info info = {
1254                 .dp = dp,
1255                 .mdb = mdb,
1256                 .db = db,
1257         };
1258
1259         return dsa_port_notify(dp, DSA_NOTIFIER_HOST_MDB_DEL, &info);
1260 }
1261
1262 int dsa_port_standalone_host_mdb_del(const struct dsa_port *dp,
1263                                      const struct switchdev_obj_port_mdb *mdb)
1264 {
1265         struct dsa_db db = {
1266                 .type = DSA_DB_PORT,
1267                 .dp = dp,
1268         };
1269
1270         return dsa_port_host_mdb_del(dp, mdb, db);
1271 }
1272
1273 int dsa_port_bridge_host_mdb_del(const struct dsa_port *dp,
1274                                  const struct switchdev_obj_port_mdb *mdb)
1275 {
1276         struct net_device *conduit = dsa_port_to_conduit(dp);
1277         struct dsa_db db = {
1278                 .type = DSA_DB_BRIDGE,
1279                 .bridge = *dp->bridge,
1280         };
1281         int err;
1282
1283         if (!dp->ds->fdb_isolation)
1284                 db.bridge.num = 0;
1285
1286         err = dev_mc_del(conduit, mdb->addr);
1287         if (err)
1288                 return err;
1289
1290         return dsa_port_host_mdb_del(dp, mdb, db);
1291 }
1292
1293 int dsa_port_vlan_add(struct dsa_port *dp,
1294                       const struct switchdev_obj_port_vlan *vlan,
1295                       struct netlink_ext_ack *extack)
1296 {
1297         struct dsa_notifier_vlan_info info = {
1298                 .dp = dp,
1299                 .vlan = vlan,
1300                 .extack = extack,
1301         };
1302
1303         return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_ADD, &info);
1304 }
1305
1306 int dsa_port_vlan_del(struct dsa_port *dp,
1307                       const struct switchdev_obj_port_vlan *vlan)
1308 {
1309         struct dsa_notifier_vlan_info info = {
1310                 .dp = dp,
1311                 .vlan = vlan,
1312         };
1313
1314         return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info);
1315 }
1316
1317 int dsa_port_host_vlan_add(struct dsa_port *dp,
1318                            const struct switchdev_obj_port_vlan *vlan,
1319                            struct netlink_ext_ack *extack)
1320 {
1321         struct net_device *conduit = dsa_port_to_conduit(dp);
1322         struct dsa_notifier_vlan_info info = {
1323                 .dp = dp,
1324                 .vlan = vlan,
1325                 .extack = extack,
1326         };
1327         int err;
1328
1329         err = dsa_port_notify(dp, DSA_NOTIFIER_HOST_VLAN_ADD, &info);
1330         if (err && err != -EOPNOTSUPP)
1331                 return err;
1332
1333         vlan_vid_add(conduit, htons(ETH_P_8021Q), vlan->vid);
1334
1335         return err;
1336 }
1337
1338 int dsa_port_host_vlan_del(struct dsa_port *dp,
1339                            const struct switchdev_obj_port_vlan *vlan)
1340 {
1341         struct net_device *conduit = dsa_port_to_conduit(dp);
1342         struct dsa_notifier_vlan_info info = {
1343                 .dp = dp,
1344                 .vlan = vlan,
1345         };
1346         int err;
1347
1348         err = dsa_port_notify(dp, DSA_NOTIFIER_HOST_VLAN_DEL, &info);
1349         if (err && err != -EOPNOTSUPP)
1350                 return err;
1351
1352         vlan_vid_del(conduit, htons(ETH_P_8021Q), vlan->vid);
1353
1354         return err;
1355 }
1356
1357 int dsa_port_mrp_add(const struct dsa_port *dp,
1358                      const struct switchdev_obj_mrp *mrp)
1359 {
1360         struct dsa_switch *ds = dp->ds;
1361
1362         if (!ds->ops->port_mrp_add)
1363                 return -EOPNOTSUPP;
1364
1365         return ds->ops->port_mrp_add(ds, dp->index, mrp);
1366 }
1367
1368 int dsa_port_mrp_del(const struct dsa_port *dp,
1369                      const struct switchdev_obj_mrp *mrp)
1370 {
1371         struct dsa_switch *ds = dp->ds;
1372
1373         if (!ds->ops->port_mrp_del)
1374                 return -EOPNOTSUPP;
1375
1376         return ds->ops->port_mrp_del(ds, dp->index, mrp);
1377 }
1378
1379 int dsa_port_mrp_add_ring_role(const struct dsa_port *dp,
1380                                const struct switchdev_obj_ring_role_mrp *mrp)
1381 {
1382         struct dsa_switch *ds = dp->ds;
1383
1384         if (!ds->ops->port_mrp_add_ring_role)
1385                 return -EOPNOTSUPP;
1386
1387         return ds->ops->port_mrp_add_ring_role(ds, dp->index, mrp);
1388 }
1389
1390 int dsa_port_mrp_del_ring_role(const struct dsa_port *dp,
1391                                const struct switchdev_obj_ring_role_mrp *mrp)
1392 {
1393         struct dsa_switch *ds = dp->ds;
1394
1395         if (!ds->ops->port_mrp_del_ring_role)
1396                 return -EOPNOTSUPP;
1397
1398         return ds->ops->port_mrp_del_ring_role(ds, dp->index, mrp);
1399 }
1400
1401 static int dsa_port_assign_conduit(struct dsa_port *dp,
1402                                    struct net_device *conduit,
1403                                    struct netlink_ext_ack *extack,
1404                                    bool fail_on_err)
1405 {
1406         struct dsa_switch *ds = dp->ds;
1407         int port = dp->index, err;
1408
1409         err = ds->ops->port_change_conduit(ds, port, conduit, extack);
1410         if (err && !fail_on_err)
1411                 dev_err(ds->dev, "port %d failed to assign conduit %s: %pe\n",
1412                         port, conduit->name, ERR_PTR(err));
1413
1414         if (err && fail_on_err)
1415                 return err;
1416
1417         dp->cpu_dp = conduit->dsa_ptr;
1418         dp->cpu_port_in_lag = netif_is_lag_master(conduit);
1419
1420         return 0;
1421 }
1422
1423 /* Change the dp->cpu_dp affinity for a user port. Note that both cross-chip
1424  * notifiers and drivers have implicit assumptions about user-to-CPU-port
1425  * mappings, so we unfortunately cannot delay the deletion of the objects
1426  * (switchdev, standalone addresses, standalone VLANs) on the old CPU port
1427  * until the new CPU port has been set up. So we need to completely tear down
1428  * the old CPU port before changing it, and restore it on errors during the
1429  * bringup of the new one.
1430  */
1431 int dsa_port_change_conduit(struct dsa_port *dp, struct net_device *conduit,
1432                             struct netlink_ext_ack *extack)
1433 {
1434         struct net_device *bridge_dev = dsa_port_bridge_dev_get(dp);
1435         struct net_device *old_conduit = dsa_port_to_conduit(dp);
1436         struct net_device *dev = dp->user;
1437         struct dsa_switch *ds = dp->ds;
1438         bool vlan_filtering;
1439         int err, tmp;
1440
1441         /* Bridges may hold host FDB, MDB and VLAN objects. These need to be
1442          * migrated, so dynamically unoffload and later reoffload the bridge
1443          * port.
1444          */
1445         if (bridge_dev) {
1446                 dsa_port_pre_bridge_leave(dp, bridge_dev);
1447                 dsa_port_bridge_leave(dp, bridge_dev);
1448         }
1449
1450         /* The port might still be VLAN filtering even if it's no longer
1451          * under a bridge, either due to ds->vlan_filtering_is_global or
1452          * ds->needs_standalone_vlan_filtering. In turn this means VLANs
1453          * on the CPU port.
1454          */
1455         vlan_filtering = dsa_port_is_vlan_filtering(dp);
1456         if (vlan_filtering) {
1457                 err = dsa_user_manage_vlan_filtering(dev, false);
1458                 if (err) {
1459                         NL_SET_ERR_MSG_MOD(extack,
1460                                            "Failed to remove standalone VLANs");
1461                         goto rewind_old_bridge;
1462                 }
1463         }
1464
1465         /* Standalone addresses, and addresses of upper interfaces like
1466          * VLAN, LAG, HSR need to be migrated.
1467          */
1468         dsa_user_unsync_ha(dev);
1469
1470         err = dsa_port_assign_conduit(dp, conduit, extack, true);
1471         if (err)
1472                 goto rewind_old_addrs;
1473
1474         dsa_user_sync_ha(dev);
1475
1476         if (vlan_filtering) {
1477                 err = dsa_user_manage_vlan_filtering(dev, true);
1478                 if (err) {
1479                         NL_SET_ERR_MSG_MOD(extack,
1480                                            "Failed to restore standalone VLANs");
1481                         goto rewind_new_addrs;
1482                 }
1483         }
1484
1485         if (bridge_dev) {
1486                 err = dsa_port_bridge_join(dp, bridge_dev, extack);
1487                 if (err && err == -EOPNOTSUPP) {
1488                         NL_SET_ERR_MSG_MOD(extack,
1489                                            "Failed to reoffload bridge");
1490                         goto rewind_new_vlan;
1491                 }
1492         }
1493
1494         return 0;
1495
1496 rewind_new_vlan:
1497         if (vlan_filtering)
1498                 dsa_user_manage_vlan_filtering(dev, false);
1499
1500 rewind_new_addrs:
1501         dsa_user_unsync_ha(dev);
1502
1503         dsa_port_assign_conduit(dp, old_conduit, NULL, false);
1504
1505 /* Restore the objects on the old CPU port */
1506 rewind_old_addrs:
1507         dsa_user_sync_ha(dev);
1508
1509         if (vlan_filtering) {
1510                 tmp = dsa_user_manage_vlan_filtering(dev, true);
1511                 if (tmp) {
1512                         dev_err(ds->dev,
1513                                 "port %d failed to restore standalone VLANs: %pe\n",
1514                                 dp->index, ERR_PTR(tmp));
1515                 }
1516         }
1517
1518 rewind_old_bridge:
1519         if (bridge_dev) {
1520                 tmp = dsa_port_bridge_join(dp, bridge_dev, extack);
1521                 if (tmp) {
1522                         dev_err(ds->dev,
1523                                 "port %d failed to rejoin bridge %s: %pe\n",
1524                                 dp->index, bridge_dev->name, ERR_PTR(tmp));
1525                 }
1526         }
1527
1528         return err;
1529 }
1530
1531 void dsa_port_set_tag_protocol(struct dsa_port *cpu_dp,
1532                                const struct dsa_device_ops *tag_ops)
1533 {
1534         cpu_dp->rcv = tag_ops->rcv;
1535         cpu_dp->tag_ops = tag_ops;
1536 }
1537
1538 static struct phy_device *dsa_port_get_phy_device(struct dsa_port *dp)
1539 {
1540         struct device_node *phy_dn;
1541         struct phy_device *phydev;
1542
1543         phy_dn = of_parse_phandle(dp->dn, "phy-handle", 0);
1544         if (!phy_dn)
1545                 return NULL;
1546
1547         phydev = of_phy_find_device(phy_dn);
1548         if (!phydev) {
1549                 of_node_put(phy_dn);
1550                 return ERR_PTR(-EPROBE_DEFER);
1551         }
1552
1553         of_node_put(phy_dn);
1554         return phydev;
1555 }
1556
1557 static struct phylink_pcs *
1558 dsa_port_phylink_mac_select_pcs(struct phylink_config *config,
1559                                 phy_interface_t interface)
1560 {
1561         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
1562         struct phylink_pcs *pcs = ERR_PTR(-EOPNOTSUPP);
1563         struct dsa_switch *ds = dp->ds;
1564
1565         if (ds->ops->phylink_mac_select_pcs)
1566                 pcs = ds->ops->phylink_mac_select_pcs(ds, dp->index, interface);
1567
1568         return pcs;
1569 }
1570
1571 static int dsa_port_phylink_mac_prepare(struct phylink_config *config,
1572                                         unsigned int mode,
1573                                         phy_interface_t interface)
1574 {
1575         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
1576         struct dsa_switch *ds = dp->ds;
1577         int err = 0;
1578
1579         if (ds->ops->phylink_mac_prepare)
1580                 err = ds->ops->phylink_mac_prepare(ds, dp->index, mode,
1581                                                    interface);
1582
1583         return err;
1584 }
1585
1586 static void dsa_port_phylink_mac_config(struct phylink_config *config,
1587                                         unsigned int mode,
1588                                         const struct phylink_link_state *state)
1589 {
1590         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
1591         struct dsa_switch *ds = dp->ds;
1592
1593         if (!ds->ops->phylink_mac_config)
1594                 return;
1595
1596         ds->ops->phylink_mac_config(ds, dp->index, mode, state);
1597 }
1598
1599 static int dsa_port_phylink_mac_finish(struct phylink_config *config,
1600                                        unsigned int mode,
1601                                        phy_interface_t interface)
1602 {
1603         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
1604         struct dsa_switch *ds = dp->ds;
1605         int err = 0;
1606
1607         if (ds->ops->phylink_mac_finish)
1608                 err = ds->ops->phylink_mac_finish(ds, dp->index, mode,
1609                                                   interface);
1610
1611         return err;
1612 }
1613
1614 static void dsa_port_phylink_mac_link_down(struct phylink_config *config,
1615                                            unsigned int mode,
1616                                            phy_interface_t interface)
1617 {
1618         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
1619         struct phy_device *phydev = NULL;
1620         struct dsa_switch *ds = dp->ds;
1621
1622         if (dsa_port_is_user(dp))
1623                 phydev = dp->user->phydev;
1624
1625         if (!ds->ops->phylink_mac_link_down) {
1626                 if (ds->ops->adjust_link && phydev)
1627                         ds->ops->adjust_link(ds, dp->index, phydev);
1628                 return;
1629         }
1630
1631         ds->ops->phylink_mac_link_down(ds, dp->index, mode, interface);
1632 }
1633
1634 static void dsa_port_phylink_mac_link_up(struct phylink_config *config,
1635                                          struct phy_device *phydev,
1636                                          unsigned int mode,
1637                                          phy_interface_t interface,
1638                                          int speed, int duplex,
1639                                          bool tx_pause, bool rx_pause)
1640 {
1641         struct dsa_port *dp = container_of(config, struct dsa_port, pl_config);
1642         struct dsa_switch *ds = dp->ds;
1643
1644         if (!ds->ops->phylink_mac_link_up) {
1645                 if (ds->ops->adjust_link && phydev)
1646                         ds->ops->adjust_link(ds, dp->index, phydev);
1647                 return;
1648         }
1649
1650         ds->ops->phylink_mac_link_up(ds, dp->index, mode, interface, phydev,
1651                                      speed, duplex, tx_pause, rx_pause);
1652 }
1653
1654 static const struct phylink_mac_ops dsa_port_phylink_mac_ops = {
1655         .mac_select_pcs = dsa_port_phylink_mac_select_pcs,
1656         .mac_prepare = dsa_port_phylink_mac_prepare,
1657         .mac_config = dsa_port_phylink_mac_config,
1658         .mac_finish = dsa_port_phylink_mac_finish,
1659         .mac_link_down = dsa_port_phylink_mac_link_down,
1660         .mac_link_up = dsa_port_phylink_mac_link_up,
1661 };
1662
1663 int dsa_port_phylink_create(struct dsa_port *dp)
1664 {
1665         struct dsa_switch *ds = dp->ds;
1666         phy_interface_t mode;
1667         struct phylink *pl;
1668         int err;
1669
1670         err = of_get_phy_mode(dp->dn, &mode);
1671         if (err)
1672                 mode = PHY_INTERFACE_MODE_NA;
1673
1674         if (ds->ops->phylink_get_caps) {
1675                 ds->ops->phylink_get_caps(ds, dp->index, &dp->pl_config);
1676         } else {
1677                 /* For legacy drivers */
1678                 if (mode != PHY_INTERFACE_MODE_NA) {
1679                         __set_bit(mode, dp->pl_config.supported_interfaces);
1680                 } else {
1681                         __set_bit(PHY_INTERFACE_MODE_INTERNAL,
1682                                   dp->pl_config.supported_interfaces);
1683                         __set_bit(PHY_INTERFACE_MODE_GMII,
1684                                   dp->pl_config.supported_interfaces);
1685                 }
1686         }
1687
1688         pl = phylink_create(&dp->pl_config, of_fwnode_handle(dp->dn),
1689                             mode, &dsa_port_phylink_mac_ops);
1690         if (IS_ERR(pl)) {
1691                 pr_err("error creating PHYLINK: %ld\n", PTR_ERR(pl));
1692                 return PTR_ERR(pl);
1693         }
1694
1695         dp->pl = pl;
1696
1697         return 0;
1698 }
1699
1700 void dsa_port_phylink_destroy(struct dsa_port *dp)
1701 {
1702         phylink_destroy(dp->pl);
1703         dp->pl = NULL;
1704 }
1705
1706 static int dsa_shared_port_setup_phy_of(struct dsa_port *dp, bool enable)
1707 {
1708         struct dsa_switch *ds = dp->ds;
1709         struct phy_device *phydev;
1710         int port = dp->index;
1711         int err = 0;
1712
1713         phydev = dsa_port_get_phy_device(dp);
1714         if (!phydev)
1715                 return 0;
1716
1717         if (IS_ERR(phydev))
1718                 return PTR_ERR(phydev);
1719
1720         if (enable) {
1721                 err = genphy_resume(phydev);
1722                 if (err < 0)
1723                         goto err_put_dev;
1724
1725                 err = genphy_read_status(phydev);
1726                 if (err < 0)
1727                         goto err_put_dev;
1728         } else {
1729                 err = genphy_suspend(phydev);
1730                 if (err < 0)
1731                         goto err_put_dev;
1732         }
1733
1734         if (ds->ops->adjust_link)
1735                 ds->ops->adjust_link(ds, port, phydev);
1736
1737         dev_dbg(ds->dev, "enabled port's phy: %s", phydev_name(phydev));
1738
1739 err_put_dev:
1740         put_device(&phydev->mdio.dev);
1741         return err;
1742 }
1743
1744 static int dsa_shared_port_fixed_link_register_of(struct dsa_port *dp)
1745 {
1746         struct device_node *dn = dp->dn;
1747         struct dsa_switch *ds = dp->ds;
1748         struct phy_device *phydev;
1749         int port = dp->index;
1750         phy_interface_t mode;
1751         int err;
1752
1753         err = of_phy_register_fixed_link(dn);
1754         if (err) {
1755                 dev_err(ds->dev,
1756                         "failed to register the fixed PHY of port %d\n",
1757                         port);
1758                 return err;
1759         }
1760
1761         phydev = of_phy_find_device(dn);
1762
1763         err = of_get_phy_mode(dn, &mode);
1764         if (err)
1765                 mode = PHY_INTERFACE_MODE_NA;
1766         phydev->interface = mode;
1767
1768         genphy_read_status(phydev);
1769
1770         if (ds->ops->adjust_link)
1771                 ds->ops->adjust_link(ds, port, phydev);
1772
1773         put_device(&phydev->mdio.dev);
1774
1775         return 0;
1776 }
1777
1778 static int dsa_shared_port_phylink_register(struct dsa_port *dp)
1779 {
1780         struct dsa_switch *ds = dp->ds;
1781         struct device_node *port_dn = dp->dn;
1782         int err;
1783
1784         dp->pl_config.dev = ds->dev;
1785         dp->pl_config.type = PHYLINK_DEV;
1786
1787         err = dsa_port_phylink_create(dp);
1788         if (err)
1789                 return err;
1790
1791         err = phylink_of_phy_connect(dp->pl, port_dn, 0);
1792         if (err && err != -ENODEV) {
1793                 pr_err("could not attach to PHY: %d\n", err);
1794                 goto err_phy_connect;
1795         }
1796
1797         return 0;
1798
1799 err_phy_connect:
1800         dsa_port_phylink_destroy(dp);
1801         return err;
1802 }
1803
1804 /* During the initial DSA driver migration to OF, port nodes were sometimes
1805  * added to device trees with no indication of how they should operate from a
1806  * link management perspective (phy-handle, fixed-link, etc). Additionally, the
1807  * phy-mode may be absent. The interpretation of these port OF nodes depends on
1808  * their type.
1809  *
1810  * User ports with no phy-handle or fixed-link are expected to connect to an
1811  * internal PHY located on the ds->user_mii_bus at an MDIO address equal to
1812  * the port number. This description is still actively supported.
1813  *
1814  * Shared (CPU and DSA) ports with no phy-handle or fixed-link are expected to
1815  * operate at the maximum speed that their phy-mode is capable of. If the
1816  * phy-mode is absent, they are expected to operate using the phy-mode
1817  * supported by the port that gives the highest link speed. It is unspecified
1818  * if the port should use flow control or not, half duplex or full duplex, or
1819  * if the phy-mode is a SERDES link, whether in-band autoneg is expected to be
1820  * enabled or not.
1821  *
1822  * In the latter case of shared ports, omitting the link management description
1823  * from the firmware node is deprecated and strongly discouraged. DSA uses
1824  * phylink, which rejects the firmware nodes of these ports for lacking
1825  * required properties.
1826  *
1827  * For switches in this table, DSA will skip enforcing validation and will
1828  * later omit registering a phylink instance for the shared ports, if they lack
1829  * a fixed-link, a phy-handle, or a managed = "in-band-status" property.
1830  * It becomes the responsibility of the driver to ensure that these ports
1831  * operate at the maximum speed (whatever this means) and will interoperate
1832  * with the DSA conduit or other cascade port, since phylink methods will not be
1833  * invoked for them.
1834  *
1835  * If you are considering expanding this table for newly introduced switches,
1836  * think again. It is OK to remove switches from this table if there aren't DT
1837  * blobs in circulation which rely on defaulting the shared ports.
1838  */
1839 static const char * const dsa_switches_apply_workarounds[] = {
1840 #if IS_ENABLED(CONFIG_NET_DSA_XRS700X)
1841         "arrow,xrs7003e",
1842         "arrow,xrs7003f",
1843         "arrow,xrs7004e",
1844         "arrow,xrs7004f",
1845 #endif
1846 #if IS_ENABLED(CONFIG_B53)
1847         "brcm,bcm5325",
1848         "brcm,bcm53115",
1849         "brcm,bcm53125",
1850         "brcm,bcm53128",
1851         "brcm,bcm5365",
1852         "brcm,bcm5389",
1853         "brcm,bcm5395",
1854         "brcm,bcm5397",
1855         "brcm,bcm5398",
1856         "brcm,bcm53010-srab",
1857         "brcm,bcm53011-srab",
1858         "brcm,bcm53012-srab",
1859         "brcm,bcm53018-srab",
1860         "brcm,bcm53019-srab",
1861         "brcm,bcm5301x-srab",
1862         "brcm,bcm11360-srab",
1863         "brcm,bcm58522-srab",
1864         "brcm,bcm58525-srab",
1865         "brcm,bcm58535-srab",
1866         "brcm,bcm58622-srab",
1867         "brcm,bcm58623-srab",
1868         "brcm,bcm58625-srab",
1869         "brcm,bcm88312-srab",
1870         "brcm,cygnus-srab",
1871         "brcm,nsp-srab",
1872         "brcm,omega-srab",
1873         "brcm,bcm3384-switch",
1874         "brcm,bcm6328-switch",
1875         "brcm,bcm6368-switch",
1876         "brcm,bcm63xx-switch",
1877 #endif
1878 #if IS_ENABLED(CONFIG_NET_DSA_BCM_SF2)
1879         "brcm,bcm7445-switch-v4.0",
1880         "brcm,bcm7278-switch-v4.0",
1881         "brcm,bcm7278-switch-v4.8",
1882 #endif
1883 #if IS_ENABLED(CONFIG_NET_DSA_LANTIQ_GSWIP)
1884         "lantiq,xrx200-gswip",
1885         "lantiq,xrx300-gswip",
1886         "lantiq,xrx330-gswip",
1887 #endif
1888 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6060)
1889         "marvell,mv88e6060",
1890 #endif
1891 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6XXX)
1892         "marvell,mv88e6085",
1893         "marvell,mv88e6190",
1894         "marvell,mv88e6250",
1895 #endif
1896 #if IS_ENABLED(CONFIG_NET_DSA_MICROCHIP_KSZ_COMMON)
1897         "microchip,ksz8765",
1898         "microchip,ksz8794",
1899         "microchip,ksz8795",
1900         "microchip,ksz8863",
1901         "microchip,ksz8873",
1902         "microchip,ksz9477",
1903         "microchip,ksz9897",
1904         "microchip,ksz9893",
1905         "microchip,ksz9563",
1906         "microchip,ksz8563",
1907         "microchip,ksz9567",
1908 #endif
1909 #if IS_ENABLED(CONFIG_NET_DSA_SMSC_LAN9303_MDIO)
1910         "smsc,lan9303-mdio",
1911 #endif
1912 #if IS_ENABLED(CONFIG_NET_DSA_SMSC_LAN9303_I2C)
1913         "smsc,lan9303-i2c",
1914 #endif
1915         NULL,
1916 };
1917
1918 static void dsa_shared_port_validate_of(struct dsa_port *dp,
1919                                         bool *missing_phy_mode,
1920                                         bool *missing_link_description)
1921 {
1922         struct device_node *dn = dp->dn, *phy_np;
1923         struct dsa_switch *ds = dp->ds;
1924         phy_interface_t mode;
1925
1926         *missing_phy_mode = false;
1927         *missing_link_description = false;
1928
1929         if (of_get_phy_mode(dn, &mode)) {
1930                 *missing_phy_mode = true;
1931                 dev_err(ds->dev,
1932                         "OF node %pOF of %s port %d lacks the required \"phy-mode\" property\n",
1933                         dn, dsa_port_is_cpu(dp) ? "CPU" : "DSA", dp->index);
1934         }
1935
1936         /* Note: of_phy_is_fixed_link() also returns true for
1937          * managed = "in-band-status"
1938          */
1939         if (of_phy_is_fixed_link(dn))
1940                 return;
1941
1942         phy_np = of_parse_phandle(dn, "phy-handle", 0);
1943         if (phy_np) {
1944                 of_node_put(phy_np);
1945                 return;
1946         }
1947
1948         *missing_link_description = true;
1949
1950         dev_err(ds->dev,
1951                 "OF node %pOF of %s port %d lacks the required \"phy-handle\", \"fixed-link\" or \"managed\" properties\n",
1952                 dn, dsa_port_is_cpu(dp) ? "CPU" : "DSA", dp->index);
1953 }
1954
1955 int dsa_shared_port_link_register_of(struct dsa_port *dp)
1956 {
1957         struct dsa_switch *ds = dp->ds;
1958         bool missing_link_description;
1959         bool missing_phy_mode;
1960         int port = dp->index;
1961
1962         dsa_shared_port_validate_of(dp, &missing_phy_mode,
1963                                     &missing_link_description);
1964
1965         if ((missing_phy_mode || missing_link_description) &&
1966             !of_device_compatible_match(ds->dev->of_node,
1967                                         dsa_switches_apply_workarounds))
1968                 return -EINVAL;
1969
1970         if (!ds->ops->adjust_link) {
1971                 if (missing_link_description) {
1972                         dev_warn(ds->dev,
1973                                  "Skipping phylink registration for %s port %d\n",
1974                                  dsa_port_is_cpu(dp) ? "CPU" : "DSA", dp->index);
1975                 } else {
1976                         if (ds->ops->phylink_mac_link_down)
1977                                 ds->ops->phylink_mac_link_down(ds, port,
1978                                         MLO_AN_FIXED, PHY_INTERFACE_MODE_NA);
1979
1980                         return dsa_shared_port_phylink_register(dp);
1981                 }
1982                 return 0;
1983         }
1984
1985         dev_warn(ds->dev,
1986                  "Using legacy PHYLIB callbacks. Please migrate to PHYLINK!\n");
1987
1988         if (of_phy_is_fixed_link(dp->dn))
1989                 return dsa_shared_port_fixed_link_register_of(dp);
1990         else
1991                 return dsa_shared_port_setup_phy_of(dp, true);
1992 }
1993
1994 void dsa_shared_port_link_unregister_of(struct dsa_port *dp)
1995 {
1996         struct dsa_switch *ds = dp->ds;
1997
1998         if (!ds->ops->adjust_link && dp->pl) {
1999                 rtnl_lock();
2000                 phylink_disconnect_phy(dp->pl);
2001                 rtnl_unlock();
2002                 dsa_port_phylink_destroy(dp);
2003                 return;
2004         }
2005
2006         if (of_phy_is_fixed_link(dp->dn))
2007                 of_phy_deregister_fixed_link(dp->dn);
2008         else
2009                 dsa_shared_port_setup_phy_of(dp, false);
2010 }
2011
2012 int dsa_port_hsr_join(struct dsa_port *dp, struct net_device *hsr,
2013                       struct netlink_ext_ack *extack)
2014 {
2015         struct dsa_switch *ds = dp->ds;
2016         int err;
2017
2018         if (!ds->ops->port_hsr_join)
2019                 return -EOPNOTSUPP;
2020
2021         dp->hsr_dev = hsr;
2022
2023         err = ds->ops->port_hsr_join(ds, dp->index, hsr, extack);
2024         if (err)
2025                 dp->hsr_dev = NULL;
2026
2027         return err;
2028 }
2029
2030 void dsa_port_hsr_leave(struct dsa_port *dp, struct net_device *hsr)
2031 {
2032         struct dsa_switch *ds = dp->ds;
2033         int err;
2034
2035         dp->hsr_dev = NULL;
2036
2037         if (ds->ops->port_hsr_leave) {
2038                 err = ds->ops->port_hsr_leave(ds, dp->index, hsr);
2039                 if (err)
2040                         dev_err(dp->ds->dev,
2041                                 "port %d failed to leave HSR %s: %pe\n",
2042                                 dp->index, hsr->name, ERR_PTR(err));
2043         }
2044 }
2045
2046 int dsa_port_tag_8021q_vlan_add(struct dsa_port *dp, u16 vid, bool broadcast)
2047 {
2048         struct dsa_notifier_tag_8021q_vlan_info info = {
2049                 .dp = dp,
2050                 .vid = vid,
2051         };
2052
2053         if (broadcast)
2054                 return dsa_broadcast(DSA_NOTIFIER_TAG_8021Q_VLAN_ADD, &info);
2055
2056         return dsa_port_notify(dp, DSA_NOTIFIER_TAG_8021Q_VLAN_ADD, &info);
2057 }
2058
2059 void dsa_port_tag_8021q_vlan_del(struct dsa_port *dp, u16 vid, bool broadcast)
2060 {
2061         struct dsa_notifier_tag_8021q_vlan_info info = {
2062                 .dp = dp,
2063                 .vid = vid,
2064         };
2065         int err;
2066
2067         if (broadcast)
2068                 err = dsa_broadcast(DSA_NOTIFIER_TAG_8021Q_VLAN_DEL, &info);
2069         else
2070                 err = dsa_port_notify(dp, DSA_NOTIFIER_TAG_8021Q_VLAN_DEL, &info);
2071         if (err)
2072                 dev_err(dp->ds->dev,
2073                         "port %d failed to notify tag_8021q VLAN %d deletion: %pe\n",
2074                         dp->index, vid, ERR_PTR(err));
2075 }