target/linux/ar71xx/files/drivers/net/ethernet/atheros/ag71xx/ag71xx_mdio.c

   1 /*
   2  *  Atheros AR71xx built-in ethernet mac driver
   3  *
   4  *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>
   5  *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
   6  *
   7  *  Based on Atheros' AG7100 driver
   8  *
   9  *  This program is free software; you can redistribute it and/or modify it
  10  *  under the terms of the GNU General Public License version 2 as published
  11  *  by the Free Software Foundation.
  12  */
  13
  14 #include "ag71xx.h"
  15
  16 #define AG71XX_MDIO_RETRY       1000
  17 #define AG71XX_MDIO_DELAY       5
  18
  19 static inline void ag71xx_mdio_wr(struct ag71xx_mdio *am, unsigned reg,
  20                                   u32 value)
  21 {
  22         void __iomem *r;
  23
  24         r = am->mdio_base + reg;
  25         __raw_writel(value, r);
  26
  27         /* flush write */
  28         (void) __raw_readl(r);
  29 }
  30
  31 static inline u32 ag71xx_mdio_rr(struct ag71xx_mdio *am, unsigned reg)
  32 {
  33         return __raw_readl(am->mdio_base + reg);
  34 }
  35
  36 static void ag71xx_mdio_dump_regs(struct ag71xx_mdio *am)
  37 {
  38         DBG("%s: mii_cfg=%08x, mii_cmd=%08x, mii_addr=%08x\n",
  39                 am->mii_bus->name,
  40                 ag71xx_mdio_rr(am, AG71XX_REG_MII_CFG),
  41                 ag71xx_mdio_rr(am, AG71XX_REG_MII_CMD),
  42                 ag71xx_mdio_rr(am, AG71XX_REG_MII_ADDR));
  43         DBG("%s: mii_ctrl=%08x, mii_status=%08x, mii_ind=%08x\n",
  44                 am->mii_bus->name,
  45                 ag71xx_mdio_rr(am, AG71XX_REG_MII_CTRL),
  46                 ag71xx_mdio_rr(am, AG71XX_REG_MII_STATUS),
  47                 ag71xx_mdio_rr(am, AG71XX_REG_MII_IND));
  48 }
  49
  50 int ag71xx_mdio_mii_read(struct ag71xx_mdio *am, int addr, int reg)
  51 {
  52         int ret;
  53         int i;
  54
  55         ag71xx_mdio_wr(am, AG71XX_REG_MII_CMD, MII_CMD_WRITE);
  56         ag71xx_mdio_wr(am, AG71XX_REG_MII_ADDR,
  57                         ((addr & 0xff) << MII_ADDR_SHIFT) | (reg & 0xff));
  58         ag71xx_mdio_wr(am, AG71XX_REG_MII_CMD, MII_CMD_READ);
  59
  60         i = AG71XX_MDIO_RETRY;
  61         while (ag71xx_mdio_rr(am, AG71XX_REG_MII_IND) & MII_IND_BUSY) {
  62                 if (i-- == 0) {
  63                         pr_err("%s: mii_read timed out\n", am->mii_bus->name);
  64                         ret = 0xffff;
  65                         goto out;
  66                 }
  67                 udelay(AG71XX_MDIO_DELAY);
  68         }
  69
  70         ret = ag71xx_mdio_rr(am, AG71XX_REG_MII_STATUS) & 0xffff;
  71         ag71xx_mdio_wr(am, AG71XX_REG_MII_CMD, MII_CMD_WRITE);
  72
  73         DBG("mii_read: addr=%04x, reg=%04x, value=%04x\n", addr, reg, ret);
  74
  75 out:
  76         return ret;
  77 }
  78
  79 void ag71xx_mdio_mii_write(struct ag71xx_mdio *am, int addr, int reg, u16 val)
  80 {
  81         int i;
  82
  83         DBG("mii_write: addr=%04x, reg=%04x, value=%04x\n", addr, reg, val);
  84
  85         ag71xx_mdio_wr(am, AG71XX_REG_MII_ADDR,
  86                         ((addr & 0xff) << MII_ADDR_SHIFT) | (reg & 0xff));
  87         ag71xx_mdio_wr(am, AG71XX_REG_MII_CTRL, val);
  88
  89         i = AG71XX_MDIO_RETRY;
  90         while (ag71xx_mdio_rr(am, AG71XX_REG_MII_IND) & MII_IND_BUSY) {
  91                 if (i-- == 0) {
  92                         pr_err("%s: mii_write timed out\n", am->mii_bus->name);
  93                         break;
  94                 }
  95                 udelay(AG71XX_MDIO_DELAY);
  96         }
  97 }
  98
  99 static int ag71xx_mdio_reset(struct mii_bus *bus)
 100 {
 101         struct ag71xx_mdio *am = bus->priv;
 102         u32 t;
 103
 104         if (am->pdata->is_ar7240)
 105                 t = MII_CFG_CLK_DIV_6;
 106         else if (am->pdata->is_ar9330)
 107                 t = MII_CFG_CLK_DIV_98;
 108         else if (am->pdata->builtin_switch && !am->pdata->is_ar934x)
 109                 t = MII_CFG_CLK_DIV_10;
 110         else if (!am->pdata->builtin_switch && am->pdata->is_ar934x)
 111                 t = MII_CFG_CLK_DIV_58;
 112         else
 113                 t = MII_CFG_CLK_DIV_28;
 114
 115         ag71xx_mdio_wr(am, AG71XX_REG_MII_CFG, t | MII_CFG_RESET);
 116         udelay(100);
 117
 118         ag71xx_mdio_wr(am, AG71XX_REG_MII_CFG, t);
 119         udelay(100);
 120
 121         return 0;
 122 }
 123
 124 static int ag71xx_mdio_read(struct mii_bus *bus, int addr, int reg)
 125 {
 126         struct ag71xx_mdio *am = bus->priv;
 127
 128         if (am->pdata->builtin_switch)
 129                 return ar7240sw_phy_read(bus, addr, reg);
 130         else
 131                 return ag71xx_mdio_mii_read(am, addr, reg);
 132 }
 133
 134 static int ag71xx_mdio_write(struct mii_bus *bus, int addr, int reg, u16 val)
 135 {
 136         struct ag71xx_mdio *am = bus->priv;
 137
 138         if (am->pdata->builtin_switch)
 139                 ar7240sw_phy_write(bus, addr, reg, val);
 140         else
 141                 ag71xx_mdio_mii_write(am, addr, reg, val);
 142         return 0;
 143 }
 144
 145 static int __devinit ag71xx_mdio_probe(struct platform_device *pdev)
 146 {
 147         struct ag71xx_mdio_platform_data *pdata;
 148         struct ag71xx_mdio *am;
 149         struct resource *res;
 150         int i;
 151         int err;
 152
 153         pdata = pdev->dev.platform_data;
 154         if (!pdata) {
 155                 dev_err(&pdev->dev, "no platform data specified\n");
 156                 return -EINVAL;
 157         }
 158
 159         am = kzalloc(sizeof(*am), GFP_KERNEL);
 160         if (!am) {
 161                 err = -ENOMEM;
 162                 goto err_out;
 163         }
 164
 165         am->pdata = pdata;
 166
 167         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 168         if (!res) {
 169                 dev_err(&pdev->dev, "no iomem resource found\n");
 170                 err = -ENXIO;
 171                 goto err_out;
 172         }
 173
 174         am->mdio_base = ioremap_nocache(res->start, res->end - res->start + 1);
 175         if (!am->mdio_base) {
 176                 dev_err(&pdev->dev, "unable to ioremap registers\n");
 177                 err = -ENOMEM;
 178                 goto err_free_mdio;
 179         }
 180
 181         am->mii_bus = mdiobus_alloc();
 182         if (am->mii_bus == NULL) {
 183                 err = -ENOMEM;
 184                 goto err_iounmap;
 185         }
 186
 187         am->mii_bus->name = "ag71xx_mdio";
 188         am->mii_bus->read = ag71xx_mdio_read;
 189         am->mii_bus->write = ag71xx_mdio_write;
 190         am->mii_bus->reset = ag71xx_mdio_reset;
 191         am->mii_bus->irq = am->mii_irq;
 192         am->mii_bus->priv = am;
 193         am->mii_bus->parent = &pdev->dev;
 194         snprintf(am->mii_bus->id, MII_BUS_ID_SIZE, "%s", dev_name(&pdev->dev));
 195         am->mii_bus->phy_mask = pdata->phy_mask;
 196
 197         for (i = 0; i < PHY_MAX_ADDR; i++)
 198                 am->mii_irq[i] = PHY_POLL;
 199
 200         ag71xx_mdio_wr(am, AG71XX_REG_MAC_CFG1, 0);
 201
 202         err = mdiobus_register(am->mii_bus);
 203         if (err)
 204                 goto err_free_bus;
 205
 206         ag71xx_mdio_dump_regs(am);
 207
 208         platform_set_drvdata(pdev, am);
 209         return 0;
 210
 211 err_free_bus:
 212         mdiobus_free(am->mii_bus);
 213 err_iounmap:
 214         iounmap(am->mdio_base);
 215 err_free_mdio:
 216         kfree(am);
 217 err_out:
 218         return err;
 219 }
 220
 221 static int __devexit ag71xx_mdio_remove(struct platform_device *pdev)
 222 {
 223         struct ag71xx_mdio *am = platform_get_drvdata(pdev);
 224
 225         if (am) {
 226                 mdiobus_unregister(am->mii_bus);
 227                 mdiobus_free(am->mii_bus);
 228                 iounmap(am->mdio_base);
 229                 kfree(am);
 230                 platform_set_drvdata(pdev, NULL);
 231         }
 232
 233         return 0;
 234 }
 235
 236 static struct platform_driver ag71xx_mdio_driver = {
 237         .probe          = ag71xx_mdio_probe,
 238         .remove         = __exit_p(ag71xx_mdio_remove),
 239         .driver = {
 240                 .name   = "ag71xx-mdio",
 241         }
 242 };
 243
 244 int __init ag71xx_mdio_driver_init(void)
 245 {
 246         return platform_driver_register(&ag71xx_mdio_driver);
 247 }
 248
 249 void ag71xx_mdio_driver_exit(void)
 250 {
 251         platform_driver_unregister(&ag71xx_mdio_driver);
 252 }