diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-09-28 09:29:38 +0200 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-10-02 13:40:56 +0200 |
commit | 7e195e66c751523d7f2bcf0b45f7d6823d87ca97 (patch) | |
tree | 190cc7cc6164815144c2d2609e58dc970b7ae8b8 /c/src/lib/libbsp/arm/imx/startup/bspstart.c | |
parent | i2c: Add temperature sensor LM75A driver (diff) | |
download | rtems-7e195e66c751523d7f2bcf0b45f7d6823d87ca97.tar.bz2 |
bsp/imx: Add imx_get_irq_of_node()
Update #3090.
Diffstat (limited to 'c/src/lib/libbsp/arm/imx/startup/bspstart.c')
-rw-r--r-- | c/src/lib/libbsp/arm/imx/startup/bspstart.c | 30 |
1 files changed, 22 insertions, 8 deletions
diff --git a/c/src/lib/libbsp/arm/imx/startup/bspstart.c b/c/src/lib/libbsp/arm/imx/startup/bspstart.c index f715726fb0..167dc9c8d5 100644 --- a/c/src/lib/libbsp/arm/imx/startup/bspstart.c +++ b/c/src/lib/libbsp/arm/imx/startup/bspstart.c @@ -21,9 +21,28 @@ #include <libfdt.h> +#define MAGIC_IRQ_OFFSET 32 + +rtems_vector_number imx_get_irq_of_node( + const void *fdt, + int node, + size_t index +) +{ + int len; + const uint32_t *val; + + val = fdt_getprop(fdt, node, "interrupts", &len); + if (val == NULL || len < (int) ((index + 1) * 12)) { + return UINT32_MAX; + } + + return fdt32_to_cpu(val[index * 3 + 1]) + MAGIC_IRQ_OFFSET; +} + uint32_t bsp_fdt_map_intr(const uint32_t *intr, size_t icells) { - return intr[1] + 32; + return intr[1] + MAGIC_IRQ_OFFSET; } void arm_generic_timer_get_config( @@ -46,13 +65,8 @@ void arm_generic_timer_get_config( bsp_fatal(IMX_FATAL_GENERIC_TIMER_FREQUENCY); } - val = fdt_getprop(fdt, node, "interrupts", &len); - if (val != NULL && len >= 8) { - /* FIXME: Figure out how Linux gets a proper IRQ number */ - *irq = 16 + fdt32_to_cpu(val[1]); - } else { - bsp_fatal(IMX_FATAL_GENERIC_TIMER_IRQ); - } + /* FIXME: Figure out how Linux gets a proper IRQ number */ + *irq = imx_get_irq_of_node(fdt, node, 0) - 16; } void bsp_start(void) |