1 // SPDX-License-Identifier: GPL-2.0-or-later
13 #include <linux/phy.h>
41 	for (port = 0; port < ARRAY_SIZE(priv->port_sts); port++) {  in bcm_sf2_num_active_ports()
44 		if (priv->port_sts[port].enabled)  in bcm_sf2_num_active_ports()
65 	if (ports_active == 0 || !priv->clk_mdiv)  in bcm_sf2_recalc_clock()
74 		new_rate = rate_table[ports_active - 1];  in bcm_sf2_recalc_clock()
75 	clk_set_rate(priv->clk_mdiv, new_rate);  in bcm_sf2_recalc_clock()
108 		if (priv->type == BCM7445_DEVICE_ID)  in bcm_sf2_imp_setup()
113 		/* Force link status for IMP port */  in bcm_sf2_imp_setup()
130 	priv->port_sts[port].enabled = true;  in bcm_sf2_imp_setup()
154 	/* Use PHY-driven LED signaling */  in bcm_sf2_gphy_enable_set()
207 			      struct phy_device *phy)  in bcm_sf2_port_setup()  argument
216 	priv->port_sts[port].enabled = true;  in bcm_sf2_port_setup()
231 	if (priv->brcm_tag_mask & BIT(port)) {  in bcm_sf2_port_setup()
250 	/* Re-enable the GPHY and re-apply workarounds */  in bcm_sf2_port_setup()
251 	if (priv->int_phy_mask & 1 << port && priv->hw_params.num_gphy == 1) {  in bcm_sf2_port_setup()
253 		if (phy) {  in bcm_sf2_port_setup()
254 			/* if phy_stop() has been called before, phy  in bcm_sf2_port_setup()
260 			 * the phy manually here, we need to reset the  in bcm_sf2_port_setup()
263 			phy->state = PHY_READY;  in bcm_sf2_port_setup()
264 			phy_init_hw(phy);  in bcm_sf2_port_setup()
269 	if (port == priv->moca_port)  in bcm_sf2_port_setup()
272 	/* Set per-queue pause threshold to 32 */  in bcm_sf2_port_setup()
285 	return b53_enable_port(ds, port, phy);  in bcm_sf2_port_setup()
294 	if (priv->wol_ports_mask & (1 << port)) {  in bcm_sf2_port_disable()
301 	if (port == priv->moca_port)  in bcm_sf2_port_disable()
304 	if (priv->int_phy_mask & 1 << port && priv->hw_params.num_gphy == 1)  in bcm_sf2_port_disable()
314 	priv->port_sts[port].enabled = false;  in bcm_sf2_port_disable()
353 	struct bcm_sf2_priv *priv = bus->priv;  in bcm_sf2_sw_mdio_read()
355 	/* Intercept reads from Broadcom pseudo-PHY address, else, send  in bcm_sf2_sw_mdio_read()
358 	if (addr == BRCM_PSEUDO_PHY_ADDR && priv->indir_phy_mask & BIT(addr))  in bcm_sf2_sw_mdio_read()
361 		return mdiobus_read_nested(priv->master_mii_bus, addr, regnum);  in bcm_sf2_sw_mdio_read()
367 	struct bcm_sf2_priv *priv = bus->priv;  in bcm_sf2_sw_mdio_write()
369 	/* Intercept writes to the Broadcom pseudo-PHY address, else,  in bcm_sf2_sw_mdio_write()
372 	if (addr == BRCM_PSEUDO_PHY_ADDR && priv->indir_phy_mask & BIT(addr))  in bcm_sf2_sw_mdio_write()
375 		return mdiobus_write_nested(priv->master_mii_bus, addr,  in bcm_sf2_sw_mdio_write()
384 	priv->irq0_stat = intrl2_0_readl(priv, INTRL2_CPU_STATUS) &  in bcm_sf2_switch_0_isr()
385 				~priv->irq0_mask;  in bcm_sf2_switch_0_isr()
386 	intrl2_0_writel(priv, priv->irq0_stat, INTRL2_CPU_CLEAR);  in bcm_sf2_switch_0_isr()
396 	priv->irq1_stat = intrl2_1_readl(priv, INTRL2_CPU_STATUS) &  in bcm_sf2_switch_1_isr()
397 				~priv->irq1_mask;  in bcm_sf2_switch_1_isr()
398 	intrl2_1_writel(priv, priv->irq1_stat, INTRL2_CPU_CLEAR);  in bcm_sf2_switch_1_isr()
400 	if (priv->irq1_stat & P_LINK_UP_IRQ(P7_IRQ_OFF)) {  in bcm_sf2_switch_1_isr()
401 		priv->port_sts[7].link = true;  in bcm_sf2_switch_1_isr()
404 	if (priv->irq1_stat & P_LINK_DOWN_IRQ(P7_IRQ_OFF)) {  in bcm_sf2_switch_1_isr()
405 		priv->port_sts[7].link = false;  in bcm_sf2_switch_1_isr()
421 	if (priv->type == BCM7278_DEVICE_ID && !IS_ERR(priv->rcdev)) {  in bcm_sf2_sw_rst()
422 		ret = reset_control_assert(priv->rcdev);  in bcm_sf2_sw_rst()
426 		return reset_control_deassert(priv->rcdev);  in bcm_sf2_sw_rst()
439 	} while (timeout-- > 0);  in bcm_sf2_sw_rst()
442 		return -ETIMEDOUT;  in bcm_sf2_sw_rst()
464 	priv->moca_port = -1;  in bcm_sf2_identify_ports()
470 		/* Internal PHYs get assigned a specific 'phy-mode' property  in bcm_sf2_identify_ports()
471 		 * value: "internal" to help flag them before MDIO probing  in bcm_sf2_identify_ports()
480 			priv->int_phy_mask |= 1 << port_num;  in bcm_sf2_identify_ports()
483 			priv->moca_port = port_num;  in bcm_sf2_identify_ports()
485 		if (of_property_read_bool(port, "brcm,use-bcm-hdr"))  in bcm_sf2_identify_ports()
486 			priv->brcm_tag_mask |= 1 << port_num;  in bcm_sf2_identify_ports()
492 		if (port_num == 5 && priv->type == BCM7278_DEVICE_ID) {  in bcm_sf2_identify_ports()
510 	dn = of_find_compatible_node(NULL, NULL, "brcm,unimac-mdio");  in bcm_sf2_mdio_register()
511 	priv->master_mii_bus = of_mdio_find_bus(dn);  in bcm_sf2_mdio_register()
512 	if (!priv->master_mii_bus)  in bcm_sf2_mdio_register()
513 		return -EPROBE_DEFER;  in bcm_sf2_mdio_register()
515 	get_device(&priv->master_mii_bus->dev);  in bcm_sf2_mdio_register()
516 	priv->master_mii_dn = dn;  in bcm_sf2_mdio_register()
518 	priv->slave_mii_bus = devm_mdiobus_alloc(ds->dev);  in bcm_sf2_mdio_register()
519 	if (!priv->slave_mii_bus)  in bcm_sf2_mdio_register()
520 		return -ENOMEM;  in bcm_sf2_mdio_register()
522 	priv->slave_mii_bus->priv = priv;  in bcm_sf2_mdio_register()
523 	priv->slave_mii_bus->name = "sf2 slave mii";  in bcm_sf2_mdio_register()
524 	priv->slave_mii_bus->read = bcm_sf2_sw_mdio_read;  in bcm_sf2_mdio_register()
525 	priv->slave_mii_bus->write = bcm_sf2_sw_mdio_write;  in bcm_sf2_mdio_register()
526 	snprintf(priv->slave_mii_bus->id, MII_BUS_ID_SIZE, "sf2-%d",  in bcm_sf2_mdio_register()
528 	priv->slave_mii_bus->dev.of_node = dn;  in bcm_sf2_mdio_register()
530 	/* Include the pseudo-PHY address to divert reads towards our  in bcm_sf2_mdio_register()
532 	 * disconnects the internal switch pseudo-PHY such that we can use the  in bcm_sf2_mdio_register()
535 	 * Here we flag the pseudo PHY as needing special treatment and would  in bcm_sf2_mdio_register()
536 	 * otherwise make all other PHY read/writes go to the master MDIO bus  in bcm_sf2_mdio_register()
537 	 * controller that comes with this switch backed by the "mdio-unimac"  in bcm_sf2_mdio_register()
541 		priv->indir_phy_mask |= (1 << BRCM_PSEUDO_PHY_ADDR) | (1 << 0);  in bcm_sf2_mdio_register()
543 		priv->indir_phy_mask = 0;  in bcm_sf2_mdio_register()
545 	ds->phys_mii_mask = priv->indir_phy_mask;  in bcm_sf2_mdio_register()
546 	ds->slave_mii_bus = priv->slave_mii_bus;  in bcm_sf2_mdio_register()
547 	priv->slave_mii_bus->parent = ds->dev->parent;  in bcm_sf2_mdio_register()
548 	priv->slave_mii_bus->phy_mask = ~priv->indir_phy_mask;  in bcm_sf2_mdio_register()
552 	 * unregister the existing PHY device that was already registered.  in bcm_sf2_mdio_register()
559 		if (!(priv->indir_phy_mask & BIT(reg)))  in bcm_sf2_mdio_register()
575 	err = mdiobus_register(priv->slave_mii_bus);  in bcm_sf2_mdio_register()
584 	mdiobus_unregister(priv->slave_mii_bus);  in bcm_sf2_mdio_unregister()
585 	of_node_put(priv->master_mii_dn);  in bcm_sf2_mdio_unregister()
592 	/* The BCM7xxx PHY driver expects to find the integrated PHY revision  in bcm_sf2_sw_get_phy_flags()
597 	return priv->hw_params.gphy_rev;  in bcm_sf2_sw_get_phy_flags()
607 	if (!phy_interface_mode_is_rgmii(state->interface) &&  in bcm_sf2_sw_validate()
608 	    state->interface != PHY_INTERFACE_MODE_MII &&  in bcm_sf2_sw_validate()
609 	    state->interface != PHY_INTERFACE_MODE_REVMII &&  in bcm_sf2_sw_validate()
610 	    state->interface != PHY_INTERFACE_MODE_GMII &&  in bcm_sf2_sw_validate()
611 	    state->interface != PHY_INTERFACE_MODE_INTERNAL &&  in bcm_sf2_sw_validate()
612 	    state->interface != PHY_INTERFACE_MODE_MOCA) {  in bcm_sf2_sw_validate()
615 			dev_err(ds->dev,  in bcm_sf2_sw_validate()
617 				state->interface, port);  in bcm_sf2_sw_validate()
630 	if (state->interface != PHY_INTERFACE_MODE_MII &&  in bcm_sf2_sw_validate()
631 	    state->interface != PHY_INTERFACE_MODE_REVMII) {  in bcm_sf2_sw_validate()
643 	bitmap_and(state->advertising, state->advertising, mask,  in bcm_sf2_sw_validate()
658 	switch (state->interface) {  in bcm_sf2_sw_mac_config()
672 		/* Nothing required for all other PHYs: internal and MoCA */  in bcm_sf2_sw_mac_config()
718 		if (priv->type == BCM7445_DEVICE_ID)  in bcm_sf2_sw_mac_link_down()
739 	struct ethtool_eee *p = &priv->dev->ports[port].eee;  in bcm_sf2_sw_mac_link_up()
745 		if (priv->type == BCM7445_DEVICE_ID)  in bcm_sf2_sw_mac_link_up()
782 		p->eee_enabled = b53_eee_init(ds, port, phydev);  in bcm_sf2_sw_mac_link_up()
790 	status->link = false;  in bcm_sf2_sw_fixed_state()
793 	 * which means that we need to force the link at the port override  in bcm_sf2_sw_fixed_state()
797 	 * For the other ports, we just force the link status, since this is  in bcm_sf2_sw_fixed_state()
798 	 * a fixed PHY device.  in bcm_sf2_sw_fixed_state()
800 	if (port == priv->moca_port) {  in bcm_sf2_sw_fixed_state()
801 		status->link = priv->port_sts[port].link;  in bcm_sf2_sw_fixed_state()
802 		/* For MoCA interfaces, also force a link down notification  in bcm_sf2_sw_fixed_state()
803 		 * since some version of the user-space daemon (mocad) use  in bcm_sf2_sw_fixed_state()
804 		 * cmd->autoneg to force the link, which messes up the PHY  in bcm_sf2_sw_fixed_state()
807 		if (!status->link)  in bcm_sf2_sw_fixed_state()
808 			netif_carrier_off(dsa_to_port(ds, port)->slave);  in bcm_sf2_sw_fixed_state()
809 		status->duplex = DUPLEX_FULL;  in bcm_sf2_sw_fixed_state()
811 		status->link = true;  in bcm_sf2_sw_fixed_state()
840 	for (port = 0; port < ds->num_ports; port++) {  in bcm_sf2_sw_suspend()
845 	if (!priv->wol_ports_mask)  in bcm_sf2_sw_suspend()
846 		clk_disable_unprepare(priv->clk);  in bcm_sf2_sw_suspend()
856 	if (!priv->wol_ports_mask)  in bcm_sf2_sw_resume()
857 		clk_prepare_enable(priv->clk);  in bcm_sf2_sw_resume()
869 	if (priv->hw_params.num_gphy == 1)  in bcm_sf2_sw_resume()
872 	ds->ops->setup(ds);  in bcm_sf2_sw_resume()
880 	struct net_device *p = dsa_to_port(ds, port)->cpu_dp->master;  in bcm_sf2_sw_get_wol()
885 	if (p->ethtool_ops->get_wol)  in bcm_sf2_sw_get_wol()
886 		p->ethtool_ops->get_wol(p, &pwol);  in bcm_sf2_sw_get_wol()
889 	wol->supported = pwol.supported;  in bcm_sf2_sw_get_wol()
890 	memset(&wol->sopass, 0, sizeof(wol->sopass));  in bcm_sf2_sw_get_wol()
893 		memcpy(&wol->sopass, pwol.sopass, sizeof(wol->sopass));  in bcm_sf2_sw_get_wol()
895 	if (priv->wol_ports_mask & (1 << port))  in bcm_sf2_sw_get_wol()
896 		wol->wolopts = pwol.wolopts;  in bcm_sf2_sw_get_wol()
898 		wol->wolopts = 0;  in bcm_sf2_sw_get_wol()
904 	struct net_device *p = dsa_to_port(ds, port)->cpu_dp->master;  in bcm_sf2_sw_set_wol()
906 	s8 cpu_port = dsa_to_port(ds, port)->cpu_dp->index;  in bcm_sf2_sw_set_wol()
909 	if (p->ethtool_ops->get_wol)  in bcm_sf2_sw_set_wol()
910 		p->ethtool_ops->get_wol(p, &pwol);  in bcm_sf2_sw_set_wol()
911 	if (wol->wolopts & ~pwol.supported)  in bcm_sf2_sw_set_wol()
912 		return -EINVAL;  in bcm_sf2_sw_set_wol()
914 	if (wol->wolopts)  in bcm_sf2_sw_set_wol()
915 		priv->wol_ports_mask |= (1 << port);  in bcm_sf2_sw_set_wol()
917 		priv->wol_ports_mask &= ~(1 << port);  in bcm_sf2_sw_set_wol()
923 	if (priv->wol_ports_mask && priv->wol_ports_mask != (1 << cpu_port))  in bcm_sf2_sw_set_wol()
924 		priv->wol_ports_mask |= (1 << cpu_port);  in bcm_sf2_sw_set_wol()
926 		priv->wol_ports_mask &= ~(1 << cpu_port);  in bcm_sf2_sw_set_wol()
928 	return p->ethtool_ops->set_wol(p, wol);  in bcm_sf2_sw_set_wol()
937 	for (port = 0; port < priv->hw_params.num_ports; port++) {  in bcm_sf2_sw_setup()
960  * bus-glue understands.
967 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_read8()
977 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_read16()
987 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_read32()
997 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_read64()
1007 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_write8()
1017 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_write16()
1027 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_write32()
1037 	struct bcm_sf2_priv *priv = dev->priv;  in bcm_sf2_core_write64()
1186 	{ .compatible = "brcm,bcm7445-switch-v4.0",
1189 	{ .compatible = "brcm,bcm7278-switch-v4.0",
1192 	{ .compatible = "brcm,bcm7278-switch-v4.8",
1202 	struct device_node *dn = pdev->dev.of_node;  in bcm_sf2_sw_probe()
1216 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);  in bcm_sf2_sw_probe()
1218 		return -ENOMEM;  in bcm_sf2_sw_probe()
1220 	ops = devm_kzalloc(&pdev->dev, sizeof(*ops), GFP_KERNEL);  in bcm_sf2_sw_probe()
1222 		return -ENOMEM;  in bcm_sf2_sw_probe()
1224 	dev = b53_switch_alloc(&pdev->dev, &bcm_sf2_io_ops, priv);  in bcm_sf2_sw_probe()
1226 		return -ENOMEM;  in bcm_sf2_sw_probe()
1228 	pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);  in bcm_sf2_sw_probe()
1230 		return -ENOMEM;  in bcm_sf2_sw_probe()
1233 	if (!of_id || !of_id->data)  in bcm_sf2_sw_probe()
1234 		return -EINVAL;  in bcm_sf2_sw_probe()
1236 	data = of_id->data;  in bcm_sf2_sw_probe()
1239 	priv->type = data->type;  in bcm_sf2_sw_probe()
1240 	priv->reg_offsets = data->reg_offsets;  in bcm_sf2_sw_probe()
1241 	priv->core_reg_align = data->core_reg_align;  in bcm_sf2_sw_probe()
1242 	priv->num_cfp_rules = data->num_cfp_rules;  in bcm_sf2_sw_probe()
1244 	priv->rcdev = devm_reset_control_get_optional_exclusive(&pdev->dev,  in bcm_sf2_sw_probe()
1246 	if (PTR_ERR(priv->rcdev) == -EPROBE_DEFER)  in bcm_sf2_sw_probe()
1247 		return PTR_ERR(priv->rcdev);  in bcm_sf2_sw_probe()
1249 	/* Auto-detection using standard registers will not work, so  in bcm_sf2_sw_probe()
1253 	pdata->chip_id = priv->type;  in bcm_sf2_sw_probe()
1254 	dev->pdata = pdata;  in bcm_sf2_sw_probe()
1256 	priv->dev = dev;  in bcm_sf2_sw_probe()
1257 	ds = dev->ds;  in bcm_sf2_sw_probe()
1258 	ds->ops = &bcm_sf2_ops;  in bcm_sf2_sw_probe()
1261 	ds->num_tx_queues = SF2_NUM_EGRESS_QUEUES;  in bcm_sf2_sw_probe()
1263 	dev_set_drvdata(&pdev->dev, priv);  in bcm_sf2_sw_probe()
1265 	spin_lock_init(&priv->indir_lock);  in bcm_sf2_sw_probe()
1266 	mutex_init(&priv->cfp.lock);  in bcm_sf2_sw_probe()
1267 	INIT_LIST_HEAD(&priv->cfp.rules_list);  in bcm_sf2_sw_probe()
1272 	set_bit(0, priv->cfp.used);  in bcm_sf2_sw_probe()
1273 	set_bit(0, priv->cfp.unique);  in bcm_sf2_sw_probe()
1283 	priv->irq0 = irq_of_parse_and_map(dn, 0);  in bcm_sf2_sw_probe()
1284 	priv->irq1 = irq_of_parse_and_map(dn, 1);  in bcm_sf2_sw_probe()
1286 	base = &priv->core;  in bcm_sf2_sw_probe()
1296 	priv->clk = devm_clk_get_optional(&pdev->dev, "sw_switch");  in bcm_sf2_sw_probe()
1297 	if (IS_ERR(priv->clk))  in bcm_sf2_sw_probe()
1298 		return PTR_ERR(priv->clk);  in bcm_sf2_sw_probe()
1300 	clk_prepare_enable(priv->clk);  in bcm_sf2_sw_probe()
1302 	priv->clk_mdiv = devm_clk_get_optional(&pdev->dev, "sw_switch_mdiv");  in bcm_sf2_sw_probe()
1303 	if (IS_ERR(priv->clk_mdiv)) {  in bcm_sf2_sw_probe()
1304 		ret = PTR_ERR(priv->clk_mdiv);  in bcm_sf2_sw_probe()
1308 	clk_prepare_enable(priv->clk_mdiv);  in bcm_sf2_sw_probe()
1316 	bcm_sf2_gphy_enable_set(priv->dev->ds, true);  in bcm_sf2_sw_probe()
1324 	bcm_sf2_gphy_enable_set(priv->dev->ds, false);  in bcm_sf2_sw_probe()
1335 	ret = devm_request_irq(&pdev->dev, priv->irq0, bcm_sf2_switch_0_isr, 0,  in bcm_sf2_sw_probe()
1342 	ret = devm_request_irq(&pdev->dev, priv->irq1, bcm_sf2_switch_1_isr, 0,  in bcm_sf2_sw_probe()
1357 	priv->hw_params.num_ports = core_readl(priv, CORE_IMP0_PRT_ID) + 1;  in bcm_sf2_sw_probe()
1358 	if (priv->hw_params.num_ports > DSA_MAX_PORTS)  in bcm_sf2_sw_probe()
1359 		priv->hw_params.num_ports = DSA_MAX_PORTS;  in bcm_sf2_sw_probe()
1362 	if (of_property_read_u32(dn, "brcm,num-gphy",  in bcm_sf2_sw_probe()
1363 				 &priv->hw_params.num_gphy))  in bcm_sf2_sw_probe()
1364 		priv->hw_params.num_gphy = 1;  in bcm_sf2_sw_probe()
1367 	priv->hw_params.top_rev = (rev >> SWITCH_TOP_REV_SHIFT) &  in bcm_sf2_sw_probe()
1369 	priv->hw_params.core_rev = (rev & SF2_REV_MASK);  in bcm_sf2_sw_probe()
1372 	priv->hw_params.gphy_rev = rev & PHY_REVISION_MASK;  in bcm_sf2_sw_probe()
1378 	dev_info(&pdev->dev,  in bcm_sf2_sw_probe()
1380 		 priv->hw_params.top_rev >> 8, priv->hw_params.top_rev & 0xff,  in bcm_sf2_sw_probe()
1381 		 priv->hw_params.core_rev >> 8, priv->hw_params.core_rev & 0xff,  in bcm_sf2_sw_probe()
1382 		 priv->irq0, priv->irq1);  in bcm_sf2_sw_probe()
1389 	clk_disable_unprepare(priv->clk_mdiv);  in bcm_sf2_sw_probe()
1391 	clk_disable_unprepare(priv->clk);  in bcm_sf2_sw_probe()
1399 	priv->wol_ports_mask = 0;  in bcm_sf2_sw_remove()
1402 	dsa_unregister_switch(priv->dev->ds);  in bcm_sf2_sw_remove()
1403 	bcm_sf2_cfp_exit(priv->dev->ds);  in bcm_sf2_sw_remove()
1405 	clk_disable_unprepare(priv->clk_mdiv);  in bcm_sf2_sw_remove()
1406 	clk_disable_unprepare(priv->clk);  in bcm_sf2_sw_remove()
1407 	if (priv->type == BCM7278_DEVICE_ID && !IS_ERR(priv->rcdev))  in bcm_sf2_sw_remove()
1408 		reset_control_assert(priv->rcdev);  in bcm_sf2_sw_remove()
1421 	 * Do not rely on kexec_in_progress, just power the PHY on.  in bcm_sf2_sw_shutdown()
1423 	if (priv->hw_params.num_gphy == 1)  in bcm_sf2_sw_shutdown()
1424 		bcm_sf2_gphy_enable_set(priv->dev->ds, true);  in bcm_sf2_sw_shutdown()
1432 	return dsa_switch_suspend(priv->dev->ds);  in bcm_sf2_suspend()
1439 	return dsa_switch_resume(priv->dev->ds);  in bcm_sf2_resume()
1452 		.name = "brcm-sf2",
1462 MODULE_ALIAS("platform:brcm-sf2");