mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2025-01-27 08:14:35 +08:00
Merge branch 'mV88e6xxx-interrupt-fixes'
Andrew Lunn says: ==================== Fixes for the MV88e6xxx interrupt code The interrupt code was never tested with a board who's probing resulted in an -EPROBE_DEFFERED. So the clean up paths never got tested. I now do have -EPROBE_DEFFERED, and things break badly during cleanup. These are the fixes. This is fixing code in net-next. v2: Fix typo pointed out by David Miller ==================== Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
commit
f81a8a02bb
@ -413,19 +413,26 @@ static const struct irq_domain_ops mv88e6xxx_g1_irq_domain_ops = {
|
|||||||
static void mv88e6xxx_g1_irq_free(struct mv88e6xxx_chip *chip)
|
static void mv88e6xxx_g1_irq_free(struct mv88e6xxx_chip *chip)
|
||||||
{
|
{
|
||||||
int irq, virq;
|
int irq, virq;
|
||||||
|
u16 mask;
|
||||||
|
|
||||||
|
mv88e6xxx_g1_read(chip, GLOBAL_CONTROL, &mask);
|
||||||
|
mask |= GENMASK(chip->g1_irq.nirqs, 0);
|
||||||
|
mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, mask);
|
||||||
|
|
||||||
|
free_irq(chip->irq, chip);
|
||||||
|
|
||||||
for (irq = 0; irq < 16; irq++) {
|
for (irq = 0; irq < 16; irq++) {
|
||||||
virq = irq_find_mapping(chip->g2_irq.domain, irq);
|
virq = irq_find_mapping(chip->g1_irq.domain, irq);
|
||||||
irq_dispose_mapping(virq);
|
irq_dispose_mapping(virq);
|
||||||
}
|
}
|
||||||
|
|
||||||
irq_domain_remove(chip->g2_irq.domain);
|
irq_domain_remove(chip->g1_irq.domain);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int mv88e6xxx_g1_irq_setup(struct mv88e6xxx_chip *chip)
|
static int mv88e6xxx_g1_irq_setup(struct mv88e6xxx_chip *chip)
|
||||||
{
|
{
|
||||||
int err, irq;
|
int err, irq, virq;
|
||||||
u16 reg;
|
u16 reg, mask;
|
||||||
|
|
||||||
chip->g1_irq.nirqs = chip->info->g1_irqs;
|
chip->g1_irq.nirqs = chip->info->g1_irqs;
|
||||||
chip->g1_irq.domain = irq_domain_add_simple(
|
chip->g1_irq.domain = irq_domain_add_simple(
|
||||||
@ -440,32 +447,41 @@ static int mv88e6xxx_g1_irq_setup(struct mv88e6xxx_chip *chip)
|
|||||||
chip->g1_irq.chip = mv88e6xxx_g1_irq_chip;
|
chip->g1_irq.chip = mv88e6xxx_g1_irq_chip;
|
||||||
chip->g1_irq.masked = ~0;
|
chip->g1_irq.masked = ~0;
|
||||||
|
|
||||||
err = mv88e6xxx_g1_read(chip, GLOBAL_CONTROL, ®);
|
err = mv88e6xxx_g1_read(chip, GLOBAL_CONTROL, &mask);
|
||||||
if (err)
|
if (err)
|
||||||
goto out;
|
goto out_mapping;
|
||||||
|
|
||||||
reg &= ~GENMASK(chip->g1_irq.nirqs, 0);
|
mask &= ~GENMASK(chip->g1_irq.nirqs, 0);
|
||||||
|
|
||||||
err = mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, reg);
|
err = mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, mask);
|
||||||
if (err)
|
if (err)
|
||||||
goto out;
|
goto out_disable;
|
||||||
|
|
||||||
/* Reading the interrupt status clears (most of) them */
|
/* Reading the interrupt status clears (most of) them */
|
||||||
err = mv88e6xxx_g1_read(chip, GLOBAL_STATUS, ®);
|
err = mv88e6xxx_g1_read(chip, GLOBAL_STATUS, ®);
|
||||||
if (err)
|
if (err)
|
||||||
goto out;
|
goto out_disable;
|
||||||
|
|
||||||
err = request_threaded_irq(chip->irq, NULL,
|
err = request_threaded_irq(chip->irq, NULL,
|
||||||
mv88e6xxx_g1_irq_thread_fn,
|
mv88e6xxx_g1_irq_thread_fn,
|
||||||
IRQF_ONESHOT | IRQF_TRIGGER_FALLING,
|
IRQF_ONESHOT | IRQF_TRIGGER_FALLING,
|
||||||
dev_name(chip->dev), chip);
|
dev_name(chip->dev), chip);
|
||||||
if (err)
|
if (err)
|
||||||
goto out;
|
goto out_disable;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
out:
|
out_disable:
|
||||||
mv88e6xxx_g1_irq_free(chip);
|
mask |= GENMASK(chip->g1_irq.nirqs, 0);
|
||||||
|
mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, mask);
|
||||||
|
|
||||||
|
out_mapping:
|
||||||
|
for (irq = 0; irq < 16; irq++) {
|
||||||
|
virq = irq_find_mapping(chip->g1_irq.domain, irq);
|
||||||
|
irq_dispose_mapping(virq);
|
||||||
|
}
|
||||||
|
|
||||||
|
irq_domain_remove(chip->g1_irq.domain);
|
||||||
|
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
@ -3897,10 +3913,14 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev)
|
|||||||
out_mdio:
|
out_mdio:
|
||||||
mv88e6xxx_mdio_unregister(chip);
|
mv88e6xxx_mdio_unregister(chip);
|
||||||
out_g2_irq:
|
out_g2_irq:
|
||||||
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT))
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT) && chip->irq > 0)
|
||||||
mv88e6xxx_g2_irq_free(chip);
|
mv88e6xxx_g2_irq_free(chip);
|
||||||
out_g1_irq:
|
out_g1_irq:
|
||||||
mv88e6xxx_g1_irq_free(chip);
|
if (chip->irq > 0) {
|
||||||
|
mutex_lock(&chip->reg_lock);
|
||||||
|
mv88e6xxx_g1_irq_free(chip);
|
||||||
|
mutex_unlock(&chip->reg_lock);
|
||||||
|
}
|
||||||
out:
|
out:
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
@ -3914,9 +3934,11 @@ static void mv88e6xxx_remove(struct mdio_device *mdiodev)
|
|||||||
mv88e6xxx_unregister_switch(chip);
|
mv88e6xxx_unregister_switch(chip);
|
||||||
mv88e6xxx_mdio_unregister(chip);
|
mv88e6xxx_mdio_unregister(chip);
|
||||||
|
|
||||||
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT))
|
if (chip->irq > 0) {
|
||||||
mv88e6xxx_g2_irq_free(chip);
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT))
|
||||||
mv88e6xxx_g1_irq_free(chip);
|
mv88e6xxx_g2_irq_free(chip);
|
||||||
|
mv88e6xxx_g1_irq_free(chip);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static const struct of_device_id mv88e6xxx_of_match[] = {
|
static const struct of_device_id mv88e6xxx_of_match[] = {
|
||||||
|
@ -507,6 +507,9 @@ void mv88e6xxx_g2_irq_free(struct mv88e6xxx_chip *chip)
|
|||||||
{
|
{
|
||||||
int irq, virq;
|
int irq, virq;
|
||||||
|
|
||||||
|
free_irq(chip->device_irq, chip);
|
||||||
|
irq_dispose_mapping(chip->device_irq);
|
||||||
|
|
||||||
for (irq = 0; irq < 16; irq++) {
|
for (irq = 0; irq < 16; irq++) {
|
||||||
virq = irq_find_mapping(chip->g2_irq.domain, irq);
|
virq = irq_find_mapping(chip->g2_irq.domain, irq);
|
||||||
irq_dispose_mapping(virq);
|
irq_dispose_mapping(virq);
|
||||||
@ -517,8 +520,7 @@ void mv88e6xxx_g2_irq_free(struct mv88e6xxx_chip *chip)
|
|||||||
|
|
||||||
int mv88e6xxx_g2_irq_setup(struct mv88e6xxx_chip *chip)
|
int mv88e6xxx_g2_irq_setup(struct mv88e6xxx_chip *chip)
|
||||||
{
|
{
|
||||||
int device_irq;
|
int err, irq, virq;
|
||||||
int err, irq;
|
|
||||||
|
|
||||||
if (!chip->dev->of_node)
|
if (!chip->dev->of_node)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
@ -534,22 +536,28 @@ int mv88e6xxx_g2_irq_setup(struct mv88e6xxx_chip *chip)
|
|||||||
chip->g2_irq.chip = mv88e6xxx_g2_irq_chip;
|
chip->g2_irq.chip = mv88e6xxx_g2_irq_chip;
|
||||||
chip->g2_irq.masked = ~0;
|
chip->g2_irq.masked = ~0;
|
||||||
|
|
||||||
device_irq = irq_find_mapping(chip->g1_irq.domain,
|
chip->device_irq = irq_find_mapping(chip->g1_irq.domain,
|
||||||
GLOBAL_STATUS_IRQ_DEVICE);
|
GLOBAL_STATUS_IRQ_DEVICE);
|
||||||
if (device_irq < 0) {
|
if (chip->device_irq < 0) {
|
||||||
err = device_irq;
|
err = chip->device_irq;
|
||||||
goto out;
|
goto out;
|
||||||
}
|
}
|
||||||
|
|
||||||
err = devm_request_threaded_irq(chip->dev, device_irq, NULL,
|
err = request_threaded_irq(chip->device_irq, NULL,
|
||||||
mv88e6xxx_g2_irq_thread_fn,
|
mv88e6xxx_g2_irq_thread_fn,
|
||||||
IRQF_ONESHOT, "mv88e6xxx-g1", chip);
|
IRQF_ONESHOT, "mv88e6xxx-g1", chip);
|
||||||
if (err)
|
if (err)
|
||||||
goto out;
|
goto out;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
out:
|
out:
|
||||||
mv88e6xxx_g2_irq_free(chip);
|
for (irq = 0; irq < 16; irq++) {
|
||||||
|
virq = irq_find_mapping(chip->g2_irq.domain, irq);
|
||||||
|
irq_dispose_mapping(virq);
|
||||||
|
}
|
||||||
|
|
||||||
|
irq_domain_remove(chip->g2_irq.domain);
|
||||||
|
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
@ -714,6 +714,7 @@ struct mv88e6xxx_chip {
|
|||||||
struct mv88e6xxx_irq g1_irq;
|
struct mv88e6xxx_irq g1_irq;
|
||||||
struct mv88e6xxx_irq g2_irq;
|
struct mv88e6xxx_irq g2_irq;
|
||||||
int irq;
|
int irq;
|
||||||
|
int device_irq;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct mv88e6xxx_bus_ops {
|
struct mv88e6xxx_bus_ops {
|
||||||
|
Loading…
Reference in New Issue
Block a user