Skip to content

Commit

Permalink
arch: sw_isr: store device info in the table and add funtions to access
Browse files Browse the repository at this point in the history 
Change the internal function to `get_parent_entry`, which
returns the entire entry of table.

Store the parent interrupt controller device in the
`irq_parent_offset` table, and added 2 helper functions to:

1. determine the parent interrupt controller based on the IRQ
2. determine the IRQ of the parent interrupt controller

Declare the `struct _irq_parent_entry` in the header and added
`-` suffix to the struct so that it can be used to test the
functions in testsuites.

Signed-off-by: Yong Cong Sin <[email protected]>
  • Loading branch information
@ycsin
ycsin committed Sep 28, 2023
1 parent efecff5 commit f66a225
Show file tree
Hide file tree
Showing 2 changed files with 122 additions and 22 deletions.
118 changes: 96 additions & 22 deletions arch/common/sw_isr_common.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -16,12 +16,30 @@

#ifdef CONFIG_MULTI_LEVEL_INTERRUPTS

struct irq_parent_offset {
unsigned int irq;
unsigned int offset;
};
/* Get 2nd level interrupt controllers */
#define _FILTER_INTC(node_id) \
COND_CODE_1(DT_NODE_HAS_PROP(node_id, interrupt_controller), \
(DT_PROP_OR(node_id, interrupts_extended, 0)), (0))
/* Get the interrupt controller that has IRQN equals to `irq` */
#define _FILTER_IRQ(node_id, irq) IS_EQ(DT_IRQN(node_id), irq)
/*
* Get the interrupt controller that match both of the filters above,
* resolves to nothing otherwise
*/
#define _GET_DEV(node_id, irq) \
COND_CODE_1(_FILTER_INTC(node_id), \
(COND_CODE_1(_FILTER_IRQ(node_id, irq), (DEVICE_DT_GET(node_id)), ())), ())
/*
* Loop through all the nodes and get device with `irq` as IRQN,
* this assumes no more than 1 device can share the same IRQN
*/
#define INTC_DEVICE_DT_IRQN_GET(irq) DT_FOREACH_STATUS_OKAY_NODE_VARGS(_GET_DEV, irq)

/* If can't find any matching interrupt controller, fills with `NULL` */
#define INTC_DEVICE_OR_NULL(d) COND_CODE_0(IS_EMPTY(d), (d), (NULL))

#define INIT_IRQ_PARENT_OFFSET(i, o) { \
#define INIT_IRQ_PARENT_OFFSET(d, i, o) { \
.dev = INTC_DEVICE_OR_NULL(d), \
.irq = i, \
.offset = o, \
}
Expand All @@ -31,9 +49,9 @@ struct irq_parent_offset {
#ifdef CONFIG_2ND_LEVEL_INTERRUPTS

#define CAT_2ND_LVL_LIST(i, base) \
INIT_IRQ_PARENT_OFFSET(CONFIG_2ND_LVL_INTR_0##i##_OFFSET, \
IRQ_INDEX_TO_OFFSET(i, base))
static struct irq_parent_offset lvl2_irq_list[CONFIG_NUM_2ND_LEVEL_AGGREGATORS]
INIT_IRQ_PARENT_OFFSET(INTC_DEVICE_DT_IRQN_GET(CONFIG_2ND_LVL_INTR_0##i##_OFFSET), \
CONFIG_2ND_LVL_INTR_0##i##_OFFSET, IRQ_INDEX_TO_OFFSET(i, base))
const struct _irq_parent_entry _lvl2_irq_list[CONFIG_NUM_2ND_LEVEL_AGGREGATORS]
= { LISTIFY(CONFIG_NUM_2ND_LEVEL_AGGREGATORS, CAT_2ND_LVL_LIST, (,),
CONFIG_2ND_LVL_ISR_TBL_OFFSET) };

Expand All @@ -42,57 +60,113 @@ static struct irq_parent_offset lvl2_irq_list[CONFIG_NUM_2ND_LEVEL_AGGREGATORS]
#ifdef CONFIG_3RD_LEVEL_INTERRUPTS

#define CAT_3RD_LVL_LIST(i, base) \
INIT_IRQ_PARENT_OFFSET(CONFIG_3RD_LVL_INTR_0##i##_OFFSET, \
IRQ_INDEX_TO_OFFSET(i, base))
static struct irq_parent_offset lvl3_irq_list[CONFIG_NUM_3RD_LEVEL_AGGREGATORS]
INIT_IRQ_PARENT_OFFSET(INTC_DEVICE_DT_IRQN_GET(CONFIG_3RD_LVL_INTR_0##i##_OFFSET), \
CONFIG_3RD_LVL_INTR_0##i##_OFFSET, IRQ_INDEX_TO_OFFSET(i, base))
const struct _irq_parent_entry _lvl3_irq_list[CONFIG_NUM_3RD_LEVEL_AGGREGATORS]
= { LISTIFY(CONFIG_NUM_3RD_LEVEL_AGGREGATORS, CAT_3RD_LVL_LIST, (,),
CONFIG_3RD_LVL_ISR_TBL_OFFSET) };

#endif /* CONFIG_3RD_LEVEL_INTERRUPTS */

static unsigned int get_parent_offset(unsigned int parent_irq,
struct irq_parent_offset list[],
static const struct _irq_parent_entry *get_parent_entry(unsigned int parent_irq,
const struct _irq_parent_entry list[],
unsigned int length)
{
unsigned int i;
unsigned int offset = 0U;
const struct _irq_parent_entry *entry = NULL;

for (i = 0U; i < length; ++i) {
if (list[i].irq == parent_irq) {
offset = list[i].offset;
entry = &list[i];
break;
}
}

__ASSERT(i != length, "Invalid argument: %i", parent_irq);

return offset;
return entry;
}

#endif /* CONFIG_MULTI_LEVEL_INTERRUPTS */

const struct device *z_get_sw_isr_device_from_irq(unsigned int irq)
{
const struct device *dev = NULL;

#ifdef CONFIG_MULTI_LEVEL_INTERRUPTS
unsigned int level, parent_irq;
const struct _irq_parent_entry *entry = NULL;

level = irq_get_level(irq);

if (level == 2U) {
parent_irq = irq_parent_level_2(irq);
entry = get_parent_entry(parent_irq,
_lvl2_irq_list,
CONFIG_NUM_2ND_LEVEL_AGGREGATORS);
}
#ifdef CONFIG_3RD_LEVEL_INTERRUPTS
else if (level == 3U) {
parent_irq = irq_parent_level_3(irq);
entry = get_parent_entry(parent_irq,
_lvl3_irq_list,
CONFIG_NUM_3RD_LEVEL_AGGREGATORS);
}
#endif /* CONFIG_3RD_LEVEL_INTERRUPTS */
dev = entry != NULL ? entry->dev : NULL;
#endif /* CONFIG_MULTI_LEVEL_INTERRUPTS */

return dev;
}

unsigned int z_get_sw_isr_irq_from_device(const struct device *dev)
{
#ifdef CONFIG_MULTI_LEVEL_INTERRUPTS
for (size_t i = 0U; i < CONFIG_NUM_2ND_LEVEL_AGGREGATORS; ++i) {
if (_lvl2_irq_list[i].dev == dev) {
return _lvl2_irq_list[i].irq;
}
}

#ifdef CONFIG_3RD_LEVEL_INTERRUPTS
for (size_t i = 0U; i < CONFIG_NUM_3RD_LEVEL_AGGREGATORS; ++i) {
if (_lvl3_irq_list[i].dev == dev) {
return _lvl3_irq_list[i].irq;
}
}
#endif /* CONFIG_3RD_LEVEL_INTERRUPTS */
#else
ARG_UNUSED(dev);
#endif

return 0;
}

unsigned int z_get_sw_isr_table_idx(unsigned int irq)
{
unsigned int table_idx;

#ifdef CONFIG_MULTI_LEVEL_INTERRUPTS
unsigned int level, parent_irq, parent_offset;
const struct _irq_parent_entry *entry = NULL;

level = irq_get_level(irq);

if (level == 2U) {
parent_irq = irq_parent_level_2(irq);
parent_offset = get_parent_offset(parent_irq,
lvl2_irq_list,
CONFIG_NUM_2ND_LEVEL_AGGREGATORS);
entry = get_parent_entry(parent_irq,
_lvl2_irq_list,
CONFIG_NUM_2ND_LEVEL_AGGREGATORS);
parent_offset = entry != NULL ? entry->offset : 0U;
table_idx = parent_offset + irq_from_level_2(irq);
}
#ifdef CONFIG_3RD_LEVEL_INTERRUPTS
else if (level == 3U) {
parent_irq = irq_parent_level_3(irq);
parent_offset = get_parent_offset(parent_irq,
lvl3_irq_list,
CONFIG_NUM_3RD_LEVEL_AGGREGATORS);
entry = get_parent_entry(parent_irq,
_lvl3_irq_list,
CONFIG_NUM_3RD_LEVEL_AGGREGATORS);
parent_offset = entry != NULL ? entry->offset : 0U;
table_idx = parent_offset + irq_from_level_3(irq);
}
#endif /* CONFIG_3RD_LEVEL_INTERRUPTS */
Expand Down
26 changes: 26 additions & 0 deletions include/zephyr/sw_isr_table.h
View file
Original file line number Diff line number Diff line change
Expand Up @@ -15,6 +15,7 @@
#define ZEPHYR_INCLUDE_SW_ISR_TABLE_H_

#if !defined(_ASMLANGUAGE)
#include <zephyr/device.h>
#include <zephyr/types.h>
#include <zephyr/toolchain.h>

Expand Down Expand Up @@ -43,6 +44,12 @@ struct _isr_table_entry {
*/
extern struct _isr_table_entry _sw_isr_table[];

struct _irq_parent_entry {
const struct device *dev;
unsigned int irq;
unsigned int offset;
};

/*
* Data structure created in a special binary .intlist section for each
* configured interrupt. gen_irq_tables.py pulls this out of the binary and
Expand Down Expand Up @@ -87,6 +94,25 @@ extern struct z_shared_isr_table_entry z_shared_sw_isr_table[];
*/
unsigned int z_get_sw_isr_table_idx(unsigned int irq);

/**
* @brief Helper function used to get the parent interrupt controller device based on passed IRQ.
*
* @param irq IRQ number in its zephyr format
*
* @return corresponding interrupt controller device in _sw_isr_table
*/
const struct device *z_get_sw_isr_device_from_irq(unsigned int irq);

/**
* @brief Helper function used to get the IRQN of the passed in parent interrupt
* controller device.
*
* @param dev parent interrupt controller device
*
* @return IRQN of the interrupt controller
*/
unsigned int z_get_sw_isr_irq_from_device(const struct device *dev);

/** This interrupt gets put directly in the vector table */
#define ISR_FLAG_DIRECT BIT(0)

Expand Down

0 comments on commit f66a225

Please sign in to comment.