1 // SPDX-License-Identifier: GPL-2.0
9 #include <linux/mdio-mux.h>
62 	/* Disable external mdio master access */  in mdio_mux_iproc_config()
63 	val = readl(md->base + MDIO_SCAN_CTRL_OFFSET);  in mdio_mux_iproc_config()
65 	writel(val, md->base + MDIO_SCAN_CTRL_OFFSET);  in mdio_mux_iproc_config()
67 	if (md->core_clk) {  in mdio_mux_iproc_config()
68 		/* use rate adjust regs to derrive the mdio's operating  in mdio_mux_iproc_config()
71 		divisor = clk_get_rate(md->core_clk) / MDIO_OPERATING_FREQUENCY;  in mdio_mux_iproc_config()
75 		writel(val, md->base + MDIO_RATE_ADJ_EXT_OFFSET);  in mdio_mux_iproc_config()
76 		writel(val, md->base + MDIO_RATE_ADJ_INT_OFFSET);  in mdio_mux_iproc_config()
89 /* start_miim_ops- Program and start MDIO transaction over mdio bus.
136 	struct iproc_mdiomux_desc *md = bus->priv;  in iproc_mdiomux_read()
139 	ret = start_miim_ops(md->base, phyid, reg, 0, MDIO_CTRL_READ_OP);  in iproc_mdiomux_read()
141 		dev_err(&bus->dev, "mdiomux read operation failed!!!");  in iproc_mdiomux_read()
149 	struct iproc_mdiomux_desc *md = bus->priv;  in iproc_mdiomux_write()
153 	ret = start_miim_ops(md->base, phyid, reg, val, MDIO_CTRL_WRITE_OP);  in iproc_mdiomux_write()
155 		dev_err(&bus->dev, "mdiomux write operation failed!!!");  in iproc_mdiomux_write()
169 	bus_id = bus_dir ? desired_child : (desired_child - EXT_BUS_START_ADDR);  in mdio_mux_iproc_switch_fn()
174 	writel(param, md->base + MDIO_PARAM_OFFSET);  in mdio_mux_iproc_switch_fn()
185 	md = devm_kzalloc(&pdev->dev, sizeof(*md), GFP_KERNEL);  in mdio_mux_iproc_probe()
187 		return -ENOMEM;  in mdio_mux_iproc_probe()
188 	md->dev = &pdev->dev;  in mdio_mux_iproc_probe()
191 	if (res->start & 0xfff) {  in mdio_mux_iproc_probe()
195 		dev_info(&pdev->dev, "fix base address in dt-blob\n");  in mdio_mux_iproc_probe()
196 		res->start &= ~0xfff;  in mdio_mux_iproc_probe()
197 		res->end = res->start + MDIO_REG_ADDR_SPACE_SIZE - 1;  in mdio_mux_iproc_probe()
199 	md->base = devm_ioremap_resource(&pdev->dev, res);  in mdio_mux_iproc_probe()
200 	if (IS_ERR(md->base)) {  in mdio_mux_iproc_probe()
201 		dev_err(&pdev->dev, "failed to ioremap register\n");  in mdio_mux_iproc_probe()
202 		return PTR_ERR(md->base);  in mdio_mux_iproc_probe()
205 	md->mii_bus = devm_mdiobus_alloc(&pdev->dev);  in mdio_mux_iproc_probe()
206 	if (!md->mii_bus) {  in mdio_mux_iproc_probe()
207 		dev_err(&pdev->dev, "mdiomux bus alloc failed\n");  in mdio_mux_iproc_probe()
208 		return -ENOMEM;  in mdio_mux_iproc_probe()
211 	md->core_clk = devm_clk_get(&pdev->dev, NULL);  in mdio_mux_iproc_probe()
212 	if (md->core_clk == ERR_PTR(-ENOENT) ||  in mdio_mux_iproc_probe()
213 	    md->core_clk == ERR_PTR(-EINVAL))  in mdio_mux_iproc_probe()
214 		md->core_clk = NULL;  in mdio_mux_iproc_probe()
215 	else if (IS_ERR(md->core_clk))  in mdio_mux_iproc_probe()
216 		return PTR_ERR(md->core_clk);  in mdio_mux_iproc_probe()
218 	rc = clk_prepare_enable(md->core_clk);  in mdio_mux_iproc_probe()
220 		dev_err(&pdev->dev, "failed to enable core clk\n");  in mdio_mux_iproc_probe()
224 	bus = md->mii_bus;  in mdio_mux_iproc_probe()
225 	bus->priv = md;  in mdio_mux_iproc_probe()
226 	bus->name = "iProc MDIO mux bus";  in mdio_mux_iproc_probe()
227 	snprintf(bus->id, MII_BUS_ID_SIZE, "%s-%d", pdev->name, pdev->id);  in mdio_mux_iproc_probe()
228 	bus->parent = &pdev->dev;  in mdio_mux_iproc_probe()
229 	bus->read = iproc_mdiomux_read;  in mdio_mux_iproc_probe()
230 	bus->write = iproc_mdiomux_write;  in mdio_mux_iproc_probe()
232 	bus->phy_mask = ~0;  in mdio_mux_iproc_probe()
233 	bus->dev.of_node = pdev->dev.of_node;  in mdio_mux_iproc_probe()
236 		dev_err(&pdev->dev, "mdiomux registration failed\n");  in mdio_mux_iproc_probe()
242 	rc = mdio_mux_init(md->dev, md->dev->of_node, mdio_mux_iproc_switch_fn,  in mdio_mux_iproc_probe()
243 			   &md->mux_handle, md, md->mii_bus);  in mdio_mux_iproc_probe()
245 		dev_info(md->dev, "mdiomux initialization failed\n");  in mdio_mux_iproc_probe()
251 	dev_info(md->dev, "iProc mdiomux registered\n");  in mdio_mux_iproc_probe()
257 	clk_disable_unprepare(md->core_clk);  in mdio_mux_iproc_probe()
265 	mdio_mux_uninit(md->mux_handle);  in mdio_mux_iproc_remove()
266 	mdiobus_unregister(md->mii_bus);  in mdio_mux_iproc_remove()
267 	clk_disable_unprepare(md->core_clk);  in mdio_mux_iproc_remove()
277 	clk_disable_unprepare(md->core_clk);  in mdio_mux_iproc_suspend()
287 	rc = clk_prepare_enable(md->core_clk);  in mdio_mux_iproc_resume()
289 		dev_err(md->dev, "failed to enable core clk\n");  in mdio_mux_iproc_resume()
303 		.compatible = "brcm,mdio-mux-iproc",
311 		.name		= "mdio-mux-iproc",
321 MODULE_DESCRIPTION("iProc MDIO Mux Bus Driver");