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/notifier.h> 11#include <linux/of_mdio.h> 12#include <linux/of_net.h> 13 14#include "dsa_priv.h" 15 16static int dsa_broadcast(unsigned long e, void *v) 17{ 18 struct dsa_switch_tree *dst; 19 int err = 0; 20 21 list_for_each_entry(dst, &dsa_tree_list, list) { 22 struct raw_notifier_head *nh = &dst->nh; 23 24 err = raw_notifier_call_chain(nh, e, v); 25 err = notifier_to_errno(err); 26 if (err) 27 break; 28 } 29 30 return err; 31} 32 33static int dsa_port_notify(const struct dsa_port *dp, unsigned long e, void *v) 34{ 35 struct raw_notifier_head *nh = &dp->ds->dst->nh; 36 int err; 37 38 err = raw_notifier_call_chain(nh, e, v); 39 40 return notifier_to_errno(err); 41} 42 43int dsa_port_set_state(struct dsa_port *dp, u8 state, 44 struct switchdev_trans *trans) 45{ 46 struct dsa_switch *ds = dp->ds; 47 int port = dp->index; 48 49 if (switchdev_trans_ph_prepare(trans)) 50 return ds->ops->port_stp_state_set ? 0 : -EOPNOTSUPP; 51 52 if (ds->ops->port_stp_state_set) 53 ds->ops->port_stp_state_set(ds, port, state); 54 55 if (ds->ops->port_fast_age) { 56 /* Fast age FDB entries or flush appropriate forwarding database 57 * for the given port, if we are moving it from Learning or 58 * Forwarding state, to Disabled or Blocking or Listening state. 59 */ 60 61 if ((dp->stp_state == BR_STATE_LEARNING || 62 dp->stp_state == BR_STATE_FORWARDING) && 63 (state == BR_STATE_DISABLED || 64 state == BR_STATE_BLOCKING || 65 state == BR_STATE_LISTENING)) 66 ds->ops->port_fast_age(ds, port); 67 } 68 69 dp->stp_state = state; 70 71 return 0; 72} 73 74static void dsa_port_set_state_now(struct dsa_port *dp, u8 state) 75{ 76 int err; 77 78 err = dsa_port_set_state(dp, state, NULL); 79 if (err) 80 pr_err("DSA: failed to set STP state %u (%d)\n", state, err); 81} 82 83int dsa_port_enable_rt(struct dsa_port *dp, struct phy_device *phy) 84{ 85 struct dsa_switch *ds = dp->ds; 86 int port = dp->index; 87 int err; 88 89 if (ds->ops->port_enable) { 90 err = ds->ops->port_enable(ds, port, phy); 91 if (err) 92 return err; 93 } 94 95 if (!dp->bridge_dev) 96 dsa_port_set_state_now(dp, BR_STATE_FORWARDING); 97 98 if (dp->pl) 99 phylink_start(dp->pl); 100 101 return 0; 102} 103 104int dsa_port_enable(struct dsa_port *dp, struct phy_device *phy) 105{ 106 int err; 107 108 rtnl_lock(); 109 err = dsa_port_enable_rt(dp, phy); 110 rtnl_unlock(); 111 112 return err; 113} 114 115void dsa_port_disable_rt(struct dsa_port *dp) 116{ 117 struct dsa_switch *ds = dp->ds; 118 int port = dp->index; 119 120 if (dp->pl) 121 phylink_stop(dp->pl); 122 123 if (!dp->bridge_dev) 124 dsa_port_set_state_now(dp, BR_STATE_DISABLED); 125 126 if (ds->ops->port_disable) 127 ds->ops->port_disable(ds, port); 128} 129 130void dsa_port_disable(struct dsa_port *dp) 131{ 132 rtnl_lock(); 133 dsa_port_disable_rt(dp); 134 rtnl_unlock(); 135} 136 137int dsa_port_bridge_join(struct dsa_port *dp, struct net_device *br) 138{ 139 struct dsa_notifier_bridge_info info = { 140 .tree_index = dp->ds->dst->index, 141 .sw_index = dp->ds->index, 142 .port = dp->index, 143 .br = br, 144 }; 145 int err; 146 147 /* Set the flooding mode before joining the port in the switch */ 148 err = dsa_port_bridge_flags(dp, BR_FLOOD | BR_MCAST_FLOOD, NULL); 149 if (err) 150 return err; 151 152 /* Here the interface is already bridged. Reflect the current 153 * configuration so that drivers can program their chips accordingly. 154 */ 155 dp->bridge_dev = br; 156 157 err = dsa_broadcast(DSA_NOTIFIER_BRIDGE_JOIN, &info); 158 159 /* The bridging is rolled back on error */ 160 if (err) { 161 dsa_port_bridge_flags(dp, 0, NULL); 162 dp->bridge_dev = NULL; 163 } 164 165 return err; 166} 167 168void dsa_port_bridge_leave(struct dsa_port *dp, struct net_device *br) 169{ 170 struct dsa_notifier_bridge_info info = { 171 .tree_index = dp->ds->dst->index, 172 .sw_index = dp->ds->index, 173 .port = dp->index, 174 .br = br, 175 }; 176 int err; 177 178 /* Here the port is already unbridged. Reflect the current configuration 179 * so that drivers can program their chips accordingly. 180 */ 181 dp->bridge_dev = NULL; 182 183 err = dsa_broadcast(DSA_NOTIFIER_BRIDGE_LEAVE, &info); 184 if (err) 185 pr_err("DSA: failed to notify DSA_NOTIFIER_BRIDGE_LEAVE\n"); 186 187 /* Port is leaving the bridge, disable flooding */ 188 dsa_port_bridge_flags(dp, 0, NULL); 189 190 /* Port left the bridge, put in BR_STATE_DISABLED by the bridge layer, 191 * so allow it to be in BR_STATE_FORWARDING to be kept functional 192 */ 193 dsa_port_set_state_now(dp, BR_STATE_FORWARDING); 194} 195 196/* Must be called under rcu_read_lock() */ 197static bool dsa_port_can_apply_vlan_filtering(struct dsa_port *dp, 198 bool vlan_filtering) 199{ 200 struct dsa_switch *ds = dp->ds; 201 int err, i; 202 203 /* VLAN awareness was off, so the question is "can we turn it on". 204 * We may have had 8021q uppers, those need to go. Make sure we don't 205 * enter an inconsistent state: deny changing the VLAN awareness state 206 * as long as we have 8021q uppers. 207 */ 208 if (vlan_filtering && dsa_is_user_port(ds, dp->index)) { 209 struct net_device *upper_dev, *slave = dp->slave; 210 struct net_device *br = dp->bridge_dev; 211 struct list_head *iter; 212 213 netdev_for_each_upper_dev_rcu(slave, upper_dev, iter) { 214 struct bridge_vlan_info br_info; 215 u16 vid; 216 217 if (!is_vlan_dev(upper_dev)) 218 continue; 219 220 vid = vlan_dev_vlan_id(upper_dev); 221 222 /* br_vlan_get_info() returns -EINVAL or -ENOENT if the 223 * device, respectively the VID is not found, returning 224 * 0 means success, which is a failure for us here. 225 */ 226 err = br_vlan_get_info(br, vid, &br_info); 227 if (err == 0) { 228 dev_err(ds->dev, "Must remove upper %s first\n", 229 upper_dev->name); 230 return false; 231 } 232 } 233 } 234 235 if (!ds->vlan_filtering_is_global) 236 return true; 237 238 /* For cases where enabling/disabling VLAN awareness is global to the 239 * switch, we need to handle the case where multiple bridges span 240 * different ports of the same switch device and one of them has a 241 * different setting than what is being requested. 242 */ 243 for (i = 0; i < ds->num_ports; i++) { 244 struct net_device *other_bridge; 245 246 other_bridge = dsa_to_port(ds, i)->bridge_dev; 247 if (!other_bridge) 248 continue; 249 /* If it's the same bridge, it also has same 250 * vlan_filtering setting => no need to check 251 */ 252 if (other_bridge == dp->bridge_dev) 253 continue; 254 if (br_vlan_enabled(other_bridge) != vlan_filtering) { 255 dev_err(ds->dev, "VLAN filtering is a global setting\n"); 256 return false; 257 } 258 } 259 return true; 260} 261 262int dsa_port_vlan_filtering(struct dsa_port *dp, bool vlan_filtering, 263 struct switchdev_trans *trans) 264{ 265 struct dsa_switch *ds = dp->ds; 266 int err; 267 268 if (switchdev_trans_ph_prepare(trans)) { 269 bool apply; 270 271 if (!ds->ops->port_vlan_filtering) 272 return -EOPNOTSUPP; 273 274 /* We are called from dsa_slave_switchdev_blocking_event(), 275 * which is not under rcu_read_lock(), unlike 276 * dsa_slave_switchdev_event(). 277 */ 278 rcu_read_lock(); 279 apply = dsa_port_can_apply_vlan_filtering(dp, vlan_filtering); 280 rcu_read_unlock(); 281 if (!apply) 282 return -EINVAL; 283 } 284 285 if (dsa_port_is_vlan_filtering(dp) == vlan_filtering) 286 return 0; 287 288 err = ds->ops->port_vlan_filtering(ds, dp->index, vlan_filtering, 289 trans); 290 if (err) 291 return err; 292 293 if (switchdev_trans_ph_commit(trans)) { 294 if (ds->vlan_filtering_is_global) 295 ds->vlan_filtering = vlan_filtering; 296 else 297 dp->vlan_filtering = vlan_filtering; 298 } 299 300 return 0; 301} 302 303/* This enforces legacy behavior for switch drivers which assume they can't 304 * receive VLAN configuration when enslaved to a bridge with vlan_filtering=0 305 */ 306bool dsa_port_skip_vlan_configuration(struct dsa_port *dp) 307{ 308 struct dsa_switch *ds = dp->ds; 309 310 if (!dp->bridge_dev) 311 return false; 312 313 return (!ds->configure_vlan_while_not_filtering && 314 !br_vlan_enabled(dp->bridge_dev)); 315} 316 317int dsa_port_ageing_time(struct dsa_port *dp, clock_t ageing_clock, 318 struct switchdev_trans *trans) 319{ 320 unsigned long ageing_jiffies = clock_t_to_jiffies(ageing_clock); 321 unsigned int ageing_time = jiffies_to_msecs(ageing_jiffies); 322 struct dsa_notifier_ageing_time_info info = { 323 .ageing_time = ageing_time, 324 .trans = trans, 325 }; 326 327 if (switchdev_trans_ph_prepare(trans)) 328 return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info); 329 330 dp->ageing_time = ageing_time; 331 332 return dsa_port_notify(dp, DSA_NOTIFIER_AGEING_TIME, &info); 333} 334 335int dsa_port_pre_bridge_flags(const struct dsa_port *dp, unsigned long flags, 336 struct switchdev_trans *trans) 337{ 338 struct dsa_switch *ds = dp->ds; 339 340 if (!ds->ops->port_egress_floods || 341 (flags & ~(BR_FLOOD | BR_MCAST_FLOOD))) 342 return -EINVAL; 343 344 return 0; 345} 346 347int dsa_port_bridge_flags(const struct dsa_port *dp, unsigned long flags, 348 struct switchdev_trans *trans) 349{ 350 struct dsa_switch *ds = dp->ds; 351 int port = dp->index; 352 int err = 0; 353 354 if (switchdev_trans_ph_prepare(trans)) 355 return 0; 356 357 if (ds->ops->port_egress_floods) 358 err = ds->ops->port_egress_floods(ds, port, flags & BR_FLOOD, 359 flags & BR_MCAST_FLOOD); 360 361 return err; 362} 363 364int dsa_port_mrouter(struct dsa_port *dp, bool mrouter, 365 struct switchdev_trans *trans) 366{ 367 struct dsa_switch *ds = dp->ds; 368 int port = dp->index; 369 370 if (switchdev_trans_ph_prepare(trans)) 371 return ds->ops->port_egress_floods ? 0 : -EOPNOTSUPP; 372 373 return ds->ops->port_egress_floods(ds, port, true, mrouter); 374} 375 376int dsa_port_mtu_change(struct dsa_port *dp, int new_mtu, 377 bool propagate_upstream) 378{ 379 struct dsa_notifier_mtu_info info = { 380 .sw_index = dp->ds->index, 381 .propagate_upstream = propagate_upstream, 382 .port = dp->index, 383 .mtu = new_mtu, 384 }; 385 386 return dsa_port_notify(dp, DSA_NOTIFIER_MTU, &info); 387} 388 389int dsa_port_fdb_add(struct dsa_port *dp, const unsigned char *addr, 390 u16 vid) 391{ 392 struct dsa_notifier_fdb_info info = { 393 .sw_index = dp->ds->index, 394 .port = dp->index, 395 .addr = addr, 396 .vid = vid, 397 }; 398 399 return dsa_port_notify(dp, DSA_NOTIFIER_FDB_ADD, &info); 400} 401 402int dsa_port_fdb_del(struct dsa_port *dp, const unsigned char *addr, 403 u16 vid) 404{ 405 struct dsa_notifier_fdb_info info = { 406 .sw_index = dp->ds->index, 407 .port = dp->index, 408 .addr = addr, 409 .vid = vid, 410 411 }; 412 413 return dsa_port_notify(dp, DSA_NOTIFIER_FDB_DEL, &info); 414} 415 416int dsa_port_fdb_dump(struct dsa_port *dp, dsa_fdb_dump_cb_t *cb, void *data) 417{ 418 struct dsa_switch *ds = dp->ds; 419 int port = dp->index; 420 421 if (!ds->ops->port_fdb_dump) 422 return -EOPNOTSUPP; 423 424 return ds->ops->port_fdb_dump(ds, port, cb, data); 425} 426 427int dsa_port_mdb_add(const struct dsa_port *dp, 428 const struct switchdev_obj_port_mdb *mdb, 429 struct switchdev_trans *trans) 430{ 431 struct dsa_notifier_mdb_info info = { 432 .sw_index = dp->ds->index, 433 .port = dp->index, 434 .trans = trans, 435 .mdb = mdb, 436 }; 437 438 return dsa_port_notify(dp, DSA_NOTIFIER_MDB_ADD, &info); 439} 440 441int dsa_port_mdb_del(const struct dsa_port *dp, 442 const struct switchdev_obj_port_mdb *mdb) 443{ 444 struct dsa_notifier_mdb_info info = { 445 .sw_index = dp->ds->index, 446 .port = dp->index, 447 .mdb = mdb, 448 }; 449 450 return dsa_port_notify(dp, DSA_NOTIFIER_MDB_DEL, &info); 451} 452 453int dsa_port_vlan_add(struct dsa_port *dp, 454 const struct switchdev_obj_port_vlan *vlan, 455 struct switchdev_trans *trans) 456{ 457 struct dsa_notifier_vlan_info info = { 458 .sw_index = dp->ds->index, 459 .port = dp->index, 460 .trans = trans, 461 .vlan = vlan, 462 }; 463 464 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_ADD, &info); 465} 466 467int dsa_port_vlan_del(struct dsa_port *dp, 468 const struct switchdev_obj_port_vlan *vlan) 469{ 470 struct dsa_notifier_vlan_info info = { 471 .sw_index = dp->ds->index, 472 .port = dp->index, 473 .vlan = vlan, 474 }; 475 476 return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info); 477} 478 479static struct phy_device *dsa_port_get_phy_device(struct dsa_port *dp) 480{ 481 struct device_node *phy_dn; 482 struct phy_device *phydev; 483 484 phy_dn = of_parse_phandle(dp->dn, "phy-handle", 0); 485 if (!phy_dn) 486 return NULL; 487 488 phydev = of_phy_find_device(phy_dn); 489 if (!phydev) { 490 of_node_put(phy_dn); 491 return ERR_PTR(-EPROBE_DEFER); 492 } 493 494 of_node_put(phy_dn); 495 return phydev; 496} 497 498static void dsa_port_phylink_validate(struct phylink_config *config, 499 unsigned long *supported, 500 struct phylink_link_state *state) 501{ 502 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config); 503 struct dsa_switch *ds = dp->ds; 504 505 if (!ds->ops->phylink_validate) 506 return; 507 508 ds->ops->phylink_validate(ds, dp->index, supported, state); 509} 510 511static void dsa_port_phylink_mac_pcs_get_state(struct phylink_config *config, 512 struct phylink_link_state *state) 513{ 514 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config); 515 struct dsa_switch *ds = dp->ds; 516 int err; 517 518 /* Only called for inband modes */ 519 if (!ds->ops->phylink_mac_link_state) { 520 state->link = 0; 521 return; 522 } 523 524 err = ds->ops->phylink_mac_link_state(ds, dp->index, state); 525 if (err < 0) { 526 dev_err(ds->dev, "p%d: phylink_mac_link_state() failed: %d\n", 527 dp->index, err); 528 state->link = 0; 529 } 530} 531 532static void dsa_port_phylink_mac_config(struct phylink_config *config, 533 unsigned int mode, 534 const struct phylink_link_state *state) 535{ 536 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config); 537 struct dsa_switch *ds = dp->ds; 538 539 if (!ds->ops->phylink_mac_config) 540 return; 541 542 ds->ops->phylink_mac_config(ds, dp->index, mode, state); 543} 544 545static void dsa_port_phylink_mac_an_restart(struct phylink_config *config) 546{ 547 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config); 548 struct dsa_switch *ds = dp->ds; 549 550 if (!ds->ops->phylink_mac_an_restart) 551 return; 552 553 ds->ops->phylink_mac_an_restart(ds, dp->index); 554} 555 556static void dsa_port_phylink_mac_link_down(struct phylink_config *config, 557 unsigned int mode, 558 phy_interface_t interface) 559{ 560 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config); 561 struct phy_device *phydev = NULL; 562 struct dsa_switch *ds = dp->ds; 563 564 if (dsa_is_user_port(ds, dp->index)) 565 phydev = dp->slave->phydev; 566 567 if (!ds->ops->phylink_mac_link_down) { 568 if (ds->ops->adjust_link && phydev) 569 ds->ops->adjust_link(ds, dp->index, phydev); 570 return; 571 } 572 573 ds->ops->phylink_mac_link_down(ds, dp->index, mode, interface); 574} 575 576static void dsa_port_phylink_mac_link_up(struct phylink_config *config, 577 struct phy_device *phydev, 578 unsigned int mode, 579 phy_interface_t interface, 580 int speed, int duplex, 581 bool tx_pause, bool rx_pause) 582{ 583 struct dsa_port *dp = container_of(config, struct dsa_port, pl_config); 584 struct dsa_switch *ds = dp->ds; 585 586 if (!ds->ops->phylink_mac_link_up) { 587 if (ds->ops->adjust_link && phydev) 588 ds->ops->adjust_link(ds, dp->index, phydev); 589 return; 590 } 591 592 ds->ops->phylink_mac_link_up(ds, dp->index, mode, interface, phydev, 593 speed, duplex, tx_pause, rx_pause); 594} 595 596const struct phylink_mac_ops dsa_port_phylink_mac_ops = { 597 .validate = dsa_port_phylink_validate, 598 .mac_pcs_get_state = dsa_port_phylink_mac_pcs_get_state, 599 .mac_config = dsa_port_phylink_mac_config, 600 .mac_an_restart = dsa_port_phylink_mac_an_restart, 601 .mac_link_down = dsa_port_phylink_mac_link_down, 602 .mac_link_up = dsa_port_phylink_mac_link_up, 603}; 604 605static int dsa_port_setup_phy_of(struct dsa_port *dp, bool enable) 606{ 607 struct dsa_switch *ds = dp->ds; 608 struct phy_device *phydev; 609 int port = dp->index; 610 int err = 0; 611 612 phydev = dsa_port_get_phy_device(dp); 613 if (!phydev) 614 return 0; 615 616 if (IS_ERR(phydev)) 617 return PTR_ERR(phydev); 618 619 if (enable) { 620 err = genphy_resume(phydev); 621 if (err < 0) 622 goto err_put_dev; 623 624 err = genphy_read_status(phydev); 625 if (err < 0) 626 goto err_put_dev; 627 } else { 628 err = genphy_suspend(phydev); 629 if (err < 0) 630 goto err_put_dev; 631 } 632 633 if (ds->ops->adjust_link) 634 ds->ops->adjust_link(ds, port, phydev); 635 636 dev_dbg(ds->dev, "enabled port's phy: %s", phydev_name(phydev)); 637 638err_put_dev: 639 put_device(&phydev->mdio.dev); 640 return err; 641} 642 643static int dsa_port_fixed_link_register_of(struct dsa_port *dp) 644{ 645 struct device_node *dn = dp->dn; 646 struct dsa_switch *ds = dp->ds; 647 struct phy_device *phydev; 648 int port = dp->index; 649 phy_interface_t mode; 650 int err; 651 652 err = of_phy_register_fixed_link(dn); 653 if (err) { 654 dev_err(ds->dev, 655 "failed to register the fixed PHY of port %d\n", 656 port); 657 return err; 658 } 659 660 phydev = of_phy_find_device(dn); 661 662 err = of_get_phy_mode(dn, &mode); 663 if (err) 664 mode = PHY_INTERFACE_MODE_NA; 665 phydev->interface = mode; 666 667 genphy_read_status(phydev); 668 669 if (ds->ops->adjust_link) 670 ds->ops->adjust_link(ds, port, phydev); 671 672 put_device(&phydev->mdio.dev); 673 674 return 0; 675} 676 677static int dsa_port_phylink_register(struct dsa_port *dp) 678{ 679 struct dsa_switch *ds = dp->ds; 680 struct device_node *port_dn = dp->dn; 681 phy_interface_t mode; 682 int err; 683 684 err = of_get_phy_mode(port_dn, &mode); 685 if (err) 686 mode = PHY_INTERFACE_MODE_NA; 687 688 dp->pl_config.dev = ds->dev; 689 dp->pl_config.type = PHYLINK_DEV; 690 dp->pl_config.pcs_poll = ds->pcs_poll; 691 692 dp->pl = phylink_create(&dp->pl_config, of_fwnode_handle(port_dn), 693 mode, &dsa_port_phylink_mac_ops); 694 if (IS_ERR(dp->pl)) { 695 pr_err("error creating PHYLINK: %ld\n", PTR_ERR(dp->pl)); 696 return PTR_ERR(dp->pl); 697 } 698 699 err = phylink_of_phy_connect(dp->pl, port_dn, 0); 700 if (err && err != -ENODEV) { 701 pr_err("could not attach to PHY: %d\n", err); 702 goto err_phy_connect; 703 } 704 705 return 0; 706 707err_phy_connect: 708 phylink_destroy(dp->pl); 709 return err; 710} 711 712int dsa_port_link_register_of(struct dsa_port *dp) 713{ 714 struct dsa_switch *ds = dp->ds; 715 struct device_node *phy_np; 716 int port = dp->index; 717 718 if (!ds->ops->adjust_link) { 719 phy_np = of_parse_phandle(dp->dn, "phy-handle", 0); 720 if (of_phy_is_fixed_link(dp->dn) || phy_np) { 721 if (ds->ops->phylink_mac_link_down) 722 ds->ops->phylink_mac_link_down(ds, port, 723 MLO_AN_FIXED, PHY_INTERFACE_MODE_NA); 724 of_node_put(phy_np); 725 return dsa_port_phylink_register(dp); 726 } 727 of_node_put(phy_np); 728 return 0; 729 } 730 731 dev_warn(ds->dev, 732 "Using legacy PHYLIB callbacks. Please migrate to PHYLINK!\n"); 733 734 if (of_phy_is_fixed_link(dp->dn)) 735 return dsa_port_fixed_link_register_of(dp); 736 else 737 return dsa_port_setup_phy_of(dp, true); 738} 739 740void dsa_port_link_unregister_of(struct dsa_port *dp) 741{ 742 struct dsa_switch *ds = dp->ds; 743 744 if (!ds->ops->adjust_link && dp->pl) { 745 rtnl_lock(); 746 phylink_disconnect_phy(dp->pl); 747 rtnl_unlock(); 748 phylink_destroy(dp->pl); 749 dp->pl = NULL; 750 return; 751 } 752 753 if (of_phy_is_fixed_link(dp->dn)) 754 of_phy_deregister_fixed_link(dp->dn); 755 else 756 dsa_port_setup_phy_of(dp, false); 757} 758 759int dsa_port_get_phy_strings(struct dsa_port *dp, uint8_t *data) 760{ 761 struct phy_device *phydev; 762 int ret = -EOPNOTSUPP; 763 764 if (of_phy_is_fixed_link(dp->dn)) 765 return ret; 766 767 phydev = dsa_port_get_phy_device(dp); 768 if (IS_ERR_OR_NULL(phydev)) 769 return ret; 770 771 ret = phy_ethtool_get_strings(phydev, data); 772 put_device(&phydev->mdio.dev); 773 774 return ret; 775} 776EXPORT_SYMBOL_GPL(dsa_port_get_phy_strings); 777 778int dsa_port_get_ethtool_phy_stats(struct dsa_port *dp, uint64_t *data) 779{ 780 struct phy_device *phydev; 781 int ret = -EOPNOTSUPP; 782 783 if (of_phy_is_fixed_link(dp->dn)) 784 return ret; 785 786 phydev = dsa_port_get_phy_device(dp); 787 if (IS_ERR_OR_NULL(phydev)) 788 return ret; 789 790 ret = phy_ethtool_get_stats(phydev, NULL, data); 791 put_device(&phydev->mdio.dev); 792 793 return ret; 794} 795EXPORT_SYMBOL_GPL(dsa_port_get_ethtool_phy_stats); 796 797int dsa_port_get_phy_sset_count(struct dsa_port *dp) 798{ 799 struct phy_device *phydev; 800 int ret = -EOPNOTSUPP; 801 802 if (of_phy_is_fixed_link(dp->dn)) 803 return ret; 804 805 phydev = dsa_port_get_phy_device(dp); 806 if (IS_ERR_OR_NULL(phydev)) 807 return ret; 808 809 ret = phy_ethtool_get_sset_count(phydev); 810 put_device(&phydev->mdio.dev); 811 812 return ret; 813} 814EXPORT_SYMBOL_GPL(dsa_port_get_phy_sset_count); 815