mirror of
https://github.com/torvalds/linux.git
synced 2026-07-30 03:01:41 +02:00
soc: qcom: smp2p: Introduce pending state for virtual irq
If a smp2p change occurs while a virtual interrupt is disabled, smp2p should be able to resend that interrupt on enablement. This functionality requires the CONFIG_HARDIRQS_SW_RESEND to be enabled to reschedule the interrupts. To ensure the mask and unmask functions are called during enabled and disable, set the flag to disable lazy IRQ state handling (IRQ_DISABLE_UNLAZY). Change-Id: I75c662c61a9705c05278d238ca51f7a2e74806d8 Signed-off-by: Chris Lew <quic_clew@quicinc.com>
This commit is contained in:
parent
5e0454ded5
commit
ea4d918f70
|
|
@ -2,6 +2,7 @@
|
|||
/*
|
||||
* Copyright (c) 2015, Sony Mobile Communications AB.
|
||||
* Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
|
||||
* Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
|
||||
*/
|
||||
|
||||
#include <linux/interrupt.h>
|
||||
|
|
@ -101,6 +102,7 @@ struct smp2p_entry {
|
|||
|
||||
struct irq_domain *domain;
|
||||
DECLARE_BITMAP(irq_enabled, 32);
|
||||
DECLARE_BITMAP(irq_pending, 32);
|
||||
DECLARE_BITMAP(irq_rising, 32);
|
||||
DECLARE_BITMAP(irq_falling, 32);
|
||||
|
||||
|
|
@ -146,6 +148,7 @@ struct qcom_smp2p {
|
|||
unsigned local_pid;
|
||||
unsigned remote_pid;
|
||||
|
||||
int irq;
|
||||
struct regmap *ipc_regmap;
|
||||
int ipc_offset;
|
||||
int ipc_bit;
|
||||
|
|
@ -217,8 +220,8 @@ static void qcom_smp2p_notify_in(struct qcom_smp2p *smp2p)
|
|||
{
|
||||
struct smp2p_smem_item *in;
|
||||
struct smp2p_entry *entry;
|
||||
unsigned long status;
|
||||
int irq_pin;
|
||||
u32 status;
|
||||
char buf[SMP2P_MAX_ENTRY_NAME];
|
||||
u32 val;
|
||||
int i;
|
||||
|
|
@ -247,19 +250,22 @@ static void qcom_smp2p_notify_in(struct qcom_smp2p *smp2p)
|
|||
|
||||
status = val ^ entry->last_value;
|
||||
entry->last_value = val;
|
||||
status |= *entry->irq_pending;
|
||||
|
||||
/* No changes of this entry? */
|
||||
if (!status)
|
||||
continue;
|
||||
|
||||
for_each_set_bit(i, entry->irq_enabled, 32) {
|
||||
if (!(status & BIT(i)))
|
||||
continue;
|
||||
|
||||
for_each_set_bit(i, &status, 32) {
|
||||
if ((val & BIT(i) && test_bit(i, entry->irq_rising)) ||
|
||||
(!(val & BIT(i)) && test_bit(i, entry->irq_falling))) {
|
||||
irq_pin = irq_find_mapping(entry->domain, i);
|
||||
handle_nested_irq(irq_pin);
|
||||
|
||||
if (test_bit(i, entry->irq_enabled))
|
||||
clear_bit(i, entry->irq_pending);
|
||||
else
|
||||
set_bit(i, entry->irq_pending);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
@ -365,6 +371,8 @@ static int smp2p_irq_map(struct irq_domain *d,
|
|||
irq_set_chip_data(irq, entry);
|
||||
irq_set_nested_thread(irq, 1);
|
||||
irq_set_noprobe(irq);
|
||||
irq_set_parent(irq, entry->smp2p->irq);
|
||||
irq_set_status_flags(irq, IRQ_DISABLE_UNLAZY);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -608,6 +616,7 @@ static int qcom_smp2p_probe(struct platform_device *pdev)
|
|||
/* Kick the outgoing edge after allocating entries */
|
||||
qcom_smp2p_kick(smp2p);
|
||||
|
||||
smp2p->irq = irq;
|
||||
ret = devm_request_threaded_irq(&pdev->dev, irq,
|
||||
NULL, qcom_smp2p_intr,
|
||||
IRQF_ONESHOT,
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user