Merge "spmi-pmic-arb: add support to dispatch interrupt based on IRQ status"
This commit is contained in:
commit
73f6909d54
1 changed files with 28 additions and 0 deletions
|
@ -577,10 +577,16 @@ static void __pmic_arb_chained_irq(struct spmi_pmic_arb *pa, bool show)
|
|||
int last = pa->max_apid >> 5;
|
||||
u32 status, enable;
|
||||
int i, id, apid;
|
||||
/* status based dispatch */
|
||||
bool acc_valid = false;
|
||||
u32 irq_status = 0;
|
||||
|
||||
for (i = first; i <= last; ++i) {
|
||||
status = readl_relaxed(pa->acc_status +
|
||||
pa->ver_ops->owner_acc_status(pa->ee, i));
|
||||
if (status)
|
||||
acc_valid = true;
|
||||
|
||||
while (status) {
|
||||
id = ffs(status) - 1;
|
||||
status &= ~BIT(id);
|
||||
|
@ -591,6 +597,28 @@ static void __pmic_arb_chained_irq(struct spmi_pmic_arb *pa, bool show)
|
|||
periph_interrupt(pa, apid, show);
|
||||
}
|
||||
}
|
||||
|
||||
/* ACC_STATUS is empty but IRQ fired check IRQ_STATUS */
|
||||
if (!acc_valid) {
|
||||
for (i = pa->min_apid; i <= pa->max_apid; i++) {
|
||||
/* skip if APPS is not irq owner */
|
||||
if (pa->apid_data[i].irq_owner != pa->ee)
|
||||
continue;
|
||||
|
||||
irq_status = readl_relaxed(pa->intr +
|
||||
pa->ver_ops->irq_status(i));
|
||||
if (irq_status) {
|
||||
enable = readl_relaxed(pa->intr +
|
||||
pa->ver_ops->acc_enable(i));
|
||||
if (enable & SPMI_PIC_ACC_ENABLE_BIT) {
|
||||
dev_dbg(&pa->spmic->dev,
|
||||
"Dispatching IRQ for apid=%d status=%x\n",
|
||||
i, irq_status);
|
||||
periph_interrupt(pa, i, show);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void pmic_arb_chained_irq(struct irq_desc *desc)
|
||||
|
|
Loading…
Add table
Reference in a new issue