1 // SPDX-License-Identifier: GPL-2.0
17 #define MAX_A38X_PORTS	3
28 #define  COMPHY_STAT1_PLL_RDY_TX	BIT(3)
56 	{ 3, 0, 0 },
60 	{ 0, 3, 0 },
61 	{ 0, 0, 3 },
66 	struct a38x_comphy *priv = lane->priv;  in a38x_set_conf()
69 	if (priv->conf) {  in a38x_set_conf()
70 		conf = readl_relaxed(priv->conf);  in a38x_set_conf()
72 			conf |= BIT(lane->port);  in a38x_set_conf()
74 			conf &= ~BIT(lane->port);  in a38x_set_conf()
75 		writel(conf, priv->conf);  in a38x_set_conf()
84 	val = readl_relaxed(lane->base + offset) & ~mask;  in a38x_comphy_set_reg()
85 	writel(val | value, lane->base + offset);  in a38x_comphy_set_reg()
103 	ret = readl_relaxed_poll_timeout_atomic(lane->base + offset, val,  in a38x_comphy_poll()
108 		dev_err(lane->priv->dev,  in a38x_comphy_poll()
109 			"comphy%u: timed out waiting for status\n", lane->n);  in a38x_comphy_poll()
121 	unsigned int gen;  in a38x_comphy_set_mode()  local
125 		return -EINVAL;  in a38x_comphy_set_mode()
130 		gen = GEN_SGMII_1_25GBPS;  in a38x_comphy_set_mode()
134 		gen = GEN_SGMII_3_125GBPS;  in a38x_comphy_set_mode()
138 		return -EINVAL;  in a38x_comphy_set_mode()
143 	a38x_comphy_set_speed(lane, gen, gen);  in a38x_comphy_set_mode()
169 	if (WARN_ON(args->args[0] >= MAX_A38X_PORTS))  in a38x_comphy_xlate()
170 		return ERR_PTR(-EINVAL);  in a38x_comphy_xlate()
177 	if (lane->port >= 0)  in a38x_comphy_xlate()
178 		return ERR_PTR(-EBUSY);  in a38x_comphy_xlate()
180 	lane->port = args->args[0];  in a38x_comphy_xlate()
182 	val = readl_relaxed(lane->priv->base + COMPHY_SELECTOR);  in a38x_comphy_xlate()
183 	val = (val >> (4 * lane->n)) & 0xf;  in a38x_comphy_xlate()
185 	if (!gbe_mux[lane->n][lane->port] ||  in a38x_comphy_xlate()
186 	    val != gbe_mux[lane->n][lane->port]) {  in a38x_comphy_xlate()
187 		dev_warn(lane->priv->dev,  in a38x_comphy_xlate()
188 			 "comphy%u: not configured for GBE\n", lane->n);  in a38x_comphy_xlate()
189 		phy = ERR_PTR(-EINVAL);  in a38x_comphy_xlate()
203 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);  in a38x_comphy_probe()
205 		return -ENOMEM;  in a38x_comphy_probe()
211 	priv->dev = &pdev->dev;  in a38x_comphy_probe()
212 	priv->base = base;  in a38x_comphy_probe()
217 		priv->conf = devm_ioremap_resource(&pdev->dev, res);  in a38x_comphy_probe()
218 		if (IS_ERR(priv->conf))  in a38x_comphy_probe()
219 			return PTR_ERR(priv->conf);  in a38x_comphy_probe()
222 	for_each_available_child_of_node(pdev->dev.of_node, child) {  in a38x_comphy_probe()
229 			dev_err(&pdev->dev, "missing 'reg' property (%d)\n",  in a38x_comphy_probe()
234 		if (val >= MAX_A38X_COMPHY || priv->lane[val].base) {  in a38x_comphy_probe()
235 			dev_err(&pdev->dev, "invalid 'reg' property\n");  in a38x_comphy_probe()
239 		phy = devm_phy_create(&pdev->dev, child, &a38x_comphy_ops);  in a38x_comphy_probe()
245 		priv->lane[val].base = base + 0x28 * val;  in a38x_comphy_probe()
246 		priv->lane[val].priv = priv;  in a38x_comphy_probe()
247 		priv->lane[val].n = val;  in a38x_comphy_probe()
248 		priv->lane[val].port = -1;  in a38x_comphy_probe()
249 		phy_set_drvdata(phy, &priv->lane[val]);  in a38x_comphy_probe()
252 	dev_set_drvdata(&pdev->dev, priv);  in a38x_comphy_probe()
254 	provider = devm_of_phy_provider_register(&pdev->dev, a38x_comphy_xlate);  in a38x_comphy_probe()
260 	{ .compatible = "marvell,armada-380-comphy" },
268 		.name = "armada-38x-comphy",