Skip to content

Commit 834fa12

Browse files
committed
Merge branch 'master' of git://gitorious.org/linux-can/linux-can
2 parents 9d4990a + a7762b1 commit 834fa12

File tree

1 file changed

+12
-1
lines changed

1 file changed

+12
-1
lines changed

drivers/net/can/sja1000/sja1000.c

Lines changed: 12 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -95,11 +95,16 @@ static void sja1000_write_cmdreg(struct sja1000_priv *priv, u8 val)
9595
spin_unlock_irqrestore(&priv->cmdreg_lock, flags);
9696
}
9797

98+
static int sja1000_is_absent(struct sja1000_priv *priv)
99+
{
100+
return (priv->read_reg(priv, REG_MOD) == 0xFF);
101+
}
102+
98103
static int sja1000_probe_chip(struct net_device *dev)
99104
{
100105
struct sja1000_priv *priv = netdev_priv(dev);
101106

102-
if (priv->reg_base && (priv->read_reg(priv, 0) == 0xFF)) {
107+
if (priv->reg_base && sja1000_is_absent(priv)) {
103108
printk(KERN_INFO "%s: probing @0x%lX failed\n",
104109
DRV_NAME, dev->base_addr);
105110
return 0;
@@ -493,6 +498,9 @@ irqreturn_t sja1000_interrupt(int irq, void *dev_id)
493498
while ((isrc = priv->read_reg(priv, REG_IR)) && (n < SJA1000_MAX_IRQ)) {
494499
n++;
495500
status = priv->read_reg(priv, REG_SR);
501+
/* check for absent controller due to hw unplug */
502+
if (status == 0xFF && sja1000_is_absent(priv))
503+
return IRQ_NONE;
496504

497505
if (isrc & IRQ_WUI)
498506
dev_warn(dev->dev.parent, "wakeup interrupt\n");
@@ -509,6 +517,9 @@ irqreturn_t sja1000_interrupt(int irq, void *dev_id)
509517
while (status & SR_RBS) {
510518
sja1000_rx(dev);
511519
status = priv->read_reg(priv, REG_SR);
520+
/* check for absent controller */
521+
if (status == 0xFF && sja1000_is_absent(priv))
522+
return IRQ_NONE;
512523
}
513524
}
514525
if (isrc & (IRQ_DOI | IRQ_EI | IRQ_BEI | IRQ_EPI | IRQ_ALI)) {

0 commit comments

Comments
 (0)