kernel/drivers/net/ethernet/arc/emac_mdio.c

   1 /*
   2  * Copyright (C) 2004-2013 Synopsys, Inc. (www.synopsys.com)
   3  *
   4  * MDIO implementation for ARC EMAC
   5  */
   6
   7 #include <linux/delay.h>
   8 #include <linux/of_mdio.h>
   9 #include <linux/platform_device.h>
  10
  11 #include "emac.h"
  12
  13 /* Number of seconds we wait for "MDIO complete" flag to appear */
  14 #define ARC_MDIO_COMPLETE_POLL_COUNT    1
  15
  16 /**
  17  * arc_mdio_complete_wait - Waits until MDIO transaction is completed.
  18  * @priv:       Pointer to ARC EMAC private data structure.
  19  *
  20  * returns:     0 on success, -ETIMEDOUT on a timeout.
  21  */
  22 static int arc_mdio_complete_wait(struct arc_emac_priv *priv)
  23 {
  24         unsigned int i;
  25
  26         for (i = 0; i < ARC_MDIO_COMPLETE_POLL_COUNT * 40; i++) {
  27                 unsigned int status = arc_reg_get(priv, R_STATUS);
  28
  29                 status &= MDIO_MASK;
  30
  31                 if (status) {
  32                         /* Reset "MDIO complete" flag */
  33                         arc_reg_set(priv, R_STATUS, status);
  34                         return 0;
  35                 }
  36
  37                 msleep(25);
  38         }
  39
  40         return -ETIMEDOUT;
  41 }
  42
  43 /**
  44  * arc_mdio_read - MDIO interface read function.
  45  * @bus:        Pointer to MII bus structure.
  46  * @phy_addr:   Address of the PHY device.
  47  * @reg_num:    PHY register to read.
  48  *
  49  * returns:     The register contents on success, -ETIMEDOUT on a timeout.
  50  *
  51  * Reads the contents of the requested register from the requested PHY
  52  * address.
  53  */
  54 static int arc_mdio_read(struct mii_bus *bus, int phy_addr, int reg_num)
  55 {
  56         struct arc_emac_priv *priv = bus->priv;
  57         unsigned int value;
  58         int error;
  59
  60         arc_reg_set(priv, R_MDIO,
  61                     0x60020000 | (phy_addr << 23) | (reg_num << 18));
  62
  63         error = arc_mdio_complete_wait(priv);
  64         if (error < 0)
  65                 return error;
  66
  67         value = arc_reg_get(priv, R_MDIO) & 0xffff;
  68
  69         dev_dbg(priv->dev, "arc_mdio_read(phy_addr=%i, reg_num=%x) = %x\n",
  70                 phy_addr, reg_num, value);
  71
  72         return value;
  73 }
  74
  75 /**
  76  * arc_mdio_write - MDIO interface write function.
  77  * @bus:        Pointer to MII bus structure.
  78  * @phy_addr:   Address of the PHY device.
  79  * @reg_num:    PHY register to write to.
  80  * @value:      Value to be written into the register.
  81  *
  82  * returns:     0 on success, -ETIMEDOUT on a timeout.
  83  *
  84  * Writes the value to the requested register.
  85  */
  86 static int arc_mdio_write(struct mii_bus *bus, int phy_addr,
  87                           int reg_num, u16 value)
  88 {
  89         struct arc_emac_priv *priv = bus->priv;
  90
  91         dev_dbg(priv->dev,
  92                 "arc_mdio_write(phy_addr=%i, reg_num=%x, value=%x)\n",
  93                 phy_addr, reg_num, value);
  94
  95         arc_reg_set(priv, R_MDIO,
  96                      0x50020000 | (phy_addr << 23) | (reg_num << 18) | value);
  97
  98         return arc_mdio_complete_wait(priv);
  99 }
 100
 101 /**
 102  * arc_mdio_probe - MDIO probe function.
 103  * @priv:       Pointer to ARC EMAC private data structure.
 104  *
 105  * returns:     0 on success, -ENOMEM when mdiobus_alloc
 106  * (to allocate memory for MII bus structure) fails.
 107  *
 108  * Sets up and registers the MDIO interface.
 109  */
 110 int arc_mdio_probe(struct arc_emac_priv *priv)
 111 {
 112         struct mii_bus *bus;
 113         int error;
 114
 115         bus = mdiobus_alloc();
 116         if (!bus)
 117                 return -ENOMEM;
 118
 119         priv->bus = bus;
 120         bus->priv = priv;
 121         bus->parent = priv->dev;
 122         bus->name = "Synopsys MII Bus",
 123         bus->read = &arc_mdio_read;
 124         bus->write = &arc_mdio_write;
 125
 126         snprintf(bus->id, MII_BUS_ID_SIZE, "%s", bus->name);
 127
 128         error = of_mdiobus_register(bus, priv->dev->of_node);
 129         if (error) {
 130                 dev_err(priv->dev, "cannot register MDIO bus %s\n", bus->name);
 131                 mdiobus_free(bus);
 132                 return error;
 133         }
 134
 135         return 0;
 136 }
 137
 138 /**
 139  * arc_mdio_remove - MDIO remove function.
 140  * @priv:       Pointer to ARC EMAC private data structure.
 141  *
 142  * Unregisters the MDIO and frees any associate memory for MII bus.
 143  */
 144 int arc_mdio_remove(struct arc_emac_priv *priv)
 145 {
 146         mdiobus_unregister(priv->bus);
 147         mdiobus_free(priv->bus);
 148         priv->bus = NULL;
 149
 150         return 0;
 151 }