Commit 06254738 authored by Jakub Kicinski's avatar Jakub Kicinski

Merge branch 'net-phy-add-support-for-shared-interrupts-part-3'

Ioana Ciornei says:

====================
net: phy: add support for shared interrupts (part 3)

This patch set aims to actually add support for shared interrupts in
phylib and not only for multi-PHY devices. While we are at it,
streamline the interrupt handling in phylib.

For a bit of context, at the moment, there are multiple phy_driver ops
that deal with this subject:

- .config_intr() - Enable/disable the interrupt line.

- .ack_interrupt() - Should quiesce any interrupts that may have been
  fired.  It's also used by phylib in conjunction with .config_intr() to
  clear any pending interrupts after the line was disabled, and before
  it is going to be enabled.

- .did_interrupt() - Intended for multi-PHY devices with a shared IRQ
  line and used by phylib to discern which PHY from the package was the
  one that actually fired the interrupt.

- .handle_interrupt() - Completely overrides the default interrupt
  handling logic from phylib. The PHY driver is responsible for checking
  if any interrupt was fired by the respective PHY and choose
  accordingly if it's the one that should trigger the link state machine.

From my point of view, the interrupt handling in phylib has become
somewhat confusing with all these callbacks that actually read the same
PHY register - the interrupt status.  A more streamlined approach would
be to just move the responsibility to write an interrupt handler to the
driver (as any other device driver does) and make .handle_interrupt()
the only way to deal with interrupts.

Another advantage with this approach would be that phylib would gain
support for shared IRQs between different PHY (not just multi-PHY
devices), something which at the moment would require extending every
PHY driver anyway in order to implement their .did_interrupt() callback
and duplicate the same logic as in .ack_interrupt(). The disadvantage
of making .did_interrupt() mandatory would be that we are slightly
changing the semantics of the phylib API and that would increase
confusion instead of reducing it.

What I am proposing is the following:

- As a first step, make the .ack_interrupt() callback optional so that
  we do not break any PHY driver amid the transition.

- Every PHY driver gains a .handle_interrupt() implementation that, for
  the most part, would look like below:

	irq_status = phy_read(phydev, INTR_STATUS);
	if (irq_status < 0) {
		phy_error(phydev);
		return IRQ_NONE;
	}

	if (!(irq_status & irq_mask))
		return IRQ_NONE;

	phy_trigger_machine(phydev);

	return IRQ_HANDLED;

- Remove each PHY driver's implementation of the .ack_interrupt() by
  actually taking care of quiescing any pending interrupts before
  enabling/after disabling the interrupt line.

- Finally, after all drivers have been ported, remove the
  .ack_interrupt() and .did_interrupt() callbacks from phy_driver.

This patch set is part 3 (and final) of the entire change set and it
addresses the remaining PHY drivers that have not been migrated
previosly. Also, it finally removed the .did_interrupt() and
.ack_interrupt() callbacks since they are of no use anymore.

I do not have access to most of these PHY's, therefore I Cc-ed the
latest contributors to the individual PHY drivers in order to have
access, hopefully, to more regression testing.
====================

Link: https://lore.kernel.org/r/20201123153817.1616814-1-ciorneiioana@gmail.comSigned-off-by: default avatarJakub Kicinski <kuba@kernel.org>
parents 470dfd80 6527b938
...@@ -50,6 +50,14 @@ ...@@ -50,6 +50,14 @@
#define MII_DP83640_MISR_LINK_INT_EN 0x20 #define MII_DP83640_MISR_LINK_INT_EN 0x20
#define MII_DP83640_MISR_ED_INT_EN 0x40 #define MII_DP83640_MISR_ED_INT_EN 0x40
#define MII_DP83640_MISR_LQ_INT_EN 0x80 #define MII_DP83640_MISR_LQ_INT_EN 0x80
#define MII_DP83640_MISR_ANC_INT 0x400
#define MII_DP83640_MISR_DUP_INT 0x800
#define MII_DP83640_MISR_SPD_INT 0x1000
#define MII_DP83640_MISR_LINK_INT 0x2000
#define MII_DP83640_MISR_INT_MASK (MII_DP83640_MISR_ANC_INT |\
MII_DP83640_MISR_DUP_INT |\
MII_DP83640_MISR_SPD_INT |\
MII_DP83640_MISR_LINK_INT)
/* phyter seems to miss the mark by 16 ns */ /* phyter seems to miss the mark by 16 ns */
#define ADJTIME_FIX 16 #define ADJTIME_FIX 16
...@@ -1151,6 +1159,10 @@ static int dp83640_config_intr(struct phy_device *phydev) ...@@ -1151,6 +1159,10 @@ static int dp83640_config_intr(struct phy_device *phydev)
int err; int err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
err = dp83640_ack_interrupt(phydev);
if (err)
return err;
misr = phy_read(phydev, MII_DP83640_MISR); misr = phy_read(phydev, MII_DP83640_MISR);
if (misr < 0) if (misr < 0)
return misr; return misr;
...@@ -1189,10 +1201,32 @@ static int dp83640_config_intr(struct phy_device *phydev) ...@@ -1189,10 +1201,32 @@ static int dp83640_config_intr(struct phy_device *phydev)
MII_DP83640_MISR_DUP_INT_EN | MII_DP83640_MISR_DUP_INT_EN |
MII_DP83640_MISR_SPD_INT_EN | MII_DP83640_MISR_SPD_INT_EN |
MII_DP83640_MISR_LINK_INT_EN); MII_DP83640_MISR_LINK_INT_EN);
return phy_write(phydev, MII_DP83640_MISR, misr); err = phy_write(phydev, MII_DP83640_MISR, misr);
if (err)
return err;
return dp83640_ack_interrupt(phydev);
} }
} }
static irqreturn_t dp83640_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
irq_status = phy_read(phydev, MII_DP83640_MISR);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (!(irq_status & MII_DP83640_MISR_INT_MASK))
return IRQ_NONE;
phy_trigger_machine(phydev);
return IRQ_HANDLED;
}
static int dp83640_hwtstamp(struct mii_timestamper *mii_ts, struct ifreq *ifr) static int dp83640_hwtstamp(struct mii_timestamper *mii_ts, struct ifreq *ifr)
{ {
struct dp83640_private *dp83640 = struct dp83640_private *dp83640 =
...@@ -1515,8 +1549,8 @@ static struct phy_driver dp83640_driver = { ...@@ -1515,8 +1549,8 @@ static struct phy_driver dp83640_driver = {
.remove = dp83640_remove, .remove = dp83640_remove,
.soft_reset = dp83640_soft_reset, .soft_reset = dp83640_soft_reset,
.config_init = dp83640_config_init, .config_init = dp83640_config_init,
.ack_interrupt = dp83640_ack_interrupt,
.config_intr = dp83640_config_intr, .config_intr = dp83640_config_intr,
.handle_interrupt = dp83640_handle_interrupt,
}; };
static int __init dp83640_init(void) static int __init dp83640_init(void)
......
...@@ -119,21 +119,6 @@ struct dp83822_private { ...@@ -119,21 +119,6 @@ struct dp83822_private {
u16 fx_sd_enable; u16 fx_sd_enable;
}; };
static int dp83822_ack_interrupt(struct phy_device *phydev)
{
int err;
err = phy_read(phydev, MII_DP83822_MISR1);
if (err < 0)
return err;
err = phy_read(phydev, MII_DP83822_MISR2);
if (err < 0)
return err;
return 0;
}
static int dp83822_set_wol(struct phy_device *phydev, static int dp83822_set_wol(struct phy_device *phydev,
struct ethtool_wolinfo *wol) struct ethtool_wolinfo *wol)
{ {
...@@ -303,6 +288,41 @@ static int dp83822_config_intr(struct phy_device *phydev) ...@@ -303,6 +288,41 @@ static int dp83822_config_intr(struct phy_device *phydev)
return phy_write(phydev, MII_DP83822_PHYSCR, physcr_status); return phy_write(phydev, MII_DP83822_PHYSCR, physcr_status);
} }
static irqreturn_t dp83822_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
/* The MISR1 and MISR2 registers are holding the interrupt status in
* the upper half (15:8), while the lower half (7:0) is used for
* controlling the interrupt enable state of those individual interrupt
* sources. To determine the possible interrupt sources, just read the
* MISR* register and use it directly to know which interrupts have
* been enabled previously or not.
*/
irq_status = phy_read(phydev, MII_DP83822_MISR1);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
goto trigger_machine;
irq_status = phy_read(phydev, MII_DP83822_MISR2);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
goto trigger_machine;
return IRQ_NONE;
trigger_machine:
phy_trigger_machine(phydev);
return IRQ_HANDLED;
}
static int dp8382x_disable_wol(struct phy_device *phydev) static int dp8382x_disable_wol(struct phy_device *phydev)
{ {
int value = DP83822_WOL_EN | DP83822_WOL_MAGIC_EN | int value = DP83822_WOL_EN | DP83822_WOL_MAGIC_EN |
...@@ -574,8 +594,8 @@ static int dp83822_resume(struct phy_device *phydev) ...@@ -574,8 +594,8 @@ static int dp83822_resume(struct phy_device *phydev)
.read_status = dp83822_read_status, \ .read_status = dp83822_read_status, \
.get_wol = dp83822_get_wol, \ .get_wol = dp83822_get_wol, \
.set_wol = dp83822_set_wol, \ .set_wol = dp83822_set_wol, \
.ack_interrupt = dp83822_ack_interrupt, \
.config_intr = dp83822_config_intr, \ .config_intr = dp83822_config_intr, \
.handle_interrupt = dp83822_handle_interrupt, \
.suspend = dp83822_suspend, \ .suspend = dp83822_suspend, \
.resume = dp83822_resume, \ .resume = dp83822_resume, \
} }
...@@ -589,8 +609,8 @@ static int dp83822_resume(struct phy_device *phydev) ...@@ -589,8 +609,8 @@ static int dp83822_resume(struct phy_device *phydev)
.config_init = dp8382x_config_init, \ .config_init = dp8382x_config_init, \
.get_wol = dp83822_get_wol, \ .get_wol = dp83822_get_wol, \
.set_wol = dp83822_set_wol, \ .set_wol = dp83822_set_wol, \
.ack_interrupt = dp83822_ack_interrupt, \
.config_intr = dp83822_config_intr, \ .config_intr = dp83822_config_intr, \
.handle_interrupt = dp83822_handle_interrupt, \
.suspend = dp83822_suspend, \ .suspend = dp83822_suspend, \
.resume = dp83822_resume, \ .resume = dp83822_resume, \
} }
......
...@@ -37,6 +37,20 @@ ...@@ -37,6 +37,20 @@
DP83848_MISR_SPD_INT_EN | \ DP83848_MISR_SPD_INT_EN | \
DP83848_MISR_LINK_INT_EN) DP83848_MISR_LINK_INT_EN)
#define DP83848_MISR_RHF_INT BIT(8)
#define DP83848_MISR_FHF_INT BIT(9)
#define DP83848_MISR_ANC_INT BIT(10)
#define DP83848_MISR_DUP_INT BIT(11)
#define DP83848_MISR_SPD_INT BIT(12)
#define DP83848_MISR_LINK_INT BIT(13)
#define DP83848_MISR_ED_INT BIT(14)
#define DP83848_INT_MASK \
(DP83848_MISR_ANC_INT | \
DP83848_MISR_DUP_INT | \
DP83848_MISR_SPD_INT | \
DP83848_MISR_LINK_INT)
static int dp83848_ack_interrupt(struct phy_device *phydev) static int dp83848_ack_interrupt(struct phy_device *phydev)
{ {
int err = phy_read(phydev, DP83848_MISR); int err = phy_read(phydev, DP83848_MISR);
...@@ -53,17 +67,46 @@ static int dp83848_config_intr(struct phy_device *phydev) ...@@ -53,17 +67,46 @@ static int dp83848_config_intr(struct phy_device *phydev)
return control; return control;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
ret = dp83848_ack_interrupt(phydev);
if (ret)
return ret;
control |= DP83848_MICR_INT_OE; control |= DP83848_MICR_INT_OE;
control |= DP83848_MICR_INTEN; control |= DP83848_MICR_INTEN;
ret = phy_write(phydev, DP83848_MISR, DP83848_INT_EN_MASK); ret = phy_write(phydev, DP83848_MISR, DP83848_INT_EN_MASK);
if (ret < 0) if (ret < 0)
return ret; return ret;
ret = phy_write(phydev, DP83848_MICR, control);
} else { } else {
control &= ~DP83848_MICR_INTEN; control &= ~DP83848_MICR_INTEN;
ret = phy_write(phydev, DP83848_MICR, control);
if (ret)
return ret;
ret = dp83848_ack_interrupt(phydev);
}
return ret;
}
static irqreturn_t dp83848_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
irq_status = phy_read(phydev, DP83848_MISR);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
} }
return phy_write(phydev, DP83848_MICR, control); if (!(irq_status & DP83848_INT_MASK))
return IRQ_NONE;
phy_trigger_machine(phydev);
return IRQ_HANDLED;
} }
static int dp83848_config_init(struct phy_device *phydev) static int dp83848_config_init(struct phy_device *phydev)
...@@ -102,8 +145,8 @@ MODULE_DEVICE_TABLE(mdio, dp83848_tbl); ...@@ -102,8 +145,8 @@ MODULE_DEVICE_TABLE(mdio, dp83848_tbl);
.resume = genphy_resume, \ .resume = genphy_resume, \
\ \
/* IRQ related */ \ /* IRQ related */ \
.ack_interrupt = dp83848_ack_interrupt, \
.config_intr = dp83848_config_intr, \ .config_intr = dp83848_config_intr, \
.handle_interrupt = dp83848_handle_interrupt, \
} }
static struct phy_driver dp83848_driver[] = { static struct phy_driver dp83848_driver[] = {
......
...@@ -288,9 +288,13 @@ static void dp83867_get_wol(struct phy_device *phydev, ...@@ -288,9 +288,13 @@ static void dp83867_get_wol(struct phy_device *phydev,
static int dp83867_config_intr(struct phy_device *phydev) static int dp83867_config_intr(struct phy_device *phydev)
{ {
int micr_status; int micr_status, err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
err = dp83867_ack_interrupt(phydev);
if (err)
return err;
micr_status = phy_read(phydev, MII_DP83867_MICR); micr_status = phy_read(phydev, MII_DP83867_MICR);
if (micr_status < 0) if (micr_status < 0)
return micr_status; return micr_status;
...@@ -303,11 +307,41 @@ static int dp83867_config_intr(struct phy_device *phydev) ...@@ -303,11 +307,41 @@ static int dp83867_config_intr(struct phy_device *phydev)
MII_DP83867_MICR_DUP_MODE_CHNG_INT_EN | MII_DP83867_MICR_DUP_MODE_CHNG_INT_EN |
MII_DP83867_MICR_SLEEP_MODE_CHNG_INT_EN); MII_DP83867_MICR_SLEEP_MODE_CHNG_INT_EN);
return phy_write(phydev, MII_DP83867_MICR, micr_status); err = phy_write(phydev, MII_DP83867_MICR, micr_status);
} else {
micr_status = 0x0;
err = phy_write(phydev, MII_DP83867_MICR, micr_status);
if (err)
return err;
err = dp83867_ack_interrupt(phydev);
} }
micr_status = 0x0; return err;
return phy_write(phydev, MII_DP83867_MICR, micr_status); }
static irqreturn_t dp83867_handle_interrupt(struct phy_device *phydev)
{
int irq_status, irq_enabled;
irq_status = phy_read(phydev, MII_DP83867_ISR);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
irq_enabled = phy_read(phydev, MII_DP83867_MICR);
if (irq_enabled < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (!(irq_status & irq_enabled))
return IRQ_NONE;
phy_trigger_machine(phydev);
return IRQ_HANDLED;
} }
static int dp83867_read_status(struct phy_device *phydev) static int dp83867_read_status(struct phy_device *phydev)
...@@ -825,8 +859,8 @@ static struct phy_driver dp83867_driver[] = { ...@@ -825,8 +859,8 @@ static struct phy_driver dp83867_driver[] = {
.set_wol = dp83867_set_wol, .set_wol = dp83867_set_wol,
/* IRQ related */ /* IRQ related */
.ack_interrupt = dp83867_ack_interrupt,
.config_intr = dp83867_config_intr, .config_intr = dp83867_config_intr,
.handle_interrupt = dp83867_handle_interrupt,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
......
...@@ -186,9 +186,13 @@ static int dp83869_ack_interrupt(struct phy_device *phydev) ...@@ -186,9 +186,13 @@ static int dp83869_ack_interrupt(struct phy_device *phydev)
static int dp83869_config_intr(struct phy_device *phydev) static int dp83869_config_intr(struct phy_device *phydev)
{ {
int micr_status = 0; int micr_status = 0, err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
err = dp83869_ack_interrupt(phydev);
if (err)
return err;
micr_status = phy_read(phydev, MII_DP83869_MICR); micr_status = phy_read(phydev, MII_DP83869_MICR);
if (micr_status < 0) if (micr_status < 0)
return micr_status; return micr_status;
...@@ -201,10 +205,40 @@ static int dp83869_config_intr(struct phy_device *phydev) ...@@ -201,10 +205,40 @@ static int dp83869_config_intr(struct phy_device *phydev)
MII_DP83869_MICR_DUP_MODE_CHNG_INT_EN | MII_DP83869_MICR_DUP_MODE_CHNG_INT_EN |
MII_DP83869_MICR_SLEEP_MODE_CHNG_INT_EN); MII_DP83869_MICR_SLEEP_MODE_CHNG_INT_EN);
return phy_write(phydev, MII_DP83869_MICR, micr_status); err = phy_write(phydev, MII_DP83869_MICR, micr_status);
} else {
err = phy_write(phydev, MII_DP83869_MICR, micr_status);
if (err)
return err;
err = dp83869_ack_interrupt(phydev);
} }
return phy_write(phydev, MII_DP83869_MICR, micr_status); return err;
}
static irqreturn_t dp83869_handle_interrupt(struct phy_device *phydev)
{
int irq_status, irq_enabled;
irq_status = phy_read(phydev, MII_DP83869_ISR);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
irq_enabled = phy_read(phydev, MII_DP83869_MICR);
if (irq_enabled < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (!(irq_status & irq_enabled))
return IRQ_NONE;
phy_trigger_machine(phydev);
return IRQ_HANDLED;
} }
static int dp83869_set_wol(struct phy_device *phydev, static int dp83869_set_wol(struct phy_device *phydev,
...@@ -850,8 +884,8 @@ static struct phy_driver dp83869_driver[] = { ...@@ -850,8 +884,8 @@ static struct phy_driver dp83869_driver[] = {
.soft_reset = dp83869_phy_reset, .soft_reset = dp83869_phy_reset,
/* IRQ related */ /* IRQ related */
.ack_interrupt = dp83869_ack_interrupt,
.config_intr = dp83869_config_intr, .config_intr = dp83869_config_intr,
.handle_interrupt = dp83869_handle_interrupt,
.read_status = dp83869_read_status, .read_status = dp83869_read_status,
.get_tunable = dp83869_get_tunable, .get_tunable = dp83869_get_tunable,
......
...@@ -197,6 +197,10 @@ static int dp83811_config_intr(struct phy_device *phydev) ...@@ -197,6 +197,10 @@ static int dp83811_config_intr(struct phy_device *phydev)
int misr_status, err; int misr_status, err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
err = dp83811_ack_interrupt(phydev);
if (err)
return err;
misr_status = phy_read(phydev, MII_DP83811_INT_STAT1); misr_status = phy_read(phydev, MII_DP83811_INT_STAT1);
if (misr_status < 0) if (misr_status < 0)
return misr_status; return misr_status;
...@@ -249,11 +253,58 @@ static int dp83811_config_intr(struct phy_device *phydev) ...@@ -249,11 +253,58 @@ static int dp83811_config_intr(struct phy_device *phydev)
return err; return err;
err = phy_write(phydev, MII_DP83811_INT_STAT3, 0); err = phy_write(phydev, MII_DP83811_INT_STAT3, 0);
if (err < 0)
return err;
err = dp83811_ack_interrupt(phydev);
} }
return err; return err;
} }
static irqreturn_t dp83811_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
/* The INT_STAT registers 1, 2 and 3 are holding the interrupt status
* in the upper half (15:8), while the lower half (7:0) is used for
* controlling the interrupt enable state of those individual interrupt
* sources. To determine the possible interrupt sources, just read the
* INT_STAT* register and use it directly to know which interrupts have
* been enabled previously or not.
*/
irq_status = phy_read(phydev, MII_DP83811_INT_STAT1);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
goto trigger_machine;
irq_status = phy_read(phydev, MII_DP83811_INT_STAT2);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
goto trigger_machine;
irq_status = phy_read(phydev, MII_DP83811_INT_STAT3);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
goto trigger_machine;
return IRQ_NONE;
trigger_machine:
phy_trigger_machine(phydev);
return IRQ_HANDLED;
}
static int dp83811_config_aneg(struct phy_device *phydev) static int dp83811_config_aneg(struct phy_device *phydev)
{ {
int value, err; int value, err;
...@@ -343,8 +394,8 @@ static struct phy_driver dp83811_driver[] = { ...@@ -343,8 +394,8 @@ static struct phy_driver dp83811_driver[] = {
.soft_reset = dp83811_phy_reset, .soft_reset = dp83811_phy_reset,
.get_wol = dp83811_get_wol, .get_wol = dp83811_get_wol,
.set_wol = dp83811_set_wol, .set_wol = dp83811_set_wol,
.ack_interrupt = dp83811_ack_interrupt,
.config_intr = dp83811_config_intr, .config_intr = dp83811_config_intr,
.handle_interrupt = dp83811_handle_interrupt,
.suspend = dp83811_suspend, .suspend = dp83811_suspend,
.resume = dp83811_resume, .resume = dp83811_resume,
}, },
......
...@@ -272,38 +272,59 @@ static int ip101a_g_config_init(struct phy_device *phydev) ...@@ -272,38 +272,59 @@ static int ip101a_g_config_init(struct phy_device *phydev)
return phy_write(phydev, IP10XX_SPEC_CTRL_STATUS, c); return phy_write(phydev, IP10XX_SPEC_CTRL_STATUS, c);
} }
static int ip101a_g_ack_interrupt(struct phy_device *phydev)
{
int err = phy_read(phydev, IP101A_G_IRQ_CONF_STATUS);
if (err < 0)
return err;
return 0;
}
static int ip101a_g_config_intr(struct phy_device *phydev) static int ip101a_g_config_intr(struct phy_device *phydev)
{ {
u16 val; u16 val;
int err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
err = ip101a_g_ack_interrupt(phydev);
if (err)
return err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
/* INTR pin used: Speed/link/duplex will cause an interrupt */ /* INTR pin used: Speed/link/duplex will cause an interrupt */
val = IP101A_G_IRQ_PIN_USED; val = IP101A_G_IRQ_PIN_USED;
else err = phy_write(phydev, IP101A_G_IRQ_CONF_STATUS, val);
} else {
val = IP101A_G_IRQ_ALL_MASK; val = IP101A_G_IRQ_ALL_MASK;
err = phy_write(phydev, IP101A_G_IRQ_CONF_STATUS, val);
if (err)
return err;
err = ip101a_g_ack_interrupt(phydev);
}
return phy_write(phydev, IP101A_G_IRQ_CONF_STATUS, val); return err;
} }
static int ip101a_g_did_interrupt(struct phy_device *phydev) static irqreturn_t ip101a_g_handle_interrupt(struct phy_device *phydev)
{ {
int val = phy_read(phydev, IP101A_G_IRQ_CONF_STATUS); int irq_status;
if (val < 0) irq_status = phy_read(phydev, IP101A_G_IRQ_CONF_STATUS);
return 0; if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
return val & (IP101A_G_IRQ_SPEED_CHANGE | if (!(irq_status & (IP101A_G_IRQ_SPEED_CHANGE |
IP101A_G_IRQ_DUPLEX_CHANGE | IP101A_G_IRQ_DUPLEX_CHANGE |
IP101A_G_IRQ_LINK_CHANGE); IP101A_G_IRQ_LINK_CHANGE)))
} return IRQ_NONE;
static int ip101a_g_ack_interrupt(struct phy_device *phydev) phy_trigger_machine(phydev);
{
int err = phy_read(phydev, IP101A_G_IRQ_CONF_STATUS);
if (err < 0)
return err;
return 0; return IRQ_HANDLED;
} }
static struct phy_driver icplus_driver[] = { static struct phy_driver icplus_driver[] = {
...@@ -332,8 +353,7 @@ static struct phy_driver icplus_driver[] = { ...@@ -332,8 +353,7 @@ static struct phy_driver icplus_driver[] = {
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.probe = ip101a_g_probe, .probe = ip101a_g_probe,
.config_intr = ip101a_g_config_intr, .config_intr = ip101a_g_config_intr,
.did_interrupt = ip101a_g_did_interrupt, .handle_interrupt = ip101a_g_handle_interrupt,
.ack_interrupt = ip101a_g_ack_interrupt,
.config_init = &ip101a_g_config_init, .config_init = &ip101a_g_config_init,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
......
...@@ -209,22 +209,45 @@ static int xway_gphy_ack_interrupt(struct phy_device *phydev) ...@@ -209,22 +209,45 @@ static int xway_gphy_ack_interrupt(struct phy_device *phydev)
return (reg < 0) ? reg : 0; return (reg < 0) ? reg : 0;
} }
static int xway_gphy_did_interrupt(struct phy_device *phydev) static int xway_gphy_config_intr(struct phy_device *phydev)
{ {
int reg; u16 mask = 0;
int err;
reg = phy_read(phydev, XWAY_MDIO_ISTAT); if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
return reg & XWAY_MDIO_INIT_MASK; err = xway_gphy_ack_interrupt(phydev);
if (err)
return err;
mask = XWAY_MDIO_INIT_MASK;
err = phy_write(phydev, XWAY_MDIO_IMASK, mask);
} else {
err = phy_write(phydev, XWAY_MDIO_IMASK, mask);
if (err)
return err;
err = xway_gphy_ack_interrupt(phydev);
}
return err;
} }
static int xway_gphy_config_intr(struct phy_device *phydev) static irqreturn_t xway_gphy_handle_interrupt(struct phy_device *phydev)
{ {
u16 mask = 0; int irq_status;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) irq_status = phy_read(phydev, XWAY_MDIO_ISTAT);
mask = XWAY_MDIO_INIT_MASK; if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (!(irq_status & XWAY_MDIO_INIT_MASK))
return IRQ_NONE;
phy_trigger_machine(phydev);
return phy_write(phydev, XWAY_MDIO_IMASK, mask); return IRQ_HANDLED;
} }
static struct phy_driver xway_gphy[] = { static struct phy_driver xway_gphy[] = {
...@@ -235,8 +258,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -235,8 +258,7 @@ static struct phy_driver xway_gphy[] = {
/* PHY_GBIT_FEATURES */ /* PHY_GBIT_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.config_aneg = xway_gphy14_config_aneg, .config_aneg = xway_gphy14_config_aneg,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -247,8 +269,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -247,8 +269,7 @@ static struct phy_driver xway_gphy[] = {
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.config_aneg = xway_gphy14_config_aneg, .config_aneg = xway_gphy14_config_aneg,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -259,8 +280,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -259,8 +280,7 @@ static struct phy_driver xway_gphy[] = {
/* PHY_GBIT_FEATURES */ /* PHY_GBIT_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.config_aneg = xway_gphy14_config_aneg, .config_aneg = xway_gphy14_config_aneg,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -271,8 +291,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -271,8 +291,7 @@ static struct phy_driver xway_gphy[] = {
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.config_aneg = xway_gphy14_config_aneg, .config_aneg = xway_gphy14_config_aneg,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -282,8 +301,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -282,8 +301,7 @@ static struct phy_driver xway_gphy[] = {
.name = "Intel XWAY PHY11G (PEF 7071/PEF 7072) v1.5 / v1.6", .name = "Intel XWAY PHY11G (PEF 7071/PEF 7072) v1.5 / v1.6",
/* PHY_GBIT_FEATURES */ /* PHY_GBIT_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -293,8 +311,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -293,8 +311,7 @@ static struct phy_driver xway_gphy[] = {
.name = "Intel XWAY PHY22F (PEF 7061) v1.5 / v1.6", .name = "Intel XWAY PHY22F (PEF 7061) v1.5 / v1.6",
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -304,8 +321,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -304,8 +321,7 @@ static struct phy_driver xway_gphy[] = {
.name = "Intel XWAY PHY11G (xRX v1.1 integrated)", .name = "Intel XWAY PHY11G (xRX v1.1 integrated)",
/* PHY_GBIT_FEATURES */ /* PHY_GBIT_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -315,8 +331,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -315,8 +331,7 @@ static struct phy_driver xway_gphy[] = {
.name = "Intel XWAY PHY22F (xRX v1.1 integrated)", .name = "Intel XWAY PHY22F (xRX v1.1 integrated)",
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -326,8 +341,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -326,8 +341,7 @@ static struct phy_driver xway_gphy[] = {
.name = "Intel XWAY PHY11G (xRX v1.2 integrated)", .name = "Intel XWAY PHY11G (xRX v1.2 integrated)",
/* PHY_GBIT_FEATURES */ /* PHY_GBIT_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
...@@ -337,8 +351,7 @@ static struct phy_driver xway_gphy[] = { ...@@ -337,8 +351,7 @@ static struct phy_driver xway_gphy[] = {
.name = "Intel XWAY PHY22F (xRX v1.2 integrated)", .name = "Intel XWAY PHY22F (xRX v1.2 integrated)",
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.config_init = xway_gphy_config_init, .config_init = xway_gphy_config_init,
.ack_interrupt = xway_gphy_ack_interrupt, .handle_interrupt = xway_gphy_handle_interrupt,
.did_interrupt = xway_gphy_did_interrupt,
.config_intr = xway_gphy_config_intr, .config_intr = xway_gphy_config_intr,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
......
...@@ -204,22 +204,45 @@ static int meson_gxl_config_intr(struct phy_device *phydev) ...@@ -204,22 +204,45 @@ static int meson_gxl_config_intr(struct phy_device *phydev)
int ret; int ret;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
/* Ack any pending IRQ */
ret = meson_gxl_ack_interrupt(phydev);
if (ret)
return ret;
val = INTSRC_ANEG_PR val = INTSRC_ANEG_PR
| INTSRC_PARALLEL_FAULT | INTSRC_PARALLEL_FAULT
| INTSRC_ANEG_LP_ACK | INTSRC_ANEG_LP_ACK
| INTSRC_LINK_DOWN | INTSRC_LINK_DOWN
| INTSRC_REMOTE_FAULT | INTSRC_REMOTE_FAULT
| INTSRC_ANEG_COMPLETE; | INTSRC_ANEG_COMPLETE;
ret = phy_write(phydev, INTSRC_MASK, val);
} else { } else {
val = 0; val = 0;
ret = phy_write(phydev, INTSRC_MASK, val);
/* Ack any pending IRQ */
ret = meson_gxl_ack_interrupt(phydev);
} }
/* Ack any pending IRQ */ return ret;
ret = meson_gxl_ack_interrupt(phydev); }
if (ret)
return ret; static irqreturn_t meson_gxl_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
irq_status = phy_read(phydev, INTSRC_FLAG);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (irq_status == 0)
return IRQ_NONE;
phy_trigger_machine(phydev);
return phy_write(phydev, INTSRC_MASK, val); return IRQ_HANDLED;
} }
static struct phy_driver meson_gxl_phy[] = { static struct phy_driver meson_gxl_phy[] = {
...@@ -231,8 +254,8 @@ static struct phy_driver meson_gxl_phy[] = { ...@@ -231,8 +254,8 @@ static struct phy_driver meson_gxl_phy[] = {
.soft_reset = genphy_soft_reset, .soft_reset = genphy_soft_reset,
.config_init = meson_gxl_config_init, .config_init = meson_gxl_config_init,
.read_status = meson_gxl_read_status, .read_status = meson_gxl_read_status,
.ack_interrupt = meson_gxl_ack_interrupt,
.config_intr = meson_gxl_config_intr, .config_intr = meson_gxl_config_intr,
.handle_interrupt = meson_gxl_handle_interrupt,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
}, { }, {
...@@ -241,8 +264,8 @@ static struct phy_driver meson_gxl_phy[] = { ...@@ -241,8 +264,8 @@ static struct phy_driver meson_gxl_phy[] = {
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.flags = PHY_IS_INTERNAL, .flags = PHY_IS_INTERNAL,
.soft_reset = genphy_soft_reset, .soft_reset = genphy_soft_reset,
.ack_interrupt = meson_gxl_ack_interrupt,
.config_intr = meson_gxl_config_intr, .config_intr = meson_gxl_config_intr,
.handle_interrupt = meson_gxl_handle_interrupt,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
}, },
......
...@@ -48,6 +48,10 @@ ...@@ -48,6 +48,10 @@
#define KSZPHY_INTCS_LINK_UP BIT(8) #define KSZPHY_INTCS_LINK_UP BIT(8)
#define KSZPHY_INTCS_ALL (KSZPHY_INTCS_LINK_UP |\ #define KSZPHY_INTCS_ALL (KSZPHY_INTCS_LINK_UP |\
KSZPHY_INTCS_LINK_DOWN) KSZPHY_INTCS_LINK_DOWN)
#define KSZPHY_INTCS_LINK_DOWN_STATUS BIT(2)
#define KSZPHY_INTCS_LINK_UP_STATUS BIT(0)
#define KSZPHY_INTCS_STATUS (KSZPHY_INTCS_LINK_DOWN_STATUS |\
KSZPHY_INTCS_LINK_UP_STATUS)
/* PHY Control 1 */ /* PHY Control 1 */
#define MII_KSZPHY_CTRL_1 0x1e #define MII_KSZPHY_CTRL_1 0x1e
...@@ -158,7 +162,7 @@ static int kszphy_ack_interrupt(struct phy_device *phydev) ...@@ -158,7 +162,7 @@ static int kszphy_ack_interrupt(struct phy_device *phydev)
static int kszphy_config_intr(struct phy_device *phydev) static int kszphy_config_intr(struct phy_device *phydev)
{ {
const struct kszphy_type *type = phydev->drv->driver_data; const struct kszphy_type *type = phydev->drv->driver_data;
int temp; int temp, err;
u16 mask; u16 mask;
if (type && type->interrupt_level_mask) if (type && type->interrupt_level_mask)
...@@ -174,12 +178,41 @@ static int kszphy_config_intr(struct phy_device *phydev) ...@@ -174,12 +178,41 @@ static int kszphy_config_intr(struct phy_device *phydev)
phy_write(phydev, MII_KSZPHY_CTRL, temp); phy_write(phydev, MII_KSZPHY_CTRL, temp);
/* enable / disable interrupts */ /* enable / disable interrupts */
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
err = kszphy_ack_interrupt(phydev);
if (err)
return err;
temp = KSZPHY_INTCS_ALL; temp = KSZPHY_INTCS_ALL;
else err = phy_write(phydev, MII_KSZPHY_INTCS, temp);
} else {
temp = 0; temp = 0;
err = phy_write(phydev, MII_KSZPHY_INTCS, temp);
if (err)
return err;
err = kszphy_ack_interrupt(phydev);
}
return err;
}
static irqreturn_t kszphy_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
irq_status = phy_read(phydev, MII_KSZPHY_INTCS);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if ((irq_status & KSZPHY_INTCS_STATUS))
return IRQ_NONE;
phy_trigger_machine(phydev);
return phy_write(phydev, MII_KSZPHY_INTCS, temp); return IRQ_HANDLED;
} }
static int kszphy_rmii_clk_sel(struct phy_device *phydev, bool val) static int kszphy_rmii_clk_sel(struct phy_device *phydev, bool val)
...@@ -1160,8 +1193,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1160,8 +1193,8 @@ static struct phy_driver ksphy_driver[] = {
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.driver_data = &ks8737_type, .driver_data = &ks8737_type,
.config_init = kszphy_config_init, .config_init = kszphy_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
}, { }, {
...@@ -1172,8 +1205,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1172,8 +1205,8 @@ static struct phy_driver ksphy_driver[] = {
.driver_data = &ksz8021_type, .driver_data = &ksz8021_type,
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = kszphy_config_init, .config_init = kszphy_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1187,8 +1220,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1187,8 +1220,8 @@ static struct phy_driver ksphy_driver[] = {
.driver_data = &ksz8021_type, .driver_data = &ksz8021_type,
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = kszphy_config_init, .config_init = kszphy_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1203,8 +1236,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1203,8 +1236,8 @@ static struct phy_driver ksphy_driver[] = {
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = ksz8041_config_init, .config_init = ksz8041_config_init,
.config_aneg = ksz8041_config_aneg, .config_aneg = ksz8041_config_aneg,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1218,8 +1251,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1218,8 +1251,8 @@ static struct phy_driver ksphy_driver[] = {
.driver_data = &ksz8041_type, .driver_data = &ksz8041_type,
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = kszphy_config_init, .config_init = kszphy_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1231,8 +1264,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1231,8 +1264,8 @@ static struct phy_driver ksphy_driver[] = {
.driver_data = &ksz8051_type, .driver_data = &ksz8051_type,
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = kszphy_config_init, .config_init = kszphy_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1247,8 +1280,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1247,8 +1280,8 @@ static struct phy_driver ksphy_driver[] = {
.driver_data = &ksz8041_type, .driver_data = &ksz8041_type,
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = kszphy_config_init, .config_init = kszphy_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1262,8 +1295,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1262,8 +1295,8 @@ static struct phy_driver ksphy_driver[] = {
.driver_data = &ksz8081_type, .driver_data = &ksz8081_type,
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = ksz8081_config_init, .config_init = ksz8081_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1275,8 +1308,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1275,8 +1308,8 @@ static struct phy_driver ksphy_driver[] = {
.phy_id_mask = MICREL_PHY_ID_MASK, .phy_id_mask = MICREL_PHY_ID_MASK,
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.config_init = ksz8061_config_init, .config_init = ksz8061_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.suspend = genphy_suspend, .suspend = genphy_suspend,
.resume = genphy_resume, .resume = genphy_resume,
}, { }, {
...@@ -1288,8 +1321,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1288,8 +1321,8 @@ static struct phy_driver ksphy_driver[] = {
.probe = kszphy_probe, .probe = kszphy_probe,
.get_features = ksz9031_get_features, .get_features = ksz9031_get_features,
.config_init = ksz9021_config_init, .config_init = ksz9021_config_init,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1307,8 +1340,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1307,8 +1340,8 @@ static struct phy_driver ksphy_driver[] = {
.config_init = ksz9031_config_init, .config_init = ksz9031_config_init,
.soft_reset = genphy_soft_reset, .soft_reset = genphy_soft_reset,
.read_status = ksz9031_read_status, .read_status = ksz9031_read_status,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
...@@ -1336,8 +1369,8 @@ static struct phy_driver ksphy_driver[] = { ...@@ -1336,8 +1369,8 @@ static struct phy_driver ksphy_driver[] = {
.probe = kszphy_probe, .probe = kszphy_probe,
.config_init = ksz9131_config_init, .config_init = ksz9131_config_init,
.read_status = genphy_read_status, .read_status = genphy_read_status,
.ack_interrupt = kszphy_ack_interrupt,
.config_intr = kszphy_config_intr, .config_intr = kszphy_config_intr,
.handle_interrupt = kszphy_handle_interrupt,
.get_sset_count = kszphy_get_sset_count, .get_sset_count = kszphy_get_sset_count,
.get_strings = kszphy_get_strings, .get_strings = kszphy_get_strings,
.get_stats = kszphy_get_stats, .get_stats = kszphy_get_stats,
......
...@@ -63,19 +63,6 @@ static void ns_exp_write(struct phy_device *phydev, u16 reg, u8 data) ...@@ -63,19 +63,6 @@ static void ns_exp_write(struct phy_device *phydev, u16 reg, u8 data)
phy_write(phydev, NS_EXP_MEM_DATA, data); phy_write(phydev, NS_EXP_MEM_DATA, data);
} }
static int ns_config_intr(struct phy_device *phydev)
{
int err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
err = phy_write(phydev, DP83865_INT_MASK,
DP83865_INT_MASK_DEFAULT);
else
err = phy_write(phydev, DP83865_INT_MASK, 0);
return err;
}
static int ns_ack_interrupt(struct phy_device *phydev) static int ns_ack_interrupt(struct phy_device *phydev)
{ {
int ret = phy_read(phydev, DP83865_INT_STATUS); int ret = phy_read(phydev, DP83865_INT_STATUS);
...@@ -89,6 +76,49 @@ static int ns_ack_interrupt(struct phy_device *phydev) ...@@ -89,6 +76,49 @@ static int ns_ack_interrupt(struct phy_device *phydev)
return ret; return ret;
} }
static irqreturn_t ns_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
irq_status = phy_read(phydev, DP83865_INT_STATUS);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (!(irq_status & DP83865_INT_MASK_DEFAULT))
return IRQ_NONE;
/* clear the interrupt */
phy_write(phydev, DP83865_INT_CLEAR, irq_status & ~0x7);
phy_trigger_machine(phydev);
return IRQ_HANDLED;
}
static int ns_config_intr(struct phy_device *phydev)
{
int err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
err = ns_ack_interrupt(phydev);
if (err)
return err;
err = phy_write(phydev, DP83865_INT_MASK,
DP83865_INT_MASK_DEFAULT);
} else {
err = phy_write(phydev, DP83865_INT_MASK, 0);
if (err)
return err;
err = ns_ack_interrupt(phydev);
}
return err;
}
static void ns_giga_speed_fallback(struct phy_device *phydev, int mode) static void ns_giga_speed_fallback(struct phy_device *phydev, int mode)
{ {
int bmcr = phy_read(phydev, MII_BMCR); int bmcr = phy_read(phydev, MII_BMCR);
...@@ -133,8 +163,8 @@ static struct phy_driver dp83865_driver[] = { { ...@@ -133,8 +163,8 @@ static struct phy_driver dp83865_driver[] = { {
.name = "NatSemi DP83865", .name = "NatSemi DP83865",
/* PHY_GBIT_FEATURES */ /* PHY_GBIT_FEATURES */
.config_init = ns_config_init, .config_init = ns_config_init,
.ack_interrupt = ns_ack_interrupt,
.config_intr = ns_config_intr, .config_intr = ns_config_intr,
.handle_interrupt = ns_handle_interrupt,
} }; } };
module_phy_driver(dp83865_driver); module_phy_driver(dp83865_driver);
......
...@@ -113,23 +113,6 @@ void phy_print_status(struct phy_device *phydev) ...@@ -113,23 +113,6 @@ void phy_print_status(struct phy_device *phydev)
} }
EXPORT_SYMBOL(phy_print_status); EXPORT_SYMBOL(phy_print_status);
/**
* phy_clear_interrupt - Ack the phy device's interrupt
* @phydev: the phy_device struct
*
* If the @phydev driver has an ack_interrupt function, call it to
* ack and clear the phy device's interrupt.
*
* Returns 0 on success or < 0 on error.
*/
static int phy_clear_interrupt(struct phy_device *phydev)
{
if (phydev->drv->ack_interrupt)
return phydev->drv->ack_interrupt(phydev);
return 0;
}
/** /**
* phy_config_interrupt - configure the PHY device for the requested interrupts * phy_config_interrupt - configure the PHY device for the requested interrupts
* @phydev: the phy_device struct * @phydev: the phy_device struct
...@@ -943,15 +926,8 @@ EXPORT_SYMBOL(phy_error); ...@@ -943,15 +926,8 @@ EXPORT_SYMBOL(phy_error);
*/ */
int phy_disable_interrupts(struct phy_device *phydev) int phy_disable_interrupts(struct phy_device *phydev)
{ {
int err;
/* Disable PHY interrupts */ /* Disable PHY interrupts */
err = phy_config_interrupt(phydev, PHY_INTERRUPT_DISABLED); return phy_config_interrupt(phydev, PHY_INTERRUPT_DISABLED);
if (err)
return err;
/* Clear the interrupt */
return phy_clear_interrupt(phydev);
} }
/** /**
...@@ -966,22 +942,7 @@ static irqreturn_t phy_interrupt(int irq, void *phy_dat) ...@@ -966,22 +942,7 @@ static irqreturn_t phy_interrupt(int irq, void *phy_dat)
struct phy_device *phydev = phy_dat; struct phy_device *phydev = phy_dat;
struct phy_driver *drv = phydev->drv; struct phy_driver *drv = phydev->drv;
if (drv->handle_interrupt) return drv->handle_interrupt(phydev);
return drv->handle_interrupt(phydev);
if (drv->did_interrupt && !drv->did_interrupt(phydev))
return IRQ_NONE;
/* reschedule state queue work to run as soon as possible */
phy_trigger_machine(phydev);
/* did_interrupt() may have cleared the interrupt already */
if (!drv->did_interrupt && phy_clear_interrupt(phydev)) {
phy_error(phydev);
return IRQ_NONE;
}
return IRQ_HANDLED;
} }
/** /**
...@@ -990,11 +951,6 @@ static irqreturn_t phy_interrupt(int irq, void *phy_dat) ...@@ -990,11 +951,6 @@ static irqreturn_t phy_interrupt(int irq, void *phy_dat)
*/ */
static int phy_enable_interrupts(struct phy_device *phydev) static int phy_enable_interrupts(struct phy_device *phydev)
{ {
int err = phy_clear_interrupt(phydev);
if (err < 0)
return err;
return phy_config_interrupt(phydev, PHY_INTERRUPT_ENABLED); return phy_config_interrupt(phydev, PHY_INTERRUPT_ENABLED);
} }
......
...@@ -2826,7 +2826,7 @@ EXPORT_SYMBOL(phy_get_internal_delay); ...@@ -2826,7 +2826,7 @@ EXPORT_SYMBOL(phy_get_internal_delay);
static bool phy_drv_supports_irq(struct phy_driver *phydrv) static bool phy_drv_supports_irq(struct phy_driver *phydrv)
{ {
return phydrv->config_intr && (phydrv->ack_interrupt || phydrv->handle_interrupt); return phydrv->config_intr && phydrv->handle_interrupt;
} }
/** /**
......
...@@ -75,6 +75,10 @@ static int qs6612_ack_interrupt(struct phy_device *phydev) ...@@ -75,6 +75,10 @@ static int qs6612_ack_interrupt(struct phy_device *phydev)
{ {
int err; int err;
/* The Interrupt Source register is not self-clearing, bits 4 and 5 are
* cleared when MII_BMSR is read and bits 1 and 3 are cleared when
* MII_EXPANSION is read
*/
err = phy_read(phydev, MII_QS6612_ISR); err = phy_read(phydev, MII_QS6612_ISR);
if (err < 0) if (err < 0)
...@@ -96,24 +100,56 @@ static int qs6612_ack_interrupt(struct phy_device *phydev) ...@@ -96,24 +100,56 @@ static int qs6612_ack_interrupt(struct phy_device *phydev)
static int qs6612_config_intr(struct phy_device *phydev) static int qs6612_config_intr(struct phy_device *phydev)
{ {
int err; int err;
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
/* clear any interrupts before enabling them */
err = qs6612_ack_interrupt(phydev);
if (err)
return err;
err = phy_write(phydev, MII_QS6612_IMR, err = phy_write(phydev, MII_QS6612_IMR,
MII_QS6612_IMR_INIT); MII_QS6612_IMR_INIT);
else } else {
err = phy_write(phydev, MII_QS6612_IMR, 0); err = phy_write(phydev, MII_QS6612_IMR, 0);
if (err)
return err;
/* clear any leftover interrupts */
err = qs6612_ack_interrupt(phydev);
}
return err; return err;
} }
static irqreturn_t qs6612_handle_interrupt(struct phy_device *phydev)
{
int irq_status;
irq_status = phy_read(phydev, MII_QS6612_ISR);
if (irq_status < 0) {
phy_error(phydev);
return IRQ_NONE;
}
if (!(irq_status & MII_QS6612_IMR_INIT))
return IRQ_NONE;
/* the interrupt source register is not self-clearing */
qs6612_ack_interrupt(phydev);
phy_trigger_machine(phydev);
return IRQ_HANDLED;
}
static struct phy_driver qs6612_driver[] = { { static struct phy_driver qs6612_driver[] = { {
.phy_id = 0x00181440, .phy_id = 0x00181440,
.name = "QS6612", .name = "QS6612",
.phy_id_mask = 0xfffffff0, .phy_id_mask = 0xfffffff0,
/* PHY_BASIC_FEATURES */ /* PHY_BASIC_FEATURES */
.config_init = qs6612_config_init, .config_init = qs6612_config_init,
.ack_interrupt = qs6612_ack_interrupt,
.config_intr = qs6612_config_intr, .config_intr = qs6612_config_intr,
.handle_interrupt = qs6612_handle_interrupt,
} }; } };
module_phy_driver(qs6612_driver); module_phy_driver(qs6612_driver);
......
...@@ -743,18 +743,11 @@ struct phy_driver { ...@@ -743,18 +743,11 @@ struct phy_driver {
/** @read_status: Determines the negotiated speed and duplex */ /** @read_status: Determines the negotiated speed and duplex */
int (*read_status)(struct phy_device *phydev); int (*read_status)(struct phy_device *phydev);
/** @ack_interrupt: Clears any pending interrupts */ /** @config_intr: Enables or disables interrupts.
int (*ack_interrupt)(struct phy_device *phydev); * It should also clear any pending interrupts prior to enabling the
* IRQs and after disabling them.
/** @config_intr: Enables or disables interrupts */
int (*config_intr)(struct phy_device *phydev);
/**
* @did_interrupt: Checks if the PHY generated an interrupt.
* For multi-PHY devices with shared PHY interrupt pin
* Set interrupt bits have to be cleared.
*/ */
int (*did_interrupt)(struct phy_device *phydev); int (*config_intr)(struct phy_device *phydev);
/** @handle_interrupt: Override default interrupt handling */ /** @handle_interrupt: Override default interrupt handling */
irqreturn_t (*handle_interrupt)(struct phy_device *phydev); irqreturn_t (*handle_interrupt)(struct phy_device *phydev);
...@@ -1487,10 +1480,6 @@ static inline int genphy_config_aneg(struct phy_device *phydev) ...@@ -1487,10 +1480,6 @@ static inline int genphy_config_aneg(struct phy_device *phydev)
return __genphy_config_aneg(phydev, false); return __genphy_config_aneg(phydev, false);
} }
static inline int genphy_no_ack_interrupt(struct phy_device *phydev)
{
return 0;
}
static inline int genphy_no_config_intr(struct phy_device *phydev) static inline int genphy_no_config_intr(struct phy_device *phydev)
{ {
return 0; return 0;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment