Merge "spmi-pmic-arb: add support to dispatch interrupt based on IRQ status" (16ea9c0a) · Commits · e / devices / android_kernel_fairphone_FP3

drivers/spmi/spmi-pmic-arb.c

+28 −0

Original line number	Diff line number	Diff line
		@@ -576,10 +576,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);
		@@ -595,6 +601,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)