net/phy/xilinx_gmii2rgmii.c

0001 // SPDX-License-Identifier: GPL-2.0+
0002 /* Xilinx GMII2RGMII Converter driver
0003  *
0004  * Copyright (C) 2016 Xilinx, Inc.
0005  * Copyright (C) 2016 Andrew Lunn <andrew@lunn.ch>
0006  *
0007  * Author: Andrew Lunn <andrew@lunn.ch>
0008  * Author: Kedareswara rao Appana <appanad@xilinx.com>
0009  *
0010  * Description:
0011  * This driver is developed for Xilinx GMII2RGMII Converter
0012  */
0013 #include <linux/module.h>
0014 #include <linux/kernel.h>
0015 #include <linux/mii.h>
0016 #include <linux/mdio.h>
0017 #include <linux/phy.h>
0018 #include <linux/of_mdio.h>
0019
0020 #define XILINX_GMII2RGMII_REG       0x10
0021 #define XILINX_GMII2RGMII_SPEED_MASK    (BMCR_SPEED1000 | BMCR_SPEED100)
0022
0023 struct gmii2rgmii {
0024     struct phy_device *phy_dev;
0025     struct phy_driver *phy_drv;
0026     struct phy_driver conv_phy_drv;
0027     struct mdio_device *mdio;
0028 };
0029
0030 static void xgmiitorgmii_configure(struct gmii2rgmii *priv, int speed)
0031 {
0032     struct mii_bus *bus = priv->mdio->bus;
0033     int addr = priv->mdio->addr;
0034     u16 val;
0035
0036     val = mdiobus_read(bus, addr, XILINX_GMII2RGMII_REG);
0037     val &= ~XILINX_GMII2RGMII_SPEED_MASK;
0038
0039     if (speed == SPEED_1000)
0040         val |= BMCR_SPEED1000;
0041     else if (speed == SPEED_100)
0042         val |= BMCR_SPEED100;
0043     else
0044         val |= BMCR_SPEED10;
0045
0046     mdiobus_write(bus, addr, XILINX_GMII2RGMII_REG, val);
0047 }
0048
0049 static int xgmiitorgmii_read_status(struct phy_device *phydev)
0050 {
0051     struct gmii2rgmii *priv = mdiodev_get_drvdata(&phydev->mdio);
0052     int err;
0053
0054     if (priv->phy_drv->read_status)
0055         err = priv->phy_drv->read_status(phydev);
0056     else
0057         err = genphy_read_status(phydev);
0058     if (err < 0)
0059         return err;
0060
0061     xgmiitorgmii_configure(priv, phydev->speed);
0062
0063     return 0;
0064 }
0065
0066 static int xgmiitorgmii_set_loopback(struct phy_device *phydev, bool enable)
0067 {
0068     struct gmii2rgmii *priv = mdiodev_get_drvdata(&phydev->mdio);
0069     int err;
0070
0071     if (priv->phy_drv->set_loopback)
0072         err = priv->phy_drv->set_loopback(phydev, enable);
0073     else
0074         err = genphy_loopback(phydev, enable);
0075     if (err < 0)
0076         return err;
0077
0078     xgmiitorgmii_configure(priv, phydev->speed);
0079
0080     return 0;
0081 }
0082
0083 static int xgmiitorgmii_probe(struct mdio_device *mdiodev)
0084 {
0085     struct device *dev = &mdiodev->dev;
0086     struct device_node *np = dev->of_node, *phy_node;
0087     struct gmii2rgmii *priv;
0088
0089     priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
0090     if (!priv)
0091         return -ENOMEM;
0092
0093     phy_node = of_parse_phandle(np, "phy-handle", 0);
0094     if (!phy_node) {
0095         dev_err(dev, "Couldn't parse phy-handle\n");
0096         return -ENODEV;
0097     }
0098
0099     priv->phy_dev = of_phy_find_device(phy_node);
0100     of_node_put(phy_node);
0101     if (!priv->phy_dev) {
0102         dev_info(dev, "Couldn't find phydev\n");
0103         return -EPROBE_DEFER;
0104     }
0105
0106     if (!priv->phy_dev->drv) {
0107         dev_info(dev, "Attached phy not ready\n");
0108         return -EPROBE_DEFER;
0109     }
0110
0111     priv->mdio = mdiodev;
0112     priv->phy_drv = priv->phy_dev->drv;
0113     memcpy(&priv->conv_phy_drv, priv->phy_dev->drv,
0114            sizeof(struct phy_driver));
0115     priv->conv_phy_drv.read_status = xgmiitorgmii_read_status;
0116     priv->conv_phy_drv.set_loopback = xgmiitorgmii_set_loopback;
0117     mdiodev_set_drvdata(&priv->phy_dev->mdio, priv);
0118     priv->phy_dev->drv = &priv->conv_phy_drv;
0119
0120     return 0;
0121 }
0122
0123 static const struct of_device_id xgmiitorgmii_of_match[] = {
0124     { .compatible = "xlnx,gmii-to-rgmii-1.0" },
0125     {},
0126 };
0127 MODULE_DEVICE_TABLE(of, xgmiitorgmii_of_match);
0128
0129 static struct mdio_driver xgmiitorgmii_driver = {
0130     .probe  = xgmiitorgmii_probe,
0131     .mdiodrv.driver = {
0132         .name = "xgmiitorgmii",
0133         .of_match_table = xgmiitorgmii_of_match,
0134     },
0135 };
0136
0137 mdio_module_driver(xgmiitorgmii_driver);
0138
0139 MODULE_DESCRIPTION("Xilinx GMII2RGMII converter driver");
0140 MODULE_LICENSE("GPL");