drivers/net/phy/phy-core.c

   1 /*
   2  * Core PHY library, taken from phy.c
   3  *
   4  * This program is free software; you can redistribute  it and/or modify it
   5  * under  the terms of  the GNU General  Public License as published by the
   6  * Free Software Foundation;  either version 2 of the  License, or (at your
   7  * option) any later version.
   8  */
   9 #include <linux/export.h>
  10 #include <linux/phy.h>
  11
  12 static void mmd_phy_indirect(struct mii_bus *bus, int phy_addr, int devad,
  13                              u16 regnum)
  14 {
  15         /* Write the desired MMD Devad */
  16         bus->write(bus, phy_addr, MII_MMD_CTRL, devad);
  17
  18         /* Write the desired MMD register address */
  19         bus->write(bus, phy_addr, MII_MMD_DATA, regnum);
  20
  21         /* Select the Function : DATA with no post increment */
  22         bus->write(bus, phy_addr, MII_MMD_CTRL, devad | MII_MMD_CTRL_NOINCR);
  23 }
  24
  25 /**
  26  * phy_read_mmd - Convenience function for reading a register
  27  * from an MMD on a given PHY.
  28  * @phydev: The phy_device struct
  29  * @devad: The MMD to read from (0..31)
  30  * @regnum: The register on the MMD to read (0..65535)
  31  *
  32  * Same rules as for phy_read();
  33  */
  34 int phy_read_mmd(struct phy_device *phydev, int devad, u32 regnum)
  35 {
  36         int val;
  37
  38         if (regnum > (u16)~0 || devad > 32)
  39                 return -EINVAL;
  40
  41         if (phydev->drv->read_mmd) {
  42                 val = phydev->drv->read_mmd(phydev, devad, regnum);
  43         } else if (phydev->is_c45) {
  44                 u32 addr = MII_ADDR_C45 | (devad << 16) | (regnum & 0xffff);
  45
  46                 val = mdiobus_read(phydev->mdio.bus, phydev->mdio.addr, addr);
  47         } else {
  48                 struct mii_bus *bus = phydev->mdio.bus;
  49                 int phy_addr = phydev->mdio.addr;
  50
  51                 mutex_lock(&bus->mdio_lock);
  52                 mmd_phy_indirect(bus, phy_addr, devad, regnum);
  53
  54                 /* Read the content of the MMD's selected register */
  55                 val = bus->read(bus, phy_addr, MII_MMD_DATA);
  56                 mutex_unlock(&bus->mdio_lock);
  57         }
  58         return val;
  59 }
  60 EXPORT_SYMBOL(phy_read_mmd);
  61
  62 /**
  63  * phy_write_mmd - Convenience function for writing a register
  64  * on an MMD on a given PHY.
  65  * @phydev: The phy_device struct
  66  * @devad: The MMD to read from
  67  * @regnum: The register on the MMD to read
  68  * @val: value to write to @regnum
  69  *
  70  * Same rules as for phy_write();
  71  */
  72 int phy_write_mmd(struct phy_device *phydev, int devad, u32 regnum, u16 val)
  73 {
  74         int ret;
  75
  76         if (regnum > (u16)~0 || devad > 32)
  77                 return -EINVAL;
  78
  79         if (phydev->drv->read_mmd) {
  80                 ret = phydev->drv->write_mmd(phydev, devad, regnum, val);
  81         } else if (phydev->is_c45) {
  82                 u32 addr = MII_ADDR_C45 | (devad << 16) | (regnum & 0xffff);
  83
  84                 ret = mdiobus_write(phydev->mdio.bus, phydev->mdio.addr,
  85                                     addr, val);
  86         } else {
  87                 struct mii_bus *bus = phydev->mdio.bus;
  88                 int phy_addr = phydev->mdio.addr;
  89
  90                 mutex_lock(&bus->mdio_lock);
  91                 mmd_phy_indirect(bus, phy_addr, devad, regnum);
  92
  93                 /* Write the data into MMD's selected register */
  94                 bus->write(bus, phy_addr, MII_MMD_DATA, val);
  95                 mutex_unlock(&bus->mdio_lock);
  96
  97                 ret = 0;
  98         }
  99         return ret;
 100 }
 101 EXPORT_SYMBOL(phy_write_mmd);