Andrew Lunn | 8bbe833 | 2019-01-21 19:34:53 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 2 | /* |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 3 | * Copyright (C) 2009-2015 Cavium, Inc. |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 4 | */ |
| 5 | |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 6 | #include <linux/platform_device.h> |
Radha Mohan Chintakuntla | a6d6786 | 2015-07-28 15:12:11 -0700 | [diff] [blame] | 7 | #include <linux/of_address.h> |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 8 | #include <linux/of_mdio.h> |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 9 | #include <linux/module.h> |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 10 | #include <linux/gfp.h> |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 11 | #include <linux/phy.h> |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 12 | #include <linux/io.h> |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 13 | |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 14 | #include "mdio-cavium.h" |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 15 | |
Bill Pemberton | 633d159 | 2012-12-03 09:24:14 -0500 | [diff] [blame] | 16 | static int octeon_mdiobus_probe(struct platform_device *pdev) |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 17 | { |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 18 | struct cavium_mdiobus *bus; |
Andrew Lunn | 35d2aea | 2016-01-06 20:11:14 +0100 | [diff] [blame] | 19 | struct mii_bus *mii_bus; |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 20 | struct resource *res_mem; |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 21 | resource_size_t mdio_phys; |
| 22 | resource_size_t regsize; |
David Daney | 6c17812 | 2010-04-01 18:17:54 -0700 | [diff] [blame] | 23 | union cvmx_smix_en smi_en; |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 24 | int err = -ENOENT; |
| 25 | |
Andrew Lunn | 35d2aea | 2016-01-06 20:11:14 +0100 | [diff] [blame] | 26 | mii_bus = devm_mdiobus_alloc_size(&pdev->dev, sizeof(*bus)); |
| 27 | if (!mii_bus) |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 28 | return -ENOMEM; |
| 29 | |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 30 | res_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 31 | if (res_mem == NULL) { |
| 32 | dev_err(&pdev->dev, "found no memory resource\n"); |
Radha Mohan Chintakuntla | de9e397 | 2015-07-28 15:12:12 -0700 | [diff] [blame] | 33 | return -ENXIO; |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 34 | } |
Radha Mohan Chintakuntla | de9e397 | 2015-07-28 15:12:12 -0700 | [diff] [blame] | 35 | |
Andrew Lunn | 35d2aea | 2016-01-06 20:11:14 +0100 | [diff] [blame] | 36 | bus = mii_bus->priv; |
| 37 | bus->mii_bus = mii_bus; |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 38 | mdio_phys = res_mem->start; |
| 39 | regsize = resource_size(res_mem); |
Radha Mohan Chintakuntla | de9e397 | 2015-07-28 15:12:12 -0700 | [diff] [blame] | 40 | |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 41 | if (!devm_request_mem_region(&pdev->dev, mdio_phys, regsize, |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 42 | res_mem->name)) { |
| 43 | dev_err(&pdev->dev, "request_mem_region failed\n"); |
Radha Mohan Chintakuntla | de9e397 | 2015-07-28 15:12:12 -0700 | [diff] [blame] | 44 | return -ENXIO; |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 45 | } |
Radha Mohan Chintakuntla | de9e397 | 2015-07-28 15:12:12 -0700 | [diff] [blame] | 46 | |
Andrew Lunn | c7b04d1 | 2020-07-07 03:49:38 +0200 | [diff] [blame] | 47 | bus->register_base = devm_ioremap(&pdev->dev, mdio_phys, regsize); |
Radha Mohan Chintakuntla | de9e397 | 2015-07-28 15:12:12 -0700 | [diff] [blame] | 48 | if (!bus->register_base) { |
| 49 | dev_err(&pdev->dev, "dev_ioremap failed\n"); |
| 50 | return -ENOMEM; |
| 51 | } |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 52 | |
David Daney | 6c17812 | 2010-04-01 18:17:54 -0700 | [diff] [blame] | 53 | smi_en.u64 = 0; |
| 54 | smi_en.s.en = 1; |
Radha Mohan Chintakuntla | a6d6786 | 2015-07-28 15:12:11 -0700 | [diff] [blame] | 55 | oct_mdio_writeq(smi_en.u64, bus->register_base + SMI_EN); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 56 | |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 57 | bus->mii_bus->name = KBUILD_MODNAME; |
Andrew Lunn | c7b04d1 | 2020-07-07 03:49:38 +0200 | [diff] [blame] | 58 | snprintf(bus->mii_bus->id, MII_BUS_ID_SIZE, "%px", bus->register_base); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 59 | bus->mii_bus->parent = &pdev->dev; |
| 60 | |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 61 | bus->mii_bus->read = cavium_mdiobus_read; |
| 62 | bus->mii_bus->write = cavium_mdiobus_write; |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 63 | |
Libo Chen | f882566 | 2013-08-21 18:15:15 +0800 | [diff] [blame] | 64 | platform_set_drvdata(pdev, bus); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 65 | |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 66 | err = of_mdiobus_register(bus->mii_bus, pdev->dev.of_node); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 67 | if (err) |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 68 | goto fail_register; |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 69 | |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 70 | dev_info(&pdev->dev, "Probed\n"); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 71 | |
| 72 | return 0; |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 73 | fail_register: |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 74 | mdiobus_free(bus->mii_bus); |
David Daney | 6c17812 | 2010-04-01 18:17:54 -0700 | [diff] [blame] | 75 | smi_en.u64 = 0; |
Radha Mohan Chintakuntla | a6d6786 | 2015-07-28 15:12:11 -0700 | [diff] [blame] | 76 | oct_mdio_writeq(smi_en.u64, bus->register_base + SMI_EN); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 77 | return err; |
| 78 | } |
| 79 | |
Bill Pemberton | 633d159 | 2012-12-03 09:24:14 -0500 | [diff] [blame] | 80 | static int octeon_mdiobus_remove(struct platform_device *pdev) |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 81 | { |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 82 | struct cavium_mdiobus *bus; |
David Daney | 6c17812 | 2010-04-01 18:17:54 -0700 | [diff] [blame] | 83 | union cvmx_smix_en smi_en; |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 84 | |
Jingoo Han | 2c0c4fb | 2013-09-02 17:10:09 +0900 | [diff] [blame] | 85 | bus = platform_get_drvdata(pdev); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 86 | |
| 87 | mdiobus_unregister(bus->mii_bus); |
| 88 | mdiobus_free(bus->mii_bus); |
David Daney | 6c17812 | 2010-04-01 18:17:54 -0700 | [diff] [blame] | 89 | smi_en.u64 = 0; |
Radha Mohan Chintakuntla | a6d6786 | 2015-07-28 15:12:11 -0700 | [diff] [blame] | 90 | oct_mdio_writeq(smi_en.u64, bus->register_base + SMI_EN); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 91 | return 0; |
| 92 | } |
| 93 | |
Fabian Frederick | d8a7dad | 2015-03-17 19:40:23 +0100 | [diff] [blame] | 94 | static const struct of_device_id octeon_mdiobus_match[] = { |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 95 | { |
| 96 | .compatible = "cavium,octeon-3860-mdio", |
| 97 | }, |
| 98 | {}, |
| 99 | }; |
| 100 | MODULE_DEVICE_TABLE(of, octeon_mdiobus_match); |
| 101 | |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 102 | static struct platform_driver octeon_mdiobus_driver = { |
| 103 | .driver = { |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 104 | .name = KBUILD_MODNAME, |
David Daney | 2fd46f4 | 2012-07-05 18:12:39 +0200 | [diff] [blame] | 105 | .of_match_table = octeon_mdiobus_match, |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 106 | }, |
| 107 | .probe = octeon_mdiobus_probe, |
Bill Pemberton | 633d159 | 2012-12-03 09:24:14 -0500 | [diff] [blame] | 108 | .remove = octeon_mdiobus_remove, |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 109 | }; |
| 110 | |
Sachin Kamat | 9fad0c9 | 2013-03-20 01:41:32 +0000 | [diff] [blame] | 111 | module_platform_driver(octeon_mdiobus_driver); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 112 | |
David Daney | 1eefee9 | 2016-03-11 09:53:10 -0800 | [diff] [blame] | 113 | MODULE_DESCRIPTION("Cavium OCTEON MDIO bus driver"); |
David Daney | 25d967b | 2009-10-14 12:04:38 -0700 | [diff] [blame] | 114 | MODULE_AUTHOR("David Daney"); |
Andrew Lunn | 8bbe833 | 2019-01-21 19:34:53 +0100 | [diff] [blame] | 115 | MODULE_LICENSE("GPL v2"); |