net/mdio/mdio-mux-bcm-iproc.c

59 static void mdio_mux_iproc_config(struct iproc_mdiomux_desc *md)
65 	val = readl(md->base + MDIO_SCAN_CTRL_OFFSET);
67 	writel(val, md->base + MDIO_SCAN_CTRL_OFFSET);
69 	if (md->core_clk) {
73 		divisor = clk_get_rate(md->core_clk) / MDIO_OPERATING_FREQUENCY;
77 		writel(val, md->base + MDIO_RATE_ADJ_EXT_OFFSET);
78 		writel(val, md->base + MDIO_RATE_ADJ_INT_OFFSET);
138 	struct iproc_mdiomux_desc *md = bus->priv;
141 	ret = start_miim_ops(md->base, false, phyid, reg, 0, MDIO_CTRL_READ_OP);
151 	struct iproc_mdiomux_desc *md = bus->priv;
154 	ret = start_miim_ops(md->base, true, phyid, reg | devad << 16, 0,
165 	struct iproc_mdiomux_desc *md = bus->priv;
169 	ret = start_miim_ops(md->base, false, phyid, reg, val,
180 	struct iproc_mdiomux_desc *md = bus->priv;
184 	ret = start_miim_ops(md->base, true, phyid, reg | devad << 16, val,
195 	struct iproc_mdiomux_desc *md = data;
206 	writel(param, md->base + MDIO_PARAM_OFFSET);
212 	struct iproc_mdiomux_desc *md;
217 	md = devm_kzalloc(&pdev->dev, sizeof(*md), GFP_KERNEL);
218 	if (!md)
220 	md->dev = &pdev->dev;
222 	md->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
223 	if (IS_ERR(md->base))
224 		return PTR_ERR(md->base);
234 	md->mii_bus = devm_mdiobus_alloc(&pdev->dev);
235 	if (!md->mii_bus) {
240 	md->core_clk = devm_clk_get(&pdev->dev, NULL);
241 	if (md->core_clk == ERR_PTR(-ENOENT) ||
242 	    md->core_clk == ERR_PTR(-EINVAL))
243 		md->core_clk = NULL;
244 	else if (IS_ERR(md->core_clk))
245 		return PTR_ERR(md->core_clk);
247 	rc = clk_prepare_enable(md->core_clk);
253 	bus = md->mii_bus;
254 	bus->priv = md;
271 	platform_set_drvdata(pdev, md);
273 	rc = mdio_mux_init(md->dev, md->dev->of_node, mdio_mux_iproc_switch_fn,
274 			   &md->mux_handle, md, md->mii_bus);
276 		dev_info(md->dev, "mdiomux initialization failed\n");
280 	mdio_mux_iproc_config(md);
282 	dev_info(md->dev, "iProc mdiomux registered\n");
288 	clk_disable_unprepare(md->core_clk);
294 	struct iproc_mdiomux_desc *md = platform_get_drvdata(pdev);
296 	mdio_mux_uninit(md->mux_handle);
297 	mdiobus_unregister(md->mii_bus);
298 	clk_disable_unprepare(md->core_clk);
304 	struct iproc_mdiomux_desc *md = dev_get_drvdata(dev);
306 	clk_disable_unprepare(md->core_clk);
313 	struct iproc_mdiomux_desc *md = dev_get_drvdata(dev);
316 	rc = clk_prepare_enable(md->core_clk);
318 		dev_err(md->dev, "failed to enable core clk\n");
321 	mdio_mux_iproc_config(md);