Add support for handling the TJA11xx PHY IRQ signal.

Signed-off-by: Marek Vasut <[email protected]>
Cc: Andrew Lunn <[email protected]>
Cc: Florian Fainelli <[email protected]>
Cc: Guenter Roeck <[email protected]>
Cc: Heiner Kallweit <[email protected]>
Cc: Jean Delvare <[email protected]>
Cc: [email protected]
---
 drivers/net/phy/nxp-tja11xx.c | 32 ++++++++++++++++++++++++++++++++
 1 file changed, 32 insertions(+)

diff --git a/drivers/net/phy/nxp-tja11xx.c b/drivers/net/phy/nxp-tja11xx.c
index b705d0bd798b..0be9fe9a9604 100644
--- a/drivers/net/phy/nxp-tja11xx.c
+++ b/drivers/net/phy/nxp-tja11xx.c
@@ -40,6 +40,8 @@
 #define MII_INTSRC_TEMP_ERR            BIT(1)
 #define MII_INTSRC_UV_ERR              BIT(3)
 
+#define MII_INTEN                      22
+
 #define MII_COMMSTAT                   23
 #define MII_COMMSTAT_LINK_UP           BIT(15)
 
@@ -239,6 +241,30 @@ static int tja11xx_read_status(struct phy_device *phydev)
        return 0;
 }
 
+static int tja11xx_config_intr(struct phy_device *phydev)
+{
+       int ret;
+
+       if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
+               ret = phy_write(phydev, MII_INTEN, 0xcfef);
+       else
+               ret = phy_write(phydev, MII_INTEN, 0);
+
+       if (ret < 0)
+               return ret;
+
+       ret = phy_read(phydev, MII_INTSRC);
+
+       return ret < 0 ? ret : 0;
+}
+
+static int tja11xx_ack_interrupt(struct phy_device *phydev)
+{
+       int ret = phy_read(phydev, MII_INTSRC);
+
+       return ret < 0 ? ret : 0;
+}
+
 static int tja11xx_get_sset_count(struct phy_device *phydev)
 {
        return ARRAY_SIZE(tja11xx_hw_stats);
@@ -366,6 +392,9 @@ static struct phy_driver tja11xx_driver[] = {
                .suspend        = genphy_suspend,
                .resume         = genphy_resume,
                .set_loopback   = genphy_loopback,
+               /* IRQ related */
+               .config_intr    = tja11xx_config_intr,
+               .ack_interrupt  = tja11xx_ack_interrupt,
                /* Statistics */
                .get_sset_count = tja11xx_get_sset_count,
                .get_strings    = tja11xx_get_strings,
@@ -381,6 +410,9 @@ static struct phy_driver tja11xx_driver[] = {
                .suspend        = genphy_suspend,
                .resume         = genphy_resume,
                .set_loopback   = genphy_loopback,
+               /* IRQ related */
+               .config_intr    = tja11xx_config_intr,
+               .ack_interrupt  = tja11xx_ack_interrupt,
                /* Statistics */
                .get_sset_count = tja11xx_get_sset_count,
                .get_strings    = tja11xx_get_strings,
-- 
2.20.1

Reply via email to