57 static void mdio_mux_iproc_config(struct iproc_mdiomux_desc *md)  in mdio_mux_iproc_config()  argument
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()
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()
136 	struct iproc_mdiomux_desc *md = bus->priv;  in iproc_mdiomux_read_c22()  local
139 	ret = start_miim_ops(md->base, false, phyid, reg, 0, MDIO_CTRL_READ_OP);  in iproc_mdiomux_read_c22()
149 	struct iproc_mdiomux_desc *md = bus->priv;  in iproc_mdiomux_read_c45()  local
152 	ret = start_miim_ops(md->base, true, phyid, reg | devad << 16, 0,  in iproc_mdiomux_read_c45()
163 	struct iproc_mdiomux_desc *md = bus->priv;  in iproc_mdiomux_write_c22()  local
167 	ret = start_miim_ops(md->base, false, phyid, reg, val,  in iproc_mdiomux_write_c22()
178 	struct iproc_mdiomux_desc *md = bus->priv;  in iproc_mdiomux_write_c45()  local
182 	ret = start_miim_ops(md->base, true, phyid, reg | devad << 16, val,  in iproc_mdiomux_write_c45()
193 	struct iproc_mdiomux_desc *md = data;  in mdio_mux_iproc_switch_fn()  local
204 	writel(param, md->base + MDIO_PARAM_OFFSET);  in mdio_mux_iproc_switch_fn()
210 	struct iproc_mdiomux_desc *md;  in mdio_mux_iproc_probe()  local
215 	md = devm_kzalloc(&pdev->dev, sizeof(*md), GFP_KERNEL);  in mdio_mux_iproc_probe()
216 	if (!md)  in mdio_mux_iproc_probe()
218 	md->dev = &pdev->dev;  in mdio_mux_iproc_probe()
220 	md->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);  in mdio_mux_iproc_probe()
221 	if (IS_ERR(md->base))  in mdio_mux_iproc_probe()
222 		return PTR_ERR(md->base);  in mdio_mux_iproc_probe()
232 	md->mii_bus = devm_mdiobus_alloc(&pdev->dev);  in mdio_mux_iproc_probe()
233 	if (!md->mii_bus) {  in mdio_mux_iproc_probe()
238 	md->core_clk = devm_clk_get(&pdev->dev, NULL);  in mdio_mux_iproc_probe()
239 	if (md->core_clk == ERR_PTR(-ENOENT) ||  in mdio_mux_iproc_probe()
240 	    md->core_clk == ERR_PTR(-EINVAL))  in mdio_mux_iproc_probe()
241 		md->core_clk = NULL;  in mdio_mux_iproc_probe()
242 	else if (IS_ERR(md->core_clk))  in mdio_mux_iproc_probe()
243 		return PTR_ERR(md->core_clk);  in mdio_mux_iproc_probe()
245 	rc = clk_prepare_enable(md->core_clk);  in mdio_mux_iproc_probe()
251 	bus = md->mii_bus;  in mdio_mux_iproc_probe()
252 	bus->priv = md;  in mdio_mux_iproc_probe()
269 	platform_set_drvdata(pdev, md);  in mdio_mux_iproc_probe()
271 	rc = mdio_mux_init(md->dev, md->dev->of_node, mdio_mux_iproc_switch_fn,  in mdio_mux_iproc_probe()
272 			   &md->mux_handle, md, md->mii_bus);  in mdio_mux_iproc_probe()
274 		dev_info(md->dev, "mdiomux initialization failed\n");  in mdio_mux_iproc_probe()
278 	mdio_mux_iproc_config(md);  in mdio_mux_iproc_probe()
280 	dev_info(md->dev, "iProc mdiomux registered\n");  in mdio_mux_iproc_probe()
286 	clk_disable_unprepare(md->core_clk);  in mdio_mux_iproc_probe()
292 	struct iproc_mdiomux_desc *md = platform_get_drvdata(pdev);  in mdio_mux_iproc_remove()  local
294 	mdio_mux_uninit(md->mux_handle);  in mdio_mux_iproc_remove()
295 	mdiobus_unregister(md->mii_bus);  in mdio_mux_iproc_remove()
296 	clk_disable_unprepare(md->core_clk);  in mdio_mux_iproc_remove()
304 	struct iproc_mdiomux_desc *md = dev_get_drvdata(dev);  in mdio_mux_iproc_suspend()  local
306 	clk_disable_unprepare(md->core_clk);  in mdio_mux_iproc_suspend()
313 	struct iproc_mdiomux_desc *md = dev_get_drvdata(dev);  in mdio_mux_iproc_resume()  local
316 	rc = clk_prepare_enable(md->core_clk);  in mdio_mux_iproc_resume()
318 		dev_err(md->dev, "failed to enable core clk\n");  in mdio_mux_iproc_resume()
321 	mdio_mux_iproc_config(md);  in mdio_mux_iproc_resume()