spmi: spmi-pmic-arb: Add support to set interrupt ownership

The MID_SEL register routes the interrupt to the configured MID.
On a multi-SOC system a PMIC interrupt may be assigned to
secondary SOC (on another MID). Make sure the interrupt gets
assigned to the right MID while registering for it.

Change-Id: I87cc890af051dbe8e1c81662800f1c39b50290da
Signed-off-by: Kiran Gunda <kgunda@codeaurora.org>
This commit is contained in:
Kiran Gunda 2021-03-19 17:09:57 +05:30 committed by Gerrit - the friendly Code Review server
parent a61e7f3481
commit 5beb4e66b9

View File

@ -1,5 +1,5 @@
// SPDX-License-Identifier: GPL-2.0-only
/* Copyright (c) 2012-2020, The Linux Foundation. All rights reserved. */
/* Copyright (c) 2012-2021, The Linux Foundation. All rights reserved. */
#include <linux/bitmap.h>
#include <linux/debugfs.h>
@ -157,6 +157,7 @@ struct spmi_pmic_arb {
u8 channel;
int irq;
u8 ee;
u8 mid;
u16 min_apid;
u16 max_apid;
u32 *mapping_table;
@ -463,6 +464,7 @@ enum qpnpint_regs {
QPNPINT_REG_EN_SET = 0x15,
QPNPINT_REG_EN_CLR = 0x16,
QPNPINT_REG_LATCHED_STS = 0x18,
QPNPINT_REG_MID_SEL = 0x1A,
};
struct spmi_pmic_arb_qpnpint_type {
@ -722,6 +724,13 @@ static int qpnpint_irq_domain_activate(struct irq_domain *domain,
return -ENODEV;
}
/*
* Make sure the interrupt is assigned to primary SOC by writing the
* MID value to MID_SEL register.
*/
if (pmic_arb->mid != EINVAL)
qpnpint_spmi_write(d, QPNPINT_REG_MID_SEL, &pmic_arb->mid, 1);
buf = BIT(irq);
qpnpint_spmi_write(d, QPNPINT_REG_EN_CLR, &buf, 1);
qpnpint_spmi_write(d, QPNPINT_REG_LATCHED_CLR, &buf, 1);
@ -1441,7 +1450,7 @@ static int spmi_pmic_arb_probe(struct platform_device *pdev)
struct resource *res;
void __iomem *core;
u32 *mapping_table;
u32 channel, ee, hw_ver;
u32 channel, ee, hw_ver, mid = 0;
int err;
ctrl = spmi_controller_alloc(&pdev->dev, sizeof(*pmic_arb));
@ -1556,6 +1565,17 @@ static int spmi_pmic_arb_probe(struct platform_device *pdev)
}
pmic_arb->ee = ee;
pmic_arb->mid = EINVAL;
err = of_property_read_u32(pdev->dev.of_node, "qcom,mid", &mid);
if (!err && mid <= 3) {
pmic_arb->mid = mid;
} else if (err != -EINVAL) {
dev_err(&pdev->dev, "invalid MID (%u) specified\n", mid);
err = -EINVAL;
goto err_put_ctrl;
}
mapping_table = devm_kcalloc(&ctrl->dev, PMIC_ARB_MAX_PERIPHS,
sizeof(*mapping_table), GFP_KERNEL);
if (!mapping_table) {