diff options
Diffstat (limited to 'bsps/arm/raspberrypi/start/bspstart.c')
-rw-r--r-- | bsps/arm/raspberrypi/start/bspstart.c | 24 |
1 files changed, 24 insertions, 0 deletions
diff --git a/bsps/arm/raspberrypi/start/bspstart.c b/bsps/arm/raspberrypi/start/bspstart.c index 49896e4d47..8d7f6aa503 100644 --- a/bsps/arm/raspberrypi/start/bspstart.c +++ b/bsps/arm/raspberrypi/start/bspstart.c @@ -23,6 +23,7 @@ #include <bsp/stackalloc.h> #include <bsp/raspberrypi.h> #include <bsp/vc.h> +#include <bsp/fdt.h> #include <libfdt.h> @@ -101,6 +102,29 @@ void *raspberrypi_get_reg_of_node(const void *fdt, int node) return (BUS_TO_PHY((void *) fdt32_to_cpu(val[0]))); } +#ifdef BSP_FDT_IS_SUPPORTED +uint32_t bsp_fdt_map_intr(const uint32_t *intr, size_t icells) +{ + uint32_t controller = intr[0]; + uint32_t source = intr[1]; + + switch ( controller ) { + case 0: + return source + BCM2835_IRQ_ID_BASIC_BASE_ID; + break; + case 1: + return source + BCM2835_IRQ_SET1_MIN; + break; + case 2: + return source + BCM2835_IRQ_SET2_MIN; + break; + default: + return BSP_INTERRUPT_VECTOR_INVALID; + break; + } +} +#endif /* BSP_FDT_IS_SUPPORTED */ + void bsp_start(void) { bcm2835_get_board_spec_entries spec = { 0 }; |