net/mdio/mdio-octeon.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /*
0003  * Copyright (C) 2009-2015 Cavium, Inc.
0004  */
0005
0006 #include <linux/gfp.h>
0007 #include <linux/io.h>
0008 #include <linux/module.h>
0009 #include <linux/of_address.h>
0010 #include <linux/of_mdio.h>
0011 #include <linux/phy.h>
0012 #include <linux/platform_device.h>
0013
0014 #include "mdio-cavium.h"
0015
0016 static int octeon_mdiobus_probe(struct platform_device *pdev)
0017 {
0018     struct cavium_mdiobus *bus;
0019     struct mii_bus *mii_bus;
0020     struct resource *res_mem;
0021     resource_size_t mdio_phys;
0022     resource_size_t regsize;
0023     union cvmx_smix_en smi_en;
0024     int err = -ENOENT;
0025
0026     mii_bus = devm_mdiobus_alloc_size(&pdev->dev, sizeof(*bus));
0027     if (!mii_bus)
0028         return -ENOMEM;
0029
0030     res_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
0031     if (res_mem == NULL) {
0032         dev_err(&pdev->dev, "found no memory resource\n");
0033         return -ENXIO;
0034     }
0035
0036     bus = mii_bus->priv;
0037     bus->mii_bus = mii_bus;
0038     mdio_phys = res_mem->start;
0039     regsize = resource_size(res_mem);
0040
0041     if (!devm_request_mem_region(&pdev->dev, mdio_phys, regsize,
0042                      res_mem->name)) {
0043         dev_err(&pdev->dev, "request_mem_region failed\n");
0044         return -ENXIO;
0045     }
0046
0047     bus->register_base = devm_ioremap(&pdev->dev, mdio_phys, regsize);
0048     if (!bus->register_base) {
0049         dev_err(&pdev->dev, "dev_ioremap failed\n");
0050         return -ENOMEM;
0051     }
0052
0053     smi_en.u64 = 0;
0054     smi_en.s.en = 1;
0055     oct_mdio_writeq(smi_en.u64, bus->register_base + SMI_EN);
0056
0057     bus->mii_bus->name = KBUILD_MODNAME;
0058     snprintf(bus->mii_bus->id, MII_BUS_ID_SIZE, "%px", bus->register_base);
0059     bus->mii_bus->parent = &pdev->dev;
0060
0061     bus->mii_bus->read = cavium_mdiobus_read;
0062     bus->mii_bus->write = cavium_mdiobus_write;
0063
0064     platform_set_drvdata(pdev, bus);
0065
0066     err = of_mdiobus_register(bus->mii_bus, pdev->dev.of_node);
0067     if (err)
0068         goto fail_register;
0069
0070     dev_info(&pdev->dev, "Probed\n");
0071
0072     return 0;
0073 fail_register:
0074     smi_en.u64 = 0;
0075     oct_mdio_writeq(smi_en.u64, bus->register_base + SMI_EN);
0076     return err;
0077 }
0078
0079 static int octeon_mdiobus_remove(struct platform_device *pdev)
0080 {
0081     struct cavium_mdiobus *bus;
0082     union cvmx_smix_en smi_en;
0083
0084     bus = platform_get_drvdata(pdev);
0085
0086     mdiobus_unregister(bus->mii_bus);
0087     smi_en.u64 = 0;
0088     oct_mdio_writeq(smi_en.u64, bus->register_base + SMI_EN);
0089     return 0;
0090 }
0091
0092 static const struct of_device_id octeon_mdiobus_match[] = {
0093     {
0094         .compatible = "cavium,octeon-3860-mdio",
0095     },
0096     {},
0097 };
0098 MODULE_DEVICE_TABLE(of, octeon_mdiobus_match);
0099
0100 static struct platform_driver octeon_mdiobus_driver = {
0101     .driver = {
0102         .name       = KBUILD_MODNAME,
0103         .of_match_table = octeon_mdiobus_match,
0104     },
0105     .probe      = octeon_mdiobus_probe,
0106     .remove     = octeon_mdiobus_remove,
0107 };
0108
0109 module_platform_driver(octeon_mdiobus_driver);
0110
0111 MODULE_DESCRIPTION("Cavium OCTEON MDIO bus driver");
0112 MODULE_AUTHOR("David Daney");
0113 MODULE_LICENSE("GPL v2");