From nobody Sun Nov 24 16:26:22 2024 Received: from metis.whiteo.stw.pengutronix.de (metis.whiteo.stw.pengutronix.de [185.203.201.7]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id CEC8C1CCEFA for ; Tue, 5 Nov 2024 09:10:06 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=185.203.201.7 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1730797808; cv=none; b=XHJOfDoL4eaaQbGoiAZ1ConjwF0YB9JlUyshuhNBGb2h2ivrlIqMl/z+c9LjN2Qr5qjZqD6t6z9Z8Y+6fWuUpBCky2f4qFDactpfN6Xl3xxZPw8gWQ0uGiccWWENgPNhLdG8wlKLnbehZ8PdIeHRssGyFMN4ZxCDclJcwBf6X2g= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1730797808; c=relaxed/simple; bh=UGvGBoQjhb5/qwftI5v5FRQl/ddwR/37BXspqE1zSDI=; h=From:To:Cc:Subject:Date:Message-Id:In-Reply-To:References: MIME-Version; b=CAIPGWhp3PGfVktWZeqbNUftgFUOs0Kow/RltUk1o77VT33Ceo2HGYEnflSAFh0S/8IjkV/sn/a59c5026PCwQyjRLtrbzQGZNOc8Hinj1H2oqUABI2vepCkF17cMWtzCvqL2MEz2/eJ46lKuicy7W/ev3Z6X4OEYCaCcdZHNx4= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=pengutronix.de; spf=pass smtp.mailfrom=pengutronix.de; arc=none smtp.client-ip=185.203.201.7 Authentication-Results: smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=pengutronix.de Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=pengutronix.de Received: from drehscheibe.grey.stw.pengutronix.de ([2a0a:edc0:0:c01:1d::a2]) by metis.whiteo.stw.pengutronix.de with esmtps (TLS1.3:ECDHE_RSA_AES_256_GCM_SHA384:256) (Exim 4.92) (envelope-from ) id 1t8FZL-0003oR-Rq; Tue, 05 Nov 2024 10:09:47 +0100 Received: from dude04.red.stw.pengutronix.de ([2a0a:edc0:0:1101:1d::ac]) by drehscheibe.grey.stw.pengutronix.de with esmtps (TLS1.3) tls TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384 (Exim 4.96) (envelope-from ) id 1t8FZK-0027Yb-1g; Tue, 05 Nov 2024 10:09:46 +0100 Received: from ore by dude04.red.stw.pengutronix.de with local (Exim 4.96) (envelope-from ) id 1t8FZK-002ogQ-1M; Tue, 05 Nov 2024 10:09:46 +0100 From: Oleksij Rempel To: "David S. Miller" , Andrew Lunn , Eric Dumazet , Florian Fainelli , Jakub Kicinski , Paolo Abeni , Vladimir Oltean , Woojung Huh , Arun Ramadoss , Conor Dooley , Krzysztof Kozlowski , Rob Herring Cc: Oleksij Rempel , kernel@pengutronix.de, linux-kernel@vger.kernel.org, netdev@vger.kernel.org, UNGLinuxDriver@microchip.com, "Russell King (Oracle)" , devicetree@vger.kernel.org, Marek Vasut Subject: [PATCH net-next v3 6/6] net: dsa: microchip: parse PHY config from device tree Date: Tue, 5 Nov 2024 10:09:44 +0100 Message-Id: <20241105090944.671379-7-o.rempel@pengutronix.de> X-Mailer: git-send-email 2.39.5 In-Reply-To: <20241105090944.671379-1-o.rempel@pengutronix.de> References: <20241105090944.671379-1-o.rempel@pengutronix.de> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable X-SA-Exim-Connect-IP: 2a0a:edc0:0:c01:1d::a2 X-SA-Exim-Mail-From: ore@pengutronix.de X-SA-Exim-Scanned: No (on metis.whiteo.stw.pengutronix.de); SAEximRunCond expanded to false X-PTX-Original-Recipient: linux-kernel@vger.kernel.org Content-Type: text/plain; charset="utf-8" Introduce ksz_parse_dt_phy_config() to validate and parse PHY configuration from the device tree for KSZ switches. This function ensures proper setup of internal PHYs by checking `phy-handle` properties, verifying expected PHY IDs, and handling parent node mismatches. Sets the PHY mask on the MII bus if validation is successful. Returns -EINVAL on configuration errors. Signed-off-by: Oleksij Rempel --- drivers/net/dsa/microchip/ksz_common.c | 80 ++++++++++++++++++++++++-- 1 file changed, 74 insertions(+), 6 deletions(-) diff --git a/drivers/net/dsa/microchip/ksz_common.c b/drivers/net/dsa/micro= chip/ksz_common.c index 3909b55857430..cd1a466504180 100644 --- a/drivers/net/dsa/microchip/ksz_common.c +++ b/drivers/net/dsa/microchip/ksz_common.c @@ -2373,6 +2373,77 @@ static void ksz_irq_phy_free(struct ksz_device *dev) irq_dispose_mapping(ds->user_mii_bus->irq[phy]); } +/** + * ksz_parse_dt_phy_config - Parse and validate PHY configuration from DT + * @dev: pointer to the KSZ device structure + * @bus: pointer to the MII bus structure + * @mdio_np: pointer to the MDIO node in the device tree + * + * This function parses and validates PHY configurations for each user port + * defined in the device tree for a KSZ switch device. It verifies that the + * `phy-handle` properties are correctly set and that the internal PHYs ma= tch + * expected IDs and parent nodes. Sets up the PHY mask in the MII bus if a= ll + * validations pass. Logs error messages for any mismatches or missing dat= a. + * + * Return: 0 on success, or a negative error code on failure. + */ +static int ksz_parse_dt_phy_config(struct ksz_device *dev, struct mii_bus = *bus, + struct device_node *mdio_np) +{ + struct device_node *phy_node, *phy_parent_node; + bool phys_are_valid =3D true; + struct dsa_port *dp; + u32 phy_id; + int ret; + + dsa_switch_for_each_user_port(dp, dev->ds) { + if (!dev->info->internal_phy[dp->index]) + continue; + + phy_node =3D of_parse_phandle(dp->dn, "phy-handle", 0); + if (!phy_node) { + dev_err(dev->dev, "failed to parse phy-handle for port %d.\n", + dp->index); + phys_are_valid =3D false; + continue; + } + + phy_parent_node =3D of_get_parent(phy_node); + if (!phy_parent_node) { + dev_err(dev->dev, "failed to get PHY-parent node for port %d\n", + dp->index); + phys_are_valid =3D false; + } else if (dev->info->internal_phy[dp->index] && + phy_parent_node !=3D mdio_np) { + dev_err(dev->dev, "PHY-parent node mismatch for port %d, expected %pOF,= got %pOF\n", + dp->index, mdio_np, phy_parent_node); + phys_are_valid =3D false; + } else { + ret =3D of_property_read_u32(phy_node, "reg", &phy_id); + if (ret < 0) { + dev_err(dev->dev, "failed to read PHY ID for port %d. Error %d\n", + dp->index, ret); + phys_are_valid =3D false; + } else if (phy_id !=3D dev->phy_addr_map[dp->index]) { + dev_err(dev->dev, "PHY ID mismatch for port %d, expected 0x%x, got 0x%= x\n", + dp->index, dev->phy_addr_map[dp->index], + phy_id); + phys_are_valid =3D false; + } else { + bus->phy_mask |=3D BIT(phy_id); + } + } + + of_node_put(phy_node); + of_node_put(phy_parent_node); + } + + if (!phys_are_valid) + return -EINVAL; + + return 0; +} + /** * ksz_mdio_register - Register and configure the MDIO bus for the KSZ dev= ice. * @dev: Pointer to the KSZ device structure. @@ -2392,7 +2463,6 @@ static int ksz_mdio_register(struct ksz_device *dev) struct dsa_switch *ds =3D dev->ds; struct device_node *mdio_np; struct mii_bus *bus; - struct dsa_port *dp; int ret, i; mdio_np =3D of_get_child_by_name(dev->dev->of_node, "mdio"); @@ -2451,11 +2521,9 @@ static int ksz_mdio_register(struct ksz_device *dev) snprintf(bus->id, MII_BUS_ID_SIZE, "SMI-%d", ds->index); } - dsa_switch_for_each_user_port(dp, dev->ds) { - if (dev->info->internal_phy[dp->index] && - dev->phy_addr_map[dp->index] < PHY_MAX_ADDR) - bus->phy_mask |=3D BIT(dev->phy_addr_map[dp->index]); - } + ret =3D ksz_parse_dt_phy_config(dev, bus, mdio_np); + if (ret) + goto put_mdio_node; ds->phys_mii_mask =3D bus->phy_mask; bus->parent =3D ds->dev; -- 2.39.5