LXR linux/drivers/net/phy/mdio-i2c.c

   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * MDIO I2C bridge
   4 *
   5 * Copyright (C) 2015-2016 Russell King
   6 *
   7 * Network PHYs can appear on I2C buses when they are part of SFP module.
   8 * This driver exposes these PHYs to the networking PHY code, allowing
   9 * our PHY drivers access to these PHYs, and so allowing configuration
  10 * of their settings.
  11 */
  12#include <linux/i2c.h>
  13#include <linux/phy.h>
  14
  15#include "mdio-i2c.h"
  16
  17/*
  18 * I2C bus addresses 0x50 and 0x51 are normally an EEPROM, which is
  19 * specified to be present in SFP modules.  These correspond with PHY
  20 * addresses 16 and 17.  Disallow access to these "phy" addresses.
  21 */
  22static bool i2c_mii_valid_phy_id(int phy_id)
  23{
  24        return phy_id != 0x10 && phy_id != 0x11;
  25}
  26
  27static unsigned int i2c_mii_phy_addr(int phy_id)
  28{
  29        return phy_id + 0x40;
  30}
  31
  32static int i2c_mii_read(struct mii_bus *bus, int phy_id, int reg)
  33{
  34        struct i2c_adapter *i2c = bus->priv;
  35        struct i2c_msg msgs[2];
  36        u8 data[2], dev_addr = reg;
  37        int bus_addr, ret;
  38
  39        if (!i2c_mii_valid_phy_id(phy_id))
  40                return 0xffff;
  41
  42        bus_addr = i2c_mii_phy_addr(phy_id);
  43        msgs[0].addr = bus_addr;
  44        msgs[0].flags = 0;
  45        msgs[0].len = 1;
  46        msgs[0].buf = &dev_addr;
  47        msgs[1].addr = bus_addr;
  48        msgs[1].flags = I2C_M_RD;
  49        msgs[1].len = sizeof(data);
  50        msgs[1].buf = data;
  51
  52        ret = i2c_transfer(i2c, msgs, ARRAY_SIZE(msgs));
  53        if (ret != ARRAY_SIZE(msgs))
  54                return 0xffff;
  55
  56        return data[0] << 8 | data[1];
  57}
  58
  59static int i2c_mii_write(struct mii_bus *bus, int phy_id, int reg, u16 val)
  60{
  61        struct i2c_adapter *i2c = bus->priv;
  62        struct i2c_msg msg;
  63        int ret;
  64        u8 data[3];
  65
  66        if (!i2c_mii_valid_phy_id(phy_id))
  67                return 0;
  68
  69        data[0] = reg;
  70        data[1] = val >> 8;
  71        data[2] = val;
  72
  73        msg.addr = i2c_mii_phy_addr(phy_id);
  74        msg.flags = 0;
  75        msg.len = 3;
  76        msg.buf = data;
  77
  78        ret = i2c_transfer(i2c, &msg, 1);
  79
  80        return ret < 0 ? ret : 0;
  81}
  82
  83struct mii_bus *mdio_i2c_alloc(struct device *parent, struct i2c_adapter *i2c)
  84{
  85        struct mii_bus *mii;
  86
  87        if (!i2c_check_functionality(i2c, I2C_FUNC_I2C))
  88                return ERR_PTR(-EINVAL);
  89
  90        mii = mdiobus_alloc();
  91        if (!mii)
  92                return ERR_PTR(-ENOMEM);
  93
  94        snprintf(mii->id, MII_BUS_ID_SIZE, "i2c:%s", dev_name(parent));
  95        mii->parent = parent;
  96        mii->read = i2c_mii_read;
  97        mii->write = i2c_mii_write;
  98        mii->priv = i2c;
  99
 100        return mii;
 101}
 102EXPORT_SYMBOL_GPL(mdio_i2c_alloc);
 103
 104MODULE_AUTHOR("Russell King");
 105MODULE_DESCRIPTION("MDIO I2C bridge library");
 106MODULE_LICENSE("GPL v2");
 107