Lines Matching +full:synclko +full:- +full:disable
1 // SPDX-License-Identifier: GPL-2.0
5 * Copyright (C) 2017-2024 Microchip Technology Inc.
14 #include <linux/platform_data/microchip-ksz.h>
205 * struct ksz_drive_strength - drive strength mapping
214 /* ksz9477_drive_strengths - Drive strength mapping for KSZ9477 variants
222 * - for high speed signals
232 * - for low speed signals
249 /* ksz88x3_drive_strengths - Drive strength mapping for KSZ8863, KSZ8873, ..
1379 * port map is NOT continuous. The per-port register
1960 if (chip->chip_id == prod_num) in ksz_lookup_info()
1972 if (dev->pdata) { in ksz_check_device_id()
1973 expected_chip_id = dev->pdata->chip_id; in ksz_check_device_id()
1976 return -ENODEV; in ksz_check_device_id()
1978 expected_chip_data = of_device_get_match_data(dev->dev); in ksz_check_device_id()
1979 expected_chip_id = expected_chip_data->chip_id; in ksz_check_device_id()
1982 if (expected_chip_id != dev->chip_id) { in ksz_check_device_id()
1983 dev_err(dev->dev, in ksz_check_device_id()
1985 expected_chip_data->dev_name, dev->info->dev_name); in ksz_check_device_id()
1986 return -ENODEV; in ksz_check_device_id()
1995 struct ksz_device *dev = ds->priv; in ksz_phylink_get_caps()
1997 if (dev->info->supports_mii[port]) in ksz_phylink_get_caps()
1998 __set_bit(PHY_INTERFACE_MODE_MII, config->supported_interfaces); in ksz_phylink_get_caps()
2000 if (dev->info->supports_rmii[port]) in ksz_phylink_get_caps()
2002 config->supported_interfaces); in ksz_phylink_get_caps()
2004 if (dev->info->supports_rgmii[port]) in ksz_phylink_get_caps()
2005 phy_interface_set_rgmii(config->supported_interfaces); in ksz_phylink_get_caps()
2007 if (dev->info->internal_phy[port]) { in ksz_phylink_get_caps()
2009 config->supported_interfaces); in ksz_phylink_get_caps()
2011 * phy-mode property is absent in ksz_phylink_get_caps()
2014 config->supported_interfaces); in ksz_phylink_get_caps()
2017 if (dev->dev_ops->get_caps) in ksz_phylink_get_caps()
2018 dev->dev_ops->get_caps(dev, port, config); in ksz_phylink_get_caps()
2029 mib = &dev->ports[port].mib; in ksz_r_mib_stats64()
2030 stats = &mib->stats64; in ksz_r_mib_stats64()
2031 pstats = &mib->pause_stats; in ksz_r_mib_stats64()
2032 raw = (struct ksz_stats_raw *)mib->counters; in ksz_r_mib_stats64()
2034 spin_lock(&mib->stats64_lock); in ksz_r_mib_stats64()
2036 stats->rx_packets = raw->rx_bcast + raw->rx_mcast + raw->rx_ucast + in ksz_r_mib_stats64()
2037 raw->rx_pause; in ksz_r_mib_stats64()
2038 stats->tx_packets = raw->tx_bcast + raw->tx_mcast + raw->tx_ucast + in ksz_r_mib_stats64()
2039 raw->tx_pause; in ksz_r_mib_stats64()
2044 stats->rx_bytes = raw->rx_total - stats->rx_packets * ETH_FCS_LEN; in ksz_r_mib_stats64()
2045 stats->tx_bytes = raw->tx_total - stats->tx_packets * ETH_FCS_LEN; in ksz_r_mib_stats64()
2047 stats->rx_length_errors = raw->rx_undersize + raw->rx_fragments + in ksz_r_mib_stats64()
2048 raw->rx_oversize; in ksz_r_mib_stats64()
2050 stats->rx_crc_errors = raw->rx_crc_err; in ksz_r_mib_stats64()
2051 stats->rx_frame_errors = raw->rx_align_err; in ksz_r_mib_stats64()
2052 stats->rx_dropped = raw->rx_discards; in ksz_r_mib_stats64()
2053 stats->rx_errors = stats->rx_length_errors + stats->rx_crc_errors + in ksz_r_mib_stats64()
2054 stats->rx_frame_errors + stats->rx_dropped; in ksz_r_mib_stats64()
2056 stats->tx_window_errors = raw->tx_late_col; in ksz_r_mib_stats64()
2057 stats->tx_fifo_errors = raw->tx_discards; in ksz_r_mib_stats64()
2058 stats->tx_aborted_errors = raw->tx_exc_col; in ksz_r_mib_stats64()
2059 stats->tx_errors = stats->tx_window_errors + stats->tx_fifo_errors + in ksz_r_mib_stats64()
2060 stats->tx_aborted_errors; in ksz_r_mib_stats64()
2062 stats->multicast = raw->rx_mcast; in ksz_r_mib_stats64()
2063 stats->collisions = raw->tx_total_col; in ksz_r_mib_stats64()
2065 pstats->tx_pause_frames = raw->tx_pause; in ksz_r_mib_stats64()
2066 pstats->rx_pause_frames = raw->rx_pause; in ksz_r_mib_stats64()
2068 spin_unlock(&mib->stats64_lock); in ksz_r_mib_stats64()
2070 if (dev->info->phy_errata_9477) { in ksz_r_mib_stats64()
2071 ret = ksz9477_errata_monitor(dev, port, raw->tx_late_col); in ksz_r_mib_stats64()
2073 dev_err(dev->dev, "Failed to monitor transmission halt\n"); in ksz_r_mib_stats64()
2084 mib = &dev->ports[port].mib; in ksz88xx_r_mib_stats64()
2085 stats = &mib->stats64; in ksz88xx_r_mib_stats64()
2086 pstats = &mib->pause_stats; in ksz88xx_r_mib_stats64()
2087 raw = (struct ksz88xx_stats_raw *)mib->counters; in ksz88xx_r_mib_stats64()
2089 spin_lock(&mib->stats64_lock); in ksz88xx_r_mib_stats64()
2091 stats->rx_packets = raw->rx_bcast + raw->rx_mcast + raw->rx_ucast + in ksz88xx_r_mib_stats64()
2092 raw->rx_pause; in ksz88xx_r_mib_stats64()
2093 stats->tx_packets = raw->tx_bcast + raw->tx_mcast + raw->tx_ucast + in ksz88xx_r_mib_stats64()
2094 raw->tx_pause; in ksz88xx_r_mib_stats64()
2099 stats->rx_bytes = raw->rx + raw->rx_hi - stats->rx_packets * ETH_FCS_LEN; in ksz88xx_r_mib_stats64()
2100 stats->tx_bytes = raw->tx + raw->tx_hi - stats->tx_packets * ETH_FCS_LEN; in ksz88xx_r_mib_stats64()
2102 stats->rx_length_errors = raw->rx_undersize + raw->rx_fragments + in ksz88xx_r_mib_stats64()
2103 raw->rx_oversize; in ksz88xx_r_mib_stats64()
2105 stats->rx_crc_errors = raw->rx_crc_err; in ksz88xx_r_mib_stats64()
2106 stats->rx_frame_errors = raw->rx_align_err; in ksz88xx_r_mib_stats64()
2107 stats->rx_dropped = raw->rx_discards; in ksz88xx_r_mib_stats64()
2108 stats->rx_errors = stats->rx_length_errors + stats->rx_crc_errors + in ksz88xx_r_mib_stats64()
2109 stats->rx_frame_errors + stats->rx_dropped; in ksz88xx_r_mib_stats64()
2111 stats->tx_window_errors = raw->tx_late_col; in ksz88xx_r_mib_stats64()
2112 stats->tx_fifo_errors = raw->tx_discards; in ksz88xx_r_mib_stats64()
2113 stats->tx_aborted_errors = raw->tx_exc_col; in ksz88xx_r_mib_stats64()
2114 stats->tx_errors = stats->tx_window_errors + stats->tx_fifo_errors + in ksz88xx_r_mib_stats64()
2115 stats->tx_aborted_errors; in ksz88xx_r_mib_stats64()
2117 stats->multicast = raw->rx_mcast; in ksz88xx_r_mib_stats64()
2118 stats->collisions = raw->tx_total_col; in ksz88xx_r_mib_stats64()
2120 pstats->tx_pause_frames = raw->tx_pause; in ksz88xx_r_mib_stats64()
2121 pstats->rx_pause_frames = raw->rx_pause; in ksz88xx_r_mib_stats64()
2123 spin_unlock(&mib->stats64_lock); in ksz88xx_r_mib_stats64()
2129 struct ksz_device *dev = ds->priv; in ksz_get_stats64()
2132 mib = &dev->ports[port].mib; in ksz_get_stats64()
2134 spin_lock(&mib->stats64_lock); in ksz_get_stats64()
2135 memcpy(s, &mib->stats64, sizeof(*s)); in ksz_get_stats64()
2136 spin_unlock(&mib->stats64_lock); in ksz_get_stats64()
2142 struct ksz_device *dev = ds->priv; in ksz_get_pause_stats()
2145 mib = &dev->ports[port].mib; in ksz_get_pause_stats()
2147 spin_lock(&mib->stats64_lock); in ksz_get_pause_stats()
2148 memcpy(pause_stats, &mib->pause_stats, sizeof(*pause_stats)); in ksz_get_pause_stats()
2149 spin_unlock(&mib->stats64_lock); in ksz_get_pause_stats()
2155 struct ksz_device *dev = ds->priv; in ksz_get_strings()
2161 for (i = 0; i < dev->info->mib_cnt; i++) in ksz_get_strings()
2162 ethtool_puts(&buf, dev->info->mib_names[i].string); in ksz_get_strings()
2166 * ksz_update_port_member - Adjust port forwarding rules based on STP state and
2190 struct ksz_port *p = &dev->ports[port]; in ksz_update_port_member()
2191 struct dsa_switch *ds = dev->ds; in ksz_update_port_member()
2202 for (i = 0; i < ds->num_ports; i++) { in ksz_update_port_member()
2204 struct ksz_port *other_p = &dev->ports[i]; in ksz_update_port_member()
2213 if (other_p->stp_state != BR_STATE_FORWARDING) in ksz_update_port_member()
2222 if (p->stp_state == BR_STATE_FORWARDING && in ksz_update_port_member()
2223 !(p->isolated && other_p->isolated)) { in ksz_update_port_member()
2229 for (j = 0; j < ds->num_ports; j++) { in ksz_update_port_member()
2239 third_p = &dev->ports[j]; in ksz_update_port_member()
2240 if (third_p->stp_state != BR_STATE_FORWARDING) in ksz_update_port_member()
2254 !(other_p->isolated && third_p->isolated)) in ksz_update_port_member()
2258 dev->dev_ops->cfg_port_member(dev, i, val | cpu_port); in ksz_update_port_member()
2261 dev->dev_ops->cfg_port_member(dev, port, port_member | cpu_port); in ksz_update_port_member()
2266 struct ksz_device *dev = bus->priv; in ksz_sw_mdio_read()
2270 ret = dev->dev_ops->r_phy(dev, addr, regnum, &val); in ksz_sw_mdio_read()
2280 struct ksz_device *dev = bus->priv; in ksz_sw_mdio_write()
2282 return dev->dev_ops->w_phy(dev, addr, regnum, val); in ksz_sw_mdio_write()
2286 * ksz_parent_mdio_read - Read data from a PHY register on the parent MDIO bus.
2300 struct ksz_device *dev = bus->priv; in ksz_parent_mdio_read()
2302 return mdiobus_read_nested(dev->parent_mdio_bus, addr, regnum); in ksz_parent_mdio_read()
2306 * ksz_parent_mdio_write - Write data to a PHY register on the parent MDIO bus.
2321 struct ksz_device *dev = bus->priv; in ksz_parent_mdio_write()
2323 return mdiobus_write_nested(dev->parent_mdio_bus, addr, regnum, val); in ksz_parent_mdio_write()
2327 * ksz_phy_addr_to_port - Map a PHY address to the corresponding switch port.
2337 * Return: Port index on success, or -EINVAL if no matching port is found.
2341 struct dsa_switch *ds = dev->ds; in ksz_phy_addr_to_port()
2345 if (dev->info->internal_phy[dp->index] && in ksz_phy_addr_to_port()
2346 dev->phy_addr_map[dp->index] == addr) in ksz_phy_addr_to_port()
2347 return dp->index; in ksz_phy_addr_to_port()
2350 return -EINVAL; in ksz_phy_addr_to_port()
2354 * ksz_irq_phy_setup - Configure IRQs for PHYs in the KSZ device.
2365 struct dsa_switch *ds = dev->ds; in ksz_irq_phy_setup()
2371 if (BIT(phy) & ds->phys_mii_mask) { in ksz_irq_phy_setup()
2378 irq = irq_find_mapping(dev->ports[port].pirq.domain, in ksz_irq_phy_setup()
2384 ds->user_mii_bus->irq[phy] = irq; in ksz_irq_phy_setup()
2389 while (phy--) in ksz_irq_phy_setup()
2390 if (BIT(phy) & ds->phys_mii_mask) in ksz_irq_phy_setup()
2391 irq_dispose_mapping(ds->user_mii_bus->irq[phy]); in ksz_irq_phy_setup()
2397 * ksz_irq_phy_free - Release IRQ mappings for PHYs in the KSZ device.
2405 struct dsa_switch *ds = dev->ds; in ksz_irq_phy_free()
2409 if (BIT(phy) & ds->phys_mii_mask) in ksz_irq_phy_free()
2410 irq_dispose_mapping(ds->user_mii_bus->irq[phy]); in ksz_irq_phy_free()
2414 * ksz_parse_dt_phy_config - Parse and validate PHY configuration from DT
2421 * `phy-handle` properties are correctly set and that the internal PHYs match
2436 dsa_switch_for_each_user_port(dp, dev->ds) { in ksz_parse_dt_phy_config()
2437 if (!dev->info->internal_phy[dp->index]) in ksz_parse_dt_phy_config()
2440 phy_node = of_parse_phandle(dp->dn, "phy-handle", 0); in ksz_parse_dt_phy_config()
2442 dev_err(dev->dev, "failed to parse phy-handle for port %d.\n", in ksz_parse_dt_phy_config()
2443 dp->index); in ksz_parse_dt_phy_config()
2450 dev_err(dev->dev, "failed to get PHY-parent node for port %d\n", in ksz_parse_dt_phy_config()
2451 dp->index); in ksz_parse_dt_phy_config()
2454 dev_err(dev->dev, "PHY-parent node mismatch for port %d, expected %pOF, got %pOF\n", in ksz_parse_dt_phy_config()
2455 dp->index, mdio_np, phy_parent_node); in ksz_parse_dt_phy_config()
2460 dev_err(dev->dev, "failed to read PHY address for port %d. Error %d\n", in ksz_parse_dt_phy_config()
2461 dp->index, ret); in ksz_parse_dt_phy_config()
2463 } else if (phy_addr != dev->phy_addr_map[dp->index]) { in ksz_parse_dt_phy_config()
2464 dev_err(dev->dev, "PHY address mismatch for port %d, expected 0x%x, got 0x%x\n", in ksz_parse_dt_phy_config()
2465 dp->index, dev->phy_addr_map[dp->index], in ksz_parse_dt_phy_config()
2469 bus->phy_mask |= BIT(phy_addr); in ksz_parse_dt_phy_config()
2478 return -EINVAL; in ksz_parse_dt_phy_config()
2484 * ksz_mdio_register - Register and configure the MDIO bus for the KSZ device.
2490 * "mdio-parent-bus" device tree property to directly manage internal PHYs.
2499 struct dsa_switch *ds = dev->ds; in ksz_mdio_register()
2504 mdio_np = of_get_child_by_name(dev->dev->of_node, "mdio"); in ksz_mdio_register()
2508 parent_bus_node = of_parse_phandle(mdio_np, "mdio-parent-bus", 0); in ksz_mdio_register()
2509 if (parent_bus_node && !dev->info->phy_side_mdio_supported) { in ksz_mdio_register()
2510 …dev_err(dev->dev, "Side MDIO bus is not supported for this HW, ignoring 'mdio-parent-bus' property… in ksz_mdio_register()
2511 ret = -EINVAL; in ksz_mdio_register()
2517 ret = -EPROBE_DEFER; in ksz_mdio_register()
2522 dev->parent_mdio_bus = parent_bus; in ksz_mdio_register()
2525 bus = devm_mdiobus_alloc(ds->dev); in ksz_mdio_register()
2527 ret = -ENOMEM; in ksz_mdio_register()
2531 if (dev->dev_ops->mdio_bus_preinit) { in ksz_mdio_register()
2532 ret = dev->dev_ops->mdio_bus_preinit(dev, !!parent_bus); in ksz_mdio_register()
2537 if (dev->dev_ops->create_phy_addr_map) { in ksz_mdio_register()
2538 ret = dev->dev_ops->create_phy_addr_map(dev, !!parent_bus); in ksz_mdio_register()
2542 for (i = 0; i < dev->info->port_cnt; i++) in ksz_mdio_register()
2543 dev->phy_addr_map[i] = i; in ksz_mdio_register()
2546 bus->priv = dev; in ksz_mdio_register()
2548 bus->read = ksz_parent_mdio_read; in ksz_mdio_register()
2549 bus->write = ksz_parent_mdio_write; in ksz_mdio_register()
2550 bus->name = "KSZ side MDIO"; in ksz_mdio_register()
2551 snprintf(bus->id, MII_BUS_ID_SIZE, "ksz-side-mdio-%d", in ksz_mdio_register()
2552 ds->index); in ksz_mdio_register()
2554 bus->read = ksz_sw_mdio_read; in ksz_mdio_register()
2555 bus->write = ksz_sw_mdio_write; in ksz_mdio_register()
2556 bus->name = "ksz user smi"; in ksz_mdio_register()
2557 if (ds->dst->index != 0) { in ksz_mdio_register()
2558 snprintf(bus->id, MII_BUS_ID_SIZE, "SMI-%d-%d", ds->dst->index, ds->index); in ksz_mdio_register()
2560 snprintf(bus->id, MII_BUS_ID_SIZE, "SMI-%d", ds->index); in ksz_mdio_register()
2568 ds->phys_mii_mask = bus->phy_mask; in ksz_mdio_register()
2569 bus->parent = ds->dev; in ksz_mdio_register()
2571 ds->user_mii_bus = bus; in ksz_mdio_register()
2573 if (dev->irq > 0) { in ksz_mdio_register()
2579 ret = devm_of_mdiobus_register(ds->dev, bus, mdio_np); in ksz_mdio_register()
2581 dev_err(ds->dev, "unable to register MDIO bus %s\n", in ksz_mdio_register()
2582 bus->id); in ksz_mdio_register()
2583 if (dev->irq > 0) in ksz_mdio_register()
2598 kirq->masked |= BIT(d->hwirq); in ksz_irq_mask()
2605 kirq->masked &= ~BIT(d->hwirq); in ksz_irq_unmask()
2612 mutex_lock(&kirq->dev->lock_irq); in ksz_irq_bus_lock()
2618 struct ksz_device *dev = kirq->dev; in ksz_irq_bus_sync_unlock()
2621 ret = ksz_write8(dev, kirq->reg_mask, kirq->masked); in ksz_irq_bus_sync_unlock()
2623 dev_err(dev->dev, "failed to change IRQ mask\n"); in ksz_irq_bus_sync_unlock()
2625 mutex_unlock(&dev->lock_irq); in ksz_irq_bus_sync_unlock()
2629 .name = "ksz-irq",
2639 irq_set_chip_data(irq, d->host_data); in ksz_irq_domain_map()
2655 free_irq(kirq->irq_num, kirq); in ksz_irq_free()
2657 for (irq = 0; irq < kirq->nirqs; irq++) { in ksz_irq_free()
2658 virq = irq_find_mapping(kirq->domain, irq); in ksz_irq_free()
2662 irq_domain_remove(kirq->domain); in ksz_irq_free()
2675 dev = kirq->dev; in ksz_irq_thread_fn()
2678 ret = ksz_read8(dev, kirq->reg_status, &data); in ksz_irq_thread_fn()
2682 for (n = 0; n < kirq->nirqs; ++n) { in ksz_irq_thread_fn()
2684 sub_irq = irq_find_mapping(kirq->domain, n); in ksz_irq_thread_fn()
2697 kirq->dev = dev; in ksz_irq_common_setup()
2698 kirq->masked = ~0; in ksz_irq_common_setup()
2700 kirq->domain = irq_domain_add_simple(dev->dev->of_node, kirq->nirqs, 0, in ksz_irq_common_setup()
2702 if (!kirq->domain) in ksz_irq_common_setup()
2703 return -ENOMEM; in ksz_irq_common_setup()
2705 for (n = 0; n < kirq->nirqs; n++) in ksz_irq_common_setup()
2706 irq_create_mapping(kirq->domain, n); in ksz_irq_common_setup()
2708 ret = request_threaded_irq(kirq->irq_num, NULL, ksz_irq_thread_fn, in ksz_irq_common_setup()
2709 IRQF_ONESHOT, kirq->name, kirq); in ksz_irq_common_setup()
2723 struct ksz_irq *girq = &dev->girq; in ksz_girq_setup()
2725 girq->nirqs = dev->info->port_cnt; in ksz_girq_setup()
2726 girq->reg_mask = REG_SW_PORT_INT_MASK__1; in ksz_girq_setup()
2727 girq->reg_status = REG_SW_PORT_INT_STATUS__1; in ksz_girq_setup()
2728 snprintf(girq->name, sizeof(girq->name), "global_port_irq"); in ksz_girq_setup()
2730 girq->irq_num = dev->irq; in ksz_girq_setup()
2737 struct ksz_irq *pirq = &dev->ports[p].pirq; in ksz_pirq_setup()
2739 pirq->nirqs = dev->info->port_nirqs; in ksz_pirq_setup()
2740 pirq->reg_mask = dev->dev_ops->get_port_addr(p, REG_PORT_INT_MASK); in ksz_pirq_setup()
2741 pirq->reg_status = dev->dev_ops->get_port_addr(p, REG_PORT_INT_STATUS); in ksz_pirq_setup()
2742 snprintf(pirq->name, sizeof(pirq->name), "port_irq-%d", p); in ksz_pirq_setup()
2744 pirq->irq_num = irq_find_mapping(dev->girq.domain, p); in ksz_pirq_setup()
2745 if (pirq->irq_num < 0) in ksz_pirq_setup()
2746 return pirq->irq_num; in ksz_pirq_setup()
2755 struct ksz_device *dev = ds->priv; in ksz_setup()
2761 regs = dev->info->regs; in ksz_setup()
2763 dev->vlan_cache = devm_kcalloc(dev->dev, sizeof(struct vlan_table), in ksz_setup()
2764 dev->info->num_vlans, GFP_KERNEL); in ksz_setup()
2765 if (!dev->vlan_cache) in ksz_setup()
2766 return -ENOMEM; in ksz_setup()
2768 ret = dev->dev_ops->reset(dev); in ksz_setup()
2770 dev_err(ds->dev, "failed to reset switch\n"); in ksz_setup()
2784 dev->dev_ops->config_cpu_port(ds); in ksz_setup()
2786 dev->dev_ops->enable_stp_addr(dev); in ksz_setup()
2788 ds->num_tx_queues = dev->info->num_tx_queues; in ksz_setup()
2795 ds->configure_vlan_while_not_filtering = false; in ksz_setup()
2796 ds->dscp_prio_mapping_is_global = true; in ksz_setup()
2798 if (dev->dev_ops->setup) { in ksz_setup()
2799 ret = dev->dev_ops->setup(ds); in ksz_setup()
2809 p = &dev->ports[dev->cpu_port]; in ksz_setup()
2810 p->learning = true; in ksz_setup()
2812 if (dev->irq > 0) { in ksz_setup()
2817 dsa_switch_for_each_user_port(dp, dev->ds) { in ksz_setup()
2818 ret = ksz_pirq_setup(dev, dp->index); in ksz_setup()
2822 if (dev->info->ptp_capable) { in ksz_setup()
2823 ret = ksz_ptp_irq_setup(ds, dp->index); in ksz_setup()
2830 if (dev->info->ptp_capable) { in ksz_setup()
2833 dev_err(dev->dev, "Failed to register PTP clock: %d\n", in ksz_setup()
2841 dev_err(dev->dev, "failed to register the mdio"); in ksz_setup()
2856 if (dev->info->ptp_capable) in ksz_setup()
2859 if (dev->irq > 0 && dev->info->ptp_capable) in ksz_setup()
2860 dsa_switch_for_each_user_port(dp, dev->ds) in ksz_setup()
2861 ksz_ptp_irq_free(ds, dp->index); in ksz_setup()
2863 if (dev->irq > 0) in ksz_setup()
2864 dsa_switch_for_each_user_port(dp, dev->ds) in ksz_setup()
2865 ksz_irq_free(&dev->ports[dp->index].pirq); in ksz_setup()
2867 if (dev->irq > 0) in ksz_setup()
2868 ksz_irq_free(&dev->girq); in ksz_setup()
2875 struct ksz_device *dev = ds->priv; in ksz_teardown()
2878 if (dev->info->ptp_capable) in ksz_teardown()
2881 if (dev->irq > 0) { in ksz_teardown()
2882 dsa_switch_for_each_user_port(dp, dev->ds) { in ksz_teardown()
2883 if (dev->info->ptp_capable) in ksz_teardown()
2884 ksz_ptp_irq_free(ds, dp->index); in ksz_teardown()
2886 ksz_irq_free(&dev->ports[dp->index].pirq); in ksz_teardown()
2889 ksz_irq_free(&dev->girq); in ksz_teardown()
2892 if (dev->dev_ops->teardown) in ksz_teardown()
2893 dev->dev_ops->teardown(ds); in ksz_teardown()
2898 struct ksz_port_mib *mib = &dev->ports[port].mib; in port_r_cnt()
2902 while (mib->cnt_ptr < dev->info->reg_mib_cnt) { in port_r_cnt()
2903 dev->dev_ops->r_mib_cnt(dev, port, mib->cnt_ptr, in port_r_cnt()
2904 &mib->counters[mib->cnt_ptr]); in port_r_cnt()
2905 ++mib->cnt_ptr; in port_r_cnt()
2909 dropped = &mib->counters[dev->info->mib_cnt]; in port_r_cnt()
2912 while (mib->cnt_ptr < dev->info->mib_cnt) { in port_r_cnt()
2913 dev->dev_ops->r_mib_pkt(dev, port, mib->cnt_ptr, in port_r_cnt()
2914 dropped, &mib->counters[mib->cnt_ptr]); in port_r_cnt()
2915 ++mib->cnt_ptr; in port_r_cnt()
2917 mib->cnt_ptr = 0; in port_r_cnt()
2928 for (i = 0; i < dev->info->port_cnt; i++) { in ksz_mib_read_work()
2929 if (dsa_is_unused_port(dev->ds, i)) in ksz_mib_read_work()
2932 p = &dev->ports[i]; in ksz_mib_read_work()
2933 mib = &p->mib; in ksz_mib_read_work()
2934 mutex_lock(&mib->cnt_mutex); in ksz_mib_read_work()
2939 if (!p->read) { in ksz_mib_read_work()
2940 const struct dsa_port *dp = dsa_to_port(dev->ds, i); in ksz_mib_read_work()
2942 if (!netif_carrier_ok(dp->user)) in ksz_mib_read_work()
2943 mib->cnt_ptr = dev->info->reg_mib_cnt; in ksz_mib_read_work()
2946 p->read = false; in ksz_mib_read_work()
2948 if (dev->dev_ops->r_mib_stat64) in ksz_mib_read_work()
2949 dev->dev_ops->r_mib_stat64(dev, i); in ksz_mib_read_work()
2951 mutex_unlock(&mib->cnt_mutex); in ksz_mib_read_work()
2954 schedule_delayed_work(&dev->mib_read, dev->mib_read_interval); in ksz_mib_read_work()
2961 INIT_DELAYED_WORK(&dev->mib_read, ksz_mib_read_work); in ksz_init_mib_timer()
2963 for (i = 0; i < dev->info->port_cnt; i++) { in ksz_init_mib_timer()
2964 struct ksz_port_mib *mib = &dev->ports[i].mib; in ksz_init_mib_timer()
2966 dev->dev_ops->port_init_cnt(dev, i); in ksz_init_mib_timer()
2968 mib->cnt_ptr = 0; in ksz_init_mib_timer()
2969 memset(mib->counters, 0, dev->info->mib_cnt * sizeof(u64)); in ksz_init_mib_timer()
2975 struct ksz_device *dev = ds->priv; in ksz_phy_read16()
2979 ret = dev->dev_ops->r_phy(dev, addr, reg, &val); in ksz_phy_read16()
2988 struct ksz_device *dev = ds->priv; in ksz_phy_write16()
2991 ret = dev->dev_ops->w_phy(dev, addr, reg, val); in ksz_phy_write16()
3000 struct ksz_device *dev = ds->priv; in ksz_get_phy_flags()
3002 switch (dev->chip_id) { in ksz_get_phy_flags()
3005 * Port 1 does not work with LinkMD Cable-Testing. in ksz_get_phy_flags()
3029 * controls. If not disabled, the PHY ports can auto-negotiate in ksz_get_phy_flags()
3046 struct ksz_device *dev = dp->ds->priv; in ksz_phylink_mac_link_down()
3049 dev->ports[dp->index].read = true; in ksz_phylink_mac_link_down()
3051 if (dev->mib_read_interval) in ksz_phylink_mac_link_down()
3052 schedule_delayed_work(&dev->mib_read, 0); in ksz_phylink_mac_link_down()
3057 struct ksz_device *dev = ds->priv; in ksz_sset_count()
3062 return dev->info->mib_cnt; in ksz_sset_count()
3069 struct ksz_device *dev = ds->priv; in ksz_get_ethtool_stats()
3072 mib = &dev->ports[port].mib; in ksz_get_ethtool_stats()
3073 mutex_lock(&mib->cnt_mutex); in ksz_get_ethtool_stats()
3076 if (!netif_carrier_ok(dp->user)) in ksz_get_ethtool_stats()
3077 mib->cnt_ptr = dev->info->reg_mib_cnt; in ksz_get_ethtool_stats()
3079 memcpy(buf, mib->counters, dev->info->mib_cnt * sizeof(u64)); in ksz_get_ethtool_stats()
3080 mutex_unlock(&mib->cnt_mutex); in ksz_get_ethtool_stats()
3105 struct ksz_device *dev = ds->priv; in ksz_port_fast_age()
3107 dev->dev_ops->flush_dyn_mac_table(dev, port); in ksz_port_fast_age()
3112 struct ksz_device *dev = ds->priv; in ksz_set_ageing_time()
3114 if (!dev->dev_ops->set_ageing_time) in ksz_set_ageing_time()
3115 return -EOPNOTSUPP; in ksz_set_ageing_time()
3117 return dev->dev_ops->set_ageing_time(dev, msecs); in ksz_set_ageing_time()
3124 struct ksz_device *dev = ds->priv; in ksz_port_fdb_add()
3126 if (!dev->dev_ops->fdb_add) in ksz_port_fdb_add()
3127 return -EOPNOTSUPP; in ksz_port_fdb_add()
3129 return dev->dev_ops->fdb_add(dev, port, addr, vid, db); in ksz_port_fdb_add()
3136 struct ksz_device *dev = ds->priv; in ksz_port_fdb_del()
3138 if (!dev->dev_ops->fdb_del) in ksz_port_fdb_del()
3139 return -EOPNOTSUPP; in ksz_port_fdb_del()
3141 return dev->dev_ops->fdb_del(dev, port, addr, vid, db); in ksz_port_fdb_del()
3147 struct ksz_device *dev = ds->priv; in ksz_port_fdb_dump()
3149 if (!dev->dev_ops->fdb_dump) in ksz_port_fdb_dump()
3150 return -EOPNOTSUPP; in ksz_port_fdb_dump()
3152 return dev->dev_ops->fdb_dump(dev, port, cb, data); in ksz_port_fdb_dump()
3159 struct ksz_device *dev = ds->priv; in ksz_port_mdb_add()
3161 if (!dev->dev_ops->mdb_add) in ksz_port_mdb_add()
3162 return -EOPNOTSUPP; in ksz_port_mdb_add()
3164 return dev->dev_ops->mdb_add(dev, port, mdb, db); in ksz_port_mdb_add()
3171 struct ksz_device *dev = ds->priv; in ksz_port_mdb_del()
3173 if (!dev->dev_ops->mdb_del) in ksz_port_mdb_del()
3174 return -EOPNOTSUPP; in ksz_port_mdb_del()
3176 return dev->dev_ops->mdb_del(dev, port, mdb, db); in ksz_port_mdb_del()
3185 for (ipm = 0; ipm < dev->info->num_ipms; ipm++) { in ksz9477_set_default_prio_queue_mapping()
3192 queue = ieee8021q_tt_to_tc(ipm, dev->info->num_tx_queues); in ksz9477_set_default_prio_queue_mapping()
3204 struct ksz_device *dev = ds->priv; in ksz_port_setup()
3211 dev->dev_ops->port_setup(dev, port, false); in ksz_port_setup()
3228 struct ksz_device *dev = ds->priv; in ksz_port_stp_state_set()
3233 regs = dev->info->regs; in ksz_port_stp_state_set()
3238 p = &dev->ports[port]; in ksz_port_stp_state_set()
3249 if (!p->learning) in ksz_port_stp_state_set()
3254 if (!p->learning) in ksz_port_stp_state_set()
3261 dev_err(ds->dev, "invalid STP state: %d\n", state); in ksz_port_stp_state_set()
3267 p->stp_state = state; in ksz_port_stp_state_set()
3274 struct ksz_device *dev = ds->priv; in ksz_port_teardown()
3276 switch (dev->chip_id) { in ksz_port_teardown()
3296 return -EINVAL; in ksz_port_pre_bridge_flags()
3305 struct ksz_device *dev = ds->priv; in ksz_port_bridge_flags()
3306 struct ksz_port *p = &dev->ports[port]; in ksz_port_bridge_flags()
3310 p->learning = !!(flags.val & BR_LEARNING); in ksz_port_bridge_flags()
3313 p->isolated = !!(flags.val & BR_ISOLATED); in ksz_port_bridge_flags()
3316 ksz_port_stp_state_set(ds, port, p->stp_state); in ksz_port_bridge_flags()
3326 struct ksz_device *dev = ds->priv; in ksz_get_tag_protocol()
3332 if (dev->chip_id == KSZ88X3_CHIP_ID || in ksz_get_tag_protocol()
3333 dev->chip_id == KSZ8563_CHIP_ID || in ksz_get_tag_protocol()
3334 dev->chip_id == KSZ9893_CHIP_ID || in ksz_get_tag_protocol()
3335 dev->chip_id == KSZ9563_CHIP_ID) in ksz_get_tag_protocol()
3338 if (dev->chip_id == KSZ8567_CHIP_ID || in ksz_get_tag_protocol()
3339 dev->chip_id == KSZ9477_CHIP_ID || in ksz_get_tag_protocol()
3340 dev->chip_id == KSZ9896_CHIP_ID || in ksz_get_tag_protocol()
3341 dev->chip_id == KSZ9897_CHIP_ID || in ksz_get_tag_protocol()
3342 dev->chip_id == KSZ9567_CHIP_ID || in ksz_get_tag_protocol()
3343 dev->chip_id == LAN9646_CHIP_ID) in ksz_get_tag_protocol()
3364 tagger_data->xmit_work_fn = ksz_port_deferred_xmit; in ksz_connect_tag_protocol()
3367 return -EPROTONOSUPPORT; in ksz_connect_tag_protocol()
3374 struct ksz_device *dev = ds->priv; in ksz_port_vlan_filtering()
3376 if (!dev->dev_ops->vlan_filtering) in ksz_port_vlan_filtering()
3377 return -EOPNOTSUPP; in ksz_port_vlan_filtering()
3379 return dev->dev_ops->vlan_filtering(dev, port, flag, extack); in ksz_port_vlan_filtering()
3386 struct ksz_device *dev = ds->priv; in ksz_port_vlan_add()
3388 if (!dev->dev_ops->vlan_add) in ksz_port_vlan_add()
3389 return -EOPNOTSUPP; in ksz_port_vlan_add()
3391 return dev->dev_ops->vlan_add(dev, port, vlan, extack); in ksz_port_vlan_add()
3397 struct ksz_device *dev = ds->priv; in ksz_port_vlan_del()
3399 if (!dev->dev_ops->vlan_del) in ksz_port_vlan_del()
3400 return -EOPNOTSUPP; in ksz_port_vlan_del()
3402 return dev->dev_ops->vlan_del(dev, port, vlan); in ksz_port_vlan_del()
3409 struct ksz_device *dev = ds->priv; in ksz_port_mirror_add()
3411 if (!dev->dev_ops->mirror_add) in ksz_port_mirror_add()
3412 return -EOPNOTSUPP; in ksz_port_mirror_add()
3414 return dev->dev_ops->mirror_add(dev, port, mirror, ingress, extack); in ksz_port_mirror_add()
3420 struct ksz_device *dev = ds->priv; in ksz_port_mirror_del()
3422 if (dev->dev_ops->mirror_del) in ksz_port_mirror_del()
3423 dev->dev_ops->mirror_del(dev, port, mirror); in ksz_port_mirror_del()
3428 struct ksz_device *dev = ds->priv; in ksz_change_mtu()
3430 if (!dev->dev_ops->change_mtu) in ksz_change_mtu()
3431 return -EOPNOTSUPP; in ksz_change_mtu()
3433 return dev->dev_ops->change_mtu(dev, port, mtu); in ksz_change_mtu()
3438 struct ksz_device *dev = ds->priv; in ksz_max_mtu()
3440 switch (dev->chip_id) { in ksz_max_mtu()
3444 return KSZ8795_HUGE_PACKET_SIZE - VLAN_ETH_HLEN - ETH_FCS_LEN; in ksz_max_mtu()
3448 return KSZ8863_HUGE_PACKET_SIZE - VLAN_ETH_HLEN - ETH_FCS_LEN; in ksz_max_mtu()
3463 return KSZ9477_MAX_FRAME_SIZE - VLAN_ETH_HLEN - ETH_FCS_LEN; in ksz_max_mtu()
3466 return -EOPNOTSUPP; in ksz_max_mtu()
3471 struct ksz_device *dev = ds->priv; in ksz_support_eee()
3473 if (!dev->info->internal_phy[port]) in ksz_support_eee()
3476 switch (dev->chip_id) { in ksz_support_eee()
3495 struct ksz_device *dev = ds->priv; in ksz_set_mac_eee()
3497 if (!e->tx_lpi_enabled) { in ksz_set_mac_eee()
3498 dev_err(dev->dev, "Disabling EEE Tx LPI is not supported\n"); in ksz_set_mac_eee()
3499 return -EINVAL; in ksz_set_mac_eee()
3502 if (e->tx_lpi_timer) { in ksz_set_mac_eee()
3503 dev_err(dev->dev, "Setting EEE Tx LPI timer is not supported\n"); in ksz_set_mac_eee()
3504 return -EINVAL; in ksz_set_mac_eee()
3513 const u8 *bitval = dev->info->xmii_ctrl1; in ksz_set_xmii()
3514 struct ksz_port *p = &dev->ports[port]; in ksz_set_xmii()
3515 const u16 *regs = dev->info->regs; in ksz_set_xmii()
3538 /* On KSZ9893, disable RGMII in-band status support */ in ksz_set_xmii()
3539 if (dev->chip_id == KSZ9893_CHIP_ID || in ksz_set_xmii()
3540 dev->chip_id == KSZ8563_CHIP_ID || in ksz_set_xmii()
3541 dev->chip_id == KSZ9563_CHIP_ID || in ksz_set_xmii()
3546 dev_err(dev->dev, "Unsupported interface '%s' for port %d\n", in ksz_set_xmii()
3551 if (p->rgmii_tx_val) in ksz_set_xmii()
3554 if (p->rgmii_rx_val) in ksz_set_xmii()
3563 const u8 *bitval = dev->info->xmii_ctrl1; in ksz_get_xmii()
3564 const u16 *regs = dev->info->regs; in ksz_get_xmii()
3599 struct ksz_device *dev = dp->ds->priv; in ksz88x3_phylink_mac_config()
3601 dev->ports[dp->index].manual_flow = !(state->pause & MLO_PAUSE_AN); in ksz88x3_phylink_mac_config()
3609 struct ksz_device *dev = dp->ds->priv; in ksz_phylink_mac_config()
3610 int port = dp->index; in ksz_phylink_mac_config()
3613 if (dev->info->internal_phy[port]) in ksz_phylink_mac_config()
3617 dev_err(dev->dev, "In-band AN not supported!\n"); in ksz_phylink_mac_config()
3621 ksz_set_xmii(dev, port, state->interface); in ksz_phylink_mac_config()
3623 if (dev->dev_ops->setup_rgmii_delay) in ksz_phylink_mac_config()
3624 dev->dev_ops->setup_rgmii_delay(dev, port); in ksz_phylink_mac_config()
3629 const u8 *bitval = dev->info->xmii_ctrl1; in ksz_get_gbit()
3630 const u16 *regs = dev->info->regs; in ksz_get_gbit()
3647 const u8 *bitval = dev->info->xmii_ctrl1; in ksz_set_gbit()
3648 const u16 *regs = dev->info->regs; in ksz_set_gbit()
3666 const u8 *bitval = dev->info->xmii_ctrl0; in ksz_set_100_10mbit()
3667 const u16 *regs = dev->info->regs; in ksz_set_100_10mbit()
3697 const u8 *bitval = dev->info->xmii_ctrl0; in ksz_duplex_flowctrl()
3698 const u32 *masks = dev->info->masks; in ksz_duplex_flowctrl()
3699 const u16 *regs = dev->info->regs; in ksz_duplex_flowctrl()
3728 struct ksz_device *dev = dp->ds->priv; in ksz9477_phylink_mac_link_up()
3729 int port = dp->index; in ksz9477_phylink_mac_link_up()
3732 p = &dev->ports[port]; in ksz9477_phylink_mac_link_up()
3735 if (dev->info->internal_phy[port]) in ksz9477_phylink_mac_link_up()
3738 p->phydev.speed = speed; in ksz9477_phylink_mac_link_up()
3765 dev->chip_id = KSZ8795_CHIP_ID; in ksz_switch_detect()
3769 dev->chip_id = KSZ8765_CHIP_ID; in ksz_switch_detect()
3771 dev->chip_id = KSZ8794_CHIP_ID; in ksz_switch_detect()
3773 return -ENODEV; in ksz_switch_detect()
3778 dev->chip_id = KSZ88X3_CHIP_ID; in ksz_switch_detect()
3780 return -ENODEV; in ksz_switch_detect()
3785 dev->chip_id = KSZ8895_CHIP_ID; in ksz_switch_detect()
3787 return -ENODEV; in ksz_switch_detect()
3792 dev->chip_id = KSZ8864_CHIP_ID; in ksz_switch_detect()
3799 dev->chip_rev = FIELD_GET(SW_REV_ID_M, id32); in ksz_switch_detect()
3815 if (dev->chip_id != LAN9646_CHIP_ID) in ksz_switch_detect()
3816 dev->chip_id = id32; in ksz_switch_detect()
3825 dev->chip_id = KSZ8563_CHIP_ID; in ksz_switch_detect()
3827 dev->chip_id = KSZ9563_CHIP_ID; in ksz_switch_detect()
3829 dev->chip_id = KSZ9893_CHIP_ID; in ksz_switch_detect()
3833 dev_err(dev->dev, in ksz_switch_detect()
3835 return -ENODEV; in ksz_switch_detect()
3844 struct ksz_device *dev = ds->priv; in ksz_cls_flower_add()
3846 switch (dev->chip_id) { in ksz_cls_flower_add()
3859 return -EOPNOTSUPP; in ksz_cls_flower_add()
3865 struct ksz_device *dev = ds->priv; in ksz_cls_flower_del()
3867 switch (dev->chip_id) { in ksz_cls_flower_del()
3880 return -EOPNOTSUPP; in ksz_cls_flower_del()
3884 * is converted to Hex-decimal using the successive multiplication method. On
3895 txrate = idle_slope - send_slope; in cinc_cal()
3898 return -EINVAL; in cinc_cal()
3929 struct ksz_device *dev = ds->priv; in ksz_setup_tc_cbs()
3933 if (!dev->info->tc_cbs_supported) in ksz_setup_tc_cbs()
3934 return -EOPNOTSUPP; in ksz_setup_tc_cbs()
3936 if (qopt->queue > dev->info->num_tx_queues) in ksz_setup_tc_cbs()
3937 return -EINVAL; in ksz_setup_tc_cbs()
3940 ret = ksz_pwrite32(dev, port, REG_PORT_MTI_QUEUE_INDEX__4, qopt->queue); in ksz_setup_tc_cbs()
3944 if (!qopt->enable) in ksz_setup_tc_cbs()
3950 qopt->hicredit); in ksz_setup_tc_cbs()
3956 qopt->locredit); in ksz_setup_tc_cbs()
3961 ret = cinc_cal(qopt->idleslope, qopt->sendslope, &bw); in ksz_setup_tc_cbs()
3965 if (dev->dev_ops->tc_cbs_set_cinc) { in ksz_setup_tc_cbs()
3966 ret = dev->dev_ops->tc_cbs_set_cinc(dev, port, bw); in ksz_setup_tc_cbs()
3982 for (queue = 0; queue < dev->info->num_tx_queues; queue++) { in ksz_disable_egress_rate_limit()
3999 return p->bands - 1 - band; in ksz_ets_band_to_queue()
4048 for (band = 0; band < p->bands; band++) { in ksz_tc_ets_add()
4060 for (tc_prio = 0; tc_prio < ARRAY_SIZE(p->priomap); tc_prio++) { in ksz_tc_ets_add()
4063 if (tc_prio >= dev->info->num_ipms) in ksz_tc_ets_add()
4066 queue = ksz_ets_band_to_queue(p, p->priomap[tc_prio]); in ksz_tc_ets_add()
4080 for (queue = 0; queue < dev->info->num_tx_queues; queue++) { in ksz_tc_ets_del()
4087 /* Revert the queue mapping for TC-priority to its default setting on in ksz_tc_ets_del()
4101 if (p->bands != dev->info->num_tx_queues) { in ksz_tc_ets_validate()
4102 dev_err(dev->dev, "Not supported amount of bands. It should be %d\n", in ksz_tc_ets_validate()
4103 dev->info->num_tx_queues); in ksz_tc_ets_validate()
4104 return -EOPNOTSUPP; in ksz_tc_ets_validate()
4107 for (band = 0; band < p->bands; ++band) { in ksz_tc_ets_validate()
4120 if (p->quanta[band]) { in ksz_tc_ets_validate()
4121 dev_err(dev->dev, "Quanta/weights configuration is not supported.\n"); in ksz_tc_ets_validate()
4122 return -EOPNOTSUPP; in ksz_tc_ets_validate()
4132 struct ksz_device *dev = ds->priv; in ksz_tc_setup_qdisc_ets()
4136 return -EOPNOTSUPP; in ksz_tc_setup_qdisc_ets()
4138 if (qopt->parent != TC_H_ROOT) { in ksz_tc_setup_qdisc_ets()
4139 dev_err(dev->dev, "Parent should be \"root\"\n"); in ksz_tc_setup_qdisc_ets()
4140 return -EOPNOTSUPP; in ksz_tc_setup_qdisc_ets()
4143 switch (qopt->command) { in ksz_tc_setup_qdisc_ets()
4145 ret = ksz_tc_ets_validate(dev, port, &qopt->replace_params); in ksz_tc_setup_qdisc_ets()
4149 return ksz_tc_ets_add(dev, port, &qopt->replace_params); in ksz_tc_setup_qdisc_ets()
4154 return -EOPNOTSUPP; in ksz_tc_setup_qdisc_ets()
4157 return -EOPNOTSUPP; in ksz_tc_setup_qdisc_ets()
4169 return -EOPNOTSUPP; in ksz_setup_tc()
4174 * ksz_handle_wake_reason - Handle wake reason on a specified port.
4188 const struct ksz_dev_ops *ops = dev->dev_ops; in ksz_handle_wake_reason()
4189 const u16 *regs = dev->info->regs; in ksz_handle_wake_reason()
4193 ret = ops->pme_pread8(dev, port, regs[REG_PORT_PME_STATUS], in ksz_handle_wake_reason()
4201 dev_dbg(dev->dev, "Wake event on port %d due to:%s%s%s\n", port, in ksz_handle_wake_reason()
4206 return ops->pme_pwrite8(dev, port, regs[REG_PORT_PME_STATUS], in ksz_handle_wake_reason()
4211 * ksz_get_wol - Get Wake-on-LAN settings for a specified port.
4214 * @wol: Pointer to ethtool Wake-on-LAN settings structure.
4223 struct ksz_device *dev = ds->priv; in ksz_get_wol()
4224 const u16 *regs = dev->info->regs; in ksz_get_wol()
4231 if (!dev->wakeup_source) in ksz_get_wol()
4234 wol->supported = WAKE_PHY; in ksz_get_wol()
4240 if (ksz_is_port_mac_global_usable(dev->ds, port)) in ksz_get_wol()
4241 wol->supported |= WAKE_MAGIC; in ksz_get_wol()
4243 ret = dev->dev_ops->pme_pread8(dev, port, regs[REG_PORT_PME_CTRL], in ksz_get_wol()
4249 wol->wolopts |= WAKE_MAGIC; in ksz_get_wol()
4251 wol->wolopts |= WAKE_PHY; in ksz_get_wol()
4255 * ksz_set_wol - Set Wake-on-LAN settings for a specified port.
4258 * @wol: Pointer to ethtool Wake-on-LAN settings structure.
4260 * This function configures Wake-on-LAN (WoL) settings for a specified
4272 struct ksz_device *dev = ds->priv; in ksz_set_wol()
4273 const u16 *regs = dev->info->regs; in ksz_set_wol()
4278 if (wol->wolopts & ~(WAKE_PHY | WAKE_MAGIC)) in ksz_set_wol()
4279 return -EINVAL; in ksz_set_wol()
4282 return -EOPNOTSUPP; in ksz_set_wol()
4284 if (!dev->wakeup_source) in ksz_set_wol()
4285 return -EOPNOTSUPP; in ksz_set_wol()
4291 if (wol->wolopts & WAKE_MAGIC) in ksz_set_wol()
4293 if (wol->wolopts & WAKE_PHY) in ksz_set_wol()
4296 ret = dev->dev_ops->pme_pread8(dev, port, regs[REG_PORT_PME_CTRL], in ksz_set_wol()
4313 ret = ksz_switch_macaddr_get(dev->ds, port, NULL); in ksz_set_wol()
4317 ksz_switch_macaddr_put(dev->ds); in ksz_set_wol()
4320 ret = dev->dev_ops->pme_pwrite8(dev, port, regs[REG_PORT_PME_CTRL], in ksz_set_wol()
4324 ksz_switch_macaddr_put(dev->ds); in ksz_set_wol()
4332 * ksz_wol_pre_shutdown - Prepares the switch device for shutdown while
4333 * considering Wake-on-LAN (WoL) settings.
4339 * into account the Wake-on-LAN (WoL) settings on the user ports. It updates
4345 const struct ksz_dev_ops *ops = dev->dev_ops; in ksz_wol_pre_shutdown()
4346 const u16 *regs = dev->info->regs; in ksz_wol_pre_shutdown()
4356 if (!dev->wakeup_source) in ksz_wol_pre_shutdown()
4359 dsa_switch_for_each_user_port(dp, dev->ds) { in ksz_wol_pre_shutdown()
4362 ret = ops->pme_pread8(dev, dp->index, in ksz_wol_pre_shutdown()
4370 ksz_handle_wake_reason(dev, dp->index); in ksz_wol_pre_shutdown()
4375 if (dev->pme_active_high) in ksz_wol_pre_shutdown()
4377 ops->pme_write8(dev, regs[REG_SW_PME_CTRL], pme_pin_en); in ksz_wol_pre_shutdown()
4389 if (dp->hsr_dev) { in ksz_port_set_mac_address()
4390 dev_err(ds->dev, in ksz_port_set_mac_address()
4393 return -EBUSY; in ksz_port_set_mac_address()
4401 ksz_get_wol(ds, dp->index, &wol); in ksz_port_set_mac_address()
4403 dev_err(ds->dev, in ksz_port_set_mac_address()
4406 return -EBUSY; in ksz_port_set_mac_address()
4413 * ksz_is_port_mac_global_usable - Check if the MAC address on a given port
4426 struct net_device *user = dsa_to_port(ds, port)->user; in ksz_is_port_mac_global_usable()
4427 const unsigned char *addr = user->dev_addr; in ksz_is_port_mac_global_usable()
4429 struct ksz_device *dev = ds->priv; in ksz_is_port_mac_global_usable()
4433 switch_macaddr = dev->switch_macaddr; in ksz_is_port_mac_global_usable()
4434 if (switch_macaddr && !ether_addr_equal(switch_macaddr->addr, addr)) in ksz_is_port_mac_global_usable()
4441 * ksz_switch_macaddr_get - Program the switch's MAC address register.
4448 * multiple features like HSR self-address filtering and WoL. Other user ports
4458 struct net_device *user = dsa_to_port(ds, port)->user; in ksz_switch_macaddr_get()
4459 const unsigned char *addr = user->dev_addr; in ksz_switch_macaddr_get()
4461 struct ksz_device *dev = ds->priv; in ksz_switch_macaddr_get()
4462 const u16 *regs = dev->info->regs; in ksz_switch_macaddr_get()
4468 switch_macaddr = dev->switch_macaddr; in ksz_switch_macaddr_get()
4470 if (!ether_addr_equal(switch_macaddr->addr, addr)) { in ksz_switch_macaddr_get()
4473 switch_macaddr->addr); in ksz_switch_macaddr_get()
4474 return -EBUSY; in ksz_switch_macaddr_get()
4477 refcount_inc(&switch_macaddr->refcount); in ksz_switch_macaddr_get()
4483 return -ENOMEM; in ksz_switch_macaddr_get()
4485 ether_addr_copy(switch_macaddr->addr, addr); in ksz_switch_macaddr_get()
4486 refcount_set(&switch_macaddr->refcount, 1); in ksz_switch_macaddr_get()
4487 dev->switch_macaddr = switch_macaddr; in ksz_switch_macaddr_get()
4499 dev->switch_macaddr = NULL; in ksz_switch_macaddr_get()
4500 refcount_set(&switch_macaddr->refcount, 0); in ksz_switch_macaddr_get()
4509 struct ksz_device *dev = ds->priv; in ksz_switch_macaddr_put()
4510 const u16 *regs = dev->info->regs; in ksz_switch_macaddr_put()
4516 switch_macaddr = dev->switch_macaddr; in ksz_switch_macaddr_put()
4517 if (!refcount_dec_and_test(&switch_macaddr->refcount)) in ksz_switch_macaddr_put()
4523 dev->switch_macaddr = NULL; in ksz_switch_macaddr_put()
4530 struct ksz_device *dev = ds->priv; in ksz_hsr_join()
4538 if (dev->chip_id != KSZ9477_CHIP_ID) { in ksz_hsr_join()
4540 return -EOPNOTSUPP; in ksz_hsr_join()
4544 if (dev->hsr_dev && hsr != dev->hsr_dev) { in ksz_hsr_join()
4546 return -EOPNOTSUPP; in ksz_hsr_join()
4552 return -EOPNOTSUPP; in ksz_hsr_join()
4556 if (hweight8(dev->hsr_ports) >= 2) { in ksz_hsr_join()
4558 "Cannot offload more than two ports - using software HSR"); in ksz_hsr_join()
4559 return -EOPNOTSUPP; in ksz_hsr_join()
4570 dev->hsr_dev = hsr; in ksz_hsr_join()
4571 dev->hsr_ports |= BIT(port); in ksz_hsr_join()
4579 struct ksz_device *dev = ds->priv; in ksz_hsr_leave()
4581 WARN_ON(dev->chip_id != KSZ9477_CHIP_ID); in ksz_hsr_leave()
4584 dev->hsr_ports &= ~BIT(port); in ksz_hsr_leave()
4585 if (!dev->hsr_ports) in ksz_hsr_leave()
4586 dev->hsr_dev = NULL; in ksz_hsr_leave()
4595 struct ksz_device *dev = ds->priv; in ksz_suspend()
4597 cancel_delayed_work_sync(&dev->mib_read); in ksz_suspend()
4603 struct ksz_device *dev = ds->priv; in ksz_resume()
4605 if (dev->mib_read_interval) in ksz_resume()
4606 schedule_delayed_work(&dev->mib_read, dev->mib_read_interval); in ksz_resume()
4680 ds->dev = base; in ksz_switch_alloc()
4681 ds->num_ports = DSA_MAX_PORTS; in ksz_switch_alloc()
4682 ds->ops = &ksz_switch_ops; in ksz_switch_alloc()
4688 ds->priv = swdev; in ksz_switch_alloc()
4689 swdev->dev = base; in ksz_switch_alloc()
4691 swdev->ds = ds; in ksz_switch_alloc()
4692 swdev->priv = priv; in ksz_switch_alloc()
4699 * ksz_switch_shutdown - Shutdown routine for the switch device.
4714 if (dev->dev_ops->reset && !wol_enabled) in ksz_switch_shutdown()
4715 dev->dev_ops->reset(dev); in ksz_switch_shutdown()
4717 dsa_switch_shutdown(dev->ds); in ksz_switch_shutdown()
4724 phy_interface_t phy_mode = dev->ports[port_num].interface; in ksz_parse_rgmii_delay()
4725 int rx_delay = -1, tx_delay = -1; in ksz_parse_rgmii_delay()
4730 of_property_read_u32(port_dn, "rx-internal-delay-ps", &rx_delay); in ksz_parse_rgmii_delay()
4731 of_property_read_u32(port_dn, "tx-internal-delay-ps", &tx_delay); in ksz_parse_rgmii_delay()
4733 if (rx_delay == -1 && tx_delay == -1) { in ksz_parse_rgmii_delay()
4734 dev_warn(dev->dev, in ksz_parse_rgmii_delay()
4735 "Port %d interpreting RGMII delay settings based on \"phy-mode\" property, " in ksz_parse_rgmii_delay()
4736 "please update device tree to specify \"rx-internal-delay-ps\" and " in ksz_parse_rgmii_delay()
4737 "\"tx-internal-delay-ps\"", in ksz_parse_rgmii_delay()
4754 dev->ports[port_num].rgmii_rx_val = rx_delay; in ksz_parse_rgmii_delay()
4755 dev->ports[port_num].rgmii_tx_val = tx_delay; in ksz_parse_rgmii_delay()
4759 * ksz_drive_strength_to_reg() - Convert drive strength value to corresponding
4769 * is returned. Otherwise, -EINVAL is returned indicating an invalid value.
4781 return -EINVAL; in ksz_drive_strength_to_reg()
4785 * ksz_drive_strength_error() - Report invalid drive strength value
4816 remaining_size -= added_len; in ksz_drive_strength_error()
4819 dev_err(dev->dev, "Invalid drive strength %d, supported values are %s\n", in ksz_drive_strength_error()
4824 * ksz9477_drive_strength_write() - Set the drive strength for specific KSZ9477
4831 * based on the provided properties. It handles chip-specific nuances and
4845 if (props[KSZ_DRIVER_STRENGTH_IO].value != -1) in ksz9477_drive_strength_write()
4846 dev_warn(dev->dev, "%s is not supported by this chip variant\n", in ksz9477_drive_strength_write()
4849 if (dev->chip_id == KSZ8795_CHIP_ID || in ksz9477_drive_strength_write()
4850 dev->chip_id == KSZ8794_CHIP_ID || in ksz9477_drive_strength_write()
4851 dev->chip_id == KSZ8765_CHIP_ID) in ksz9477_drive_strength_write()
4857 if (props[i].value == -1) in ksz9477_drive_strength_write()
4876 * ksz88x3_drive_strength_write() - Set the drive strength configuration for
4898 if (props[i].value == -1 || i == KSZ_DRIVER_STRENGTH_IO) in ksz88x3_drive_strength_write()
4901 dev_warn(dev->dev, "%s is not supported by this chip variant\n", in ksz88x3_drive_strength_write()
4919 * ksz_parse_drive_strength() - Extract and apply drive strength configurations
4934 .name = "microchip,hi-drive-strength-microamp", in ksz_parse_drive_strength()
4936 .value = -1, in ksz_parse_drive_strength()
4939 .name = "microchip,lo-drive-strength-microamp", in ksz_parse_drive_strength()
4941 .value = -1, in ksz_parse_drive_strength()
4944 .name = "microchip,io-drive-strength-microamp", in ksz_parse_drive_strength()
4946 .value = -1, in ksz_parse_drive_strength()
4949 struct device_node *np = dev->dev->of_node; in ksz_parse_drive_strength()
4956 if (ret && ret != -EINVAL) in ksz_parse_drive_strength()
4957 dev_warn(dev->dev, "Failed to read %s\n", in ksz_parse_drive_strength()
4968 switch (dev->chip_id) { in ksz_parse_drive_strength()
4988 if (of_props[i].value == -1) in ksz_parse_drive_strength()
4991 dev_warn(dev->dev, "%s is not supported by this chip variant\n", in ksz_parse_drive_strength()
5008 dev->reset_gpio = devm_gpiod_get_optional(dev->dev, "reset", in ksz_switch_register()
5010 if (IS_ERR(dev->reset_gpio)) in ksz_switch_register()
5011 return PTR_ERR(dev->reset_gpio); in ksz_switch_register()
5013 if (dev->reset_gpio) { in ksz_switch_register()
5014 gpiod_set_value_cansleep(dev->reset_gpio, 1); in ksz_switch_register()
5016 gpiod_set_value_cansleep(dev->reset_gpio, 0); in ksz_switch_register()
5020 mutex_init(&dev->dev_mutex); in ksz_switch_register()
5021 mutex_init(&dev->regmap_mutex); in ksz_switch_register()
5022 mutex_init(&dev->alu_mutex); in ksz_switch_register()
5023 mutex_init(&dev->vlan_mutex); in ksz_switch_register()
5029 info = ksz_lookup_info(dev->chip_id); in ksz_switch_register()
5031 return -ENODEV; in ksz_switch_register()
5034 dev->info = info; in ksz_switch_register()
5036 dev_info(dev->dev, "found switch: %s, rev %i\n", in ksz_switch_register()
5037 dev->info->dev_name, dev->chip_rev); in ksz_switch_register()
5043 dev->dev_ops = dev->info->ops; in ksz_switch_register()
5045 ret = dev->dev_ops->init(dev); in ksz_switch_register()
5049 dev->ports = devm_kzalloc(dev->dev, in ksz_switch_register()
5050 dev->info->port_cnt * sizeof(struct ksz_port), in ksz_switch_register()
5052 if (!dev->ports) in ksz_switch_register()
5053 return -ENOMEM; in ksz_switch_register()
5055 for (i = 0; i < dev->info->port_cnt; i++) { in ksz_switch_register()
5056 spin_lock_init(&dev->ports[i].mib.stats64_lock); in ksz_switch_register()
5057 mutex_init(&dev->ports[i].mib.cnt_mutex); in ksz_switch_register()
5058 dev->ports[i].mib.counters = in ksz_switch_register()
5059 devm_kzalloc(dev->dev, in ksz_switch_register()
5060 sizeof(u64) * (dev->info->mib_cnt + 1), in ksz_switch_register()
5062 if (!dev->ports[i].mib.counters) in ksz_switch_register()
5063 return -ENOMEM; in ksz_switch_register()
5065 dev->ports[i].ksz_dev = dev; in ksz_switch_register()
5066 dev->ports[i].num = i; in ksz_switch_register()
5070 dev->ds->num_ports = dev->info->port_cnt; in ksz_switch_register()
5073 dev->ds->phylink_mac_ops = dev->info->phylink_mac_ops; in ksz_switch_register()
5078 for (port_num = 0; port_num < dev->info->port_cnt; ++port_num) in ksz_switch_register()
5079 dev->ports[port_num].interface = PHY_INTERFACE_MODE_NA; in ksz_switch_register()
5080 if (dev->dev->of_node) { in ksz_switch_register()
5081 ret = of_get_phy_mode(dev->dev->of_node, &interface); in ksz_switch_register()
5083 dev->compat_interface = interface; in ksz_switch_register()
5084 ports = of_get_child_by_name(dev->dev->of_node, "ethernet-ports"); in ksz_switch_register()
5086 ports = of_get_child_by_name(dev->dev->of_node, "ports"); in ksz_switch_register()
5092 if (!(dev->port_mask & BIT(port_num))) { in ksz_switch_register()
5094 return -EINVAL; in ksz_switch_register()
5097 &dev->ports[port_num].interface); in ksz_switch_register()
5103 dev->synclko_125 = of_property_read_bool(dev->dev->of_node, in ksz_switch_register()
5104 "microchip,synclko-125"); in ksz_switch_register()
5105 dev->synclko_disable = of_property_read_bool(dev->dev->of_node, in ksz_switch_register()
5106 "microchip,synclko-disable"); in ksz_switch_register()
5107 if (dev->synclko_125 && dev->synclko_disable) { in ksz_switch_register()
5108 dev_err(dev->dev, "inconsistent synclko settings\n"); in ksz_switch_register()
5109 return -EINVAL; in ksz_switch_register()
5112 dev->wakeup_source = of_property_read_bool(dev->dev->of_node, in ksz_switch_register()
5113 "wakeup-source"); in ksz_switch_register()
5114 dev->pme_active_high = of_property_read_bool(dev->dev->of_node, in ksz_switch_register()
5115 "microchip,pme-active-high"); in ksz_switch_register()
5118 ret = dsa_register_switch(dev->ds); in ksz_switch_register()
5120 dev->dev_ops->exit(dev); in ksz_switch_register()
5125 dev->mib_read_interval = msecs_to_jiffies(5000); in ksz_switch_register()
5128 schedule_delayed_work(&dev->mib_read, 0); in ksz_switch_register()
5137 if (dev->mib_read_interval) { in ksz_switch_remove()
5138 dev->mib_read_interval = 0; in ksz_switch_remove()
5139 cancel_delayed_work_sync(&dev->mib_read); in ksz_switch_remove()
5142 dev->dev_ops->exit(dev); in ksz_switch_remove()
5143 dsa_unregister_switch(dev->ds); in ksz_switch_remove()
5145 if (dev->reset_gpio) in ksz_switch_remove()
5146 gpiod_set_value_cansleep(dev->reset_gpio, 1); in ksz_switch_remove()
5156 return dsa_switch_suspend(priv->ds); in ksz_switch_suspend()
5164 return dsa_switch_resume(priv->ds); in ksz_switch_resume()