![David Daney](/assets/img/avatar_default.png)
In some cases the mdio bus is not enabled at the time of probing. This prevents anything from working, so we will enable it before trying to use it, and disable it when the driver is removed. Signed-off-by: David Daney <ddaney@caviumnetworks.com> To: linux-mips@linux-mips.org To: netdev@vger.kernel.org To: gregkh@suse.de Patchwork: http://patchwork.linux-mips.org/patch/1090/ Acked-by: David S. Miller <davem@davemloft.net> Acked-by: Greg Kroah-Hartman <gregkh@suse.de> Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
192 lines
4.3 KiB
C
192 lines
4.3 KiB
C
/*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file "COPYING" in the main directory of this archive
|
|
* for more details.
|
|
*
|
|
* Copyright (C) 2009 Cavium Networks
|
|
*/
|
|
|
|
#include <linux/gfp.h>
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/phy.h>
|
|
|
|
#include <asm/octeon/octeon.h>
|
|
#include <asm/octeon/cvmx-smix-defs.h>
|
|
|
|
#define DRV_VERSION "1.0"
|
|
#define DRV_DESCRIPTION "Cavium Networks Octeon SMI/MDIO driver"
|
|
|
|
struct octeon_mdiobus {
|
|
struct mii_bus *mii_bus;
|
|
int unit;
|
|
int phy_irq[PHY_MAX_ADDR];
|
|
};
|
|
|
|
static int octeon_mdiobus_read(struct mii_bus *bus, int phy_id, int regnum)
|
|
{
|
|
struct octeon_mdiobus *p = bus->priv;
|
|
union cvmx_smix_cmd smi_cmd;
|
|
union cvmx_smix_rd_dat smi_rd;
|
|
int timeout = 1000;
|
|
|
|
smi_cmd.u64 = 0;
|
|
smi_cmd.s.phy_op = 1; /* MDIO_CLAUSE_22_READ */
|
|
smi_cmd.s.phy_adr = phy_id;
|
|
smi_cmd.s.reg_adr = regnum;
|
|
cvmx_write_csr(CVMX_SMIX_CMD(p->unit), smi_cmd.u64);
|
|
|
|
do {
|
|
/*
|
|
* Wait 1000 clocks so we don't saturate the RSL bus
|
|
* doing reads.
|
|
*/
|
|
cvmx_wait(1000);
|
|
smi_rd.u64 = cvmx_read_csr(CVMX_SMIX_RD_DAT(p->unit));
|
|
} while (smi_rd.s.pending && --timeout);
|
|
|
|
if (smi_rd.s.val)
|
|
return smi_rd.s.dat;
|
|
else
|
|
return -EIO;
|
|
}
|
|
|
|
static int octeon_mdiobus_write(struct mii_bus *bus, int phy_id,
|
|
int regnum, u16 val)
|
|
{
|
|
struct octeon_mdiobus *p = bus->priv;
|
|
union cvmx_smix_cmd smi_cmd;
|
|
union cvmx_smix_wr_dat smi_wr;
|
|
int timeout = 1000;
|
|
|
|
smi_wr.u64 = 0;
|
|
smi_wr.s.dat = val;
|
|
cvmx_write_csr(CVMX_SMIX_WR_DAT(p->unit), smi_wr.u64);
|
|
|
|
smi_cmd.u64 = 0;
|
|
smi_cmd.s.phy_op = 0; /* MDIO_CLAUSE_22_WRITE */
|
|
smi_cmd.s.phy_adr = phy_id;
|
|
smi_cmd.s.reg_adr = regnum;
|
|
cvmx_write_csr(CVMX_SMIX_CMD(p->unit), smi_cmd.u64);
|
|
|
|
do {
|
|
/*
|
|
* Wait 1000 clocks so we don't saturate the RSL bus
|
|
* doing reads.
|
|
*/
|
|
cvmx_wait(1000);
|
|
smi_wr.u64 = cvmx_read_csr(CVMX_SMIX_WR_DAT(p->unit));
|
|
} while (smi_wr.s.pending && --timeout);
|
|
|
|
if (timeout <= 0)
|
|
return -EIO;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __init octeon_mdiobus_probe(struct platform_device *pdev)
|
|
{
|
|
struct octeon_mdiobus *bus;
|
|
union cvmx_smix_en smi_en;
|
|
int i;
|
|
int err = -ENOENT;
|
|
|
|
bus = devm_kzalloc(&pdev->dev, sizeof(*bus), GFP_KERNEL);
|
|
if (!bus)
|
|
return -ENOMEM;
|
|
|
|
/* The platform_device id is our unit number. */
|
|
bus->unit = pdev->id;
|
|
|
|
bus->mii_bus = mdiobus_alloc();
|
|
|
|
if (!bus->mii_bus)
|
|
goto err;
|
|
|
|
smi_en.u64 = 0;
|
|
smi_en.s.en = 1;
|
|
cvmx_write_csr(CVMX_SMIX_EN(bus->unit), smi_en.u64);
|
|
|
|
/*
|
|
* Standard Octeon evaluation boards don't support phy
|
|
* interrupts, we need to poll.
|
|
*/
|
|
for (i = 0; i < PHY_MAX_ADDR; i++)
|
|
bus->phy_irq[i] = PHY_POLL;
|
|
|
|
bus->mii_bus->priv = bus;
|
|
bus->mii_bus->irq = bus->phy_irq;
|
|
bus->mii_bus->name = "mdio-octeon";
|
|
snprintf(bus->mii_bus->id, MII_BUS_ID_SIZE, "%x", bus->unit);
|
|
bus->mii_bus->parent = &pdev->dev;
|
|
|
|
bus->mii_bus->read = octeon_mdiobus_read;
|
|
bus->mii_bus->write = octeon_mdiobus_write;
|
|
|
|
dev_set_drvdata(&pdev->dev, bus);
|
|
|
|
err = mdiobus_register(bus->mii_bus);
|
|
if (err)
|
|
goto err_register;
|
|
|
|
dev_info(&pdev->dev, "Version " DRV_VERSION "\n");
|
|
|
|
return 0;
|
|
err_register:
|
|
mdiobus_free(bus->mii_bus);
|
|
|
|
err:
|
|
devm_kfree(&pdev->dev, bus);
|
|
smi_en.u64 = 0;
|
|
cvmx_write_csr(CVMX_SMIX_EN(bus->unit), smi_en.u64);
|
|
return err;
|
|
}
|
|
|
|
static int __exit octeon_mdiobus_remove(struct platform_device *pdev)
|
|
{
|
|
struct octeon_mdiobus *bus;
|
|
union cvmx_smix_en smi_en;
|
|
|
|
bus = dev_get_drvdata(&pdev->dev);
|
|
|
|
mdiobus_unregister(bus->mii_bus);
|
|
mdiobus_free(bus->mii_bus);
|
|
smi_en.u64 = 0;
|
|
cvmx_write_csr(CVMX_SMIX_EN(bus->unit), smi_en.u64);
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver octeon_mdiobus_driver = {
|
|
.driver = {
|
|
.name = "mdio-octeon",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = octeon_mdiobus_probe,
|
|
.remove = __exit_p(octeon_mdiobus_remove),
|
|
};
|
|
|
|
void octeon_mdiobus_force_mod_depencency(void)
|
|
{
|
|
/* Let ethernet drivers force us to be loaded. */
|
|
}
|
|
EXPORT_SYMBOL(octeon_mdiobus_force_mod_depencency);
|
|
|
|
static int __init octeon_mdiobus_mod_init(void)
|
|
{
|
|
return platform_driver_register(&octeon_mdiobus_driver);
|
|
}
|
|
|
|
static void __exit octeon_mdiobus_mod_exit(void)
|
|
{
|
|
platform_driver_unregister(&octeon_mdiobus_driver);
|
|
}
|
|
|
|
module_init(octeon_mdiobus_mod_init);
|
|
module_exit(octeon_mdiobus_mod_exit);
|
|
|
|
MODULE_DESCRIPTION(DRV_DESCRIPTION);
|
|
MODULE_VERSION(DRV_VERSION);
|
|
MODULE_AUTHOR("David Daney");
|
|
MODULE_LICENSE("GPL");
|