diff options
author | Anup Patel <anup.patel@wdc.com> | 2020-04-24 14:26:33 +0300 |
---|---|---|
committer | Anup Patel <anup@brainfault.org> | 2020-05-01 07:30:35 +0300 |
commit | 75322a634bc8494fc5cf0f5290c81e1100789631 (patch) | |
tree | 82633439ff683b2dd6fe79a729b287d3d8f0df6d /lib | |
parent | 76f0f814075338970c7e7914ab94644e855632f7 (diff) | |
download | opensbi-75322a634bc8494fc5cf0f5290c81e1100789631.tar.xz |
lib: utils: Add simple FDT irqchip framework
We add simple irqchip framework which will select and use irqchip driver
based on details in FDT passed by previous booting stage.
Signed-off-by: Anup Patel <anup.patel@wdc.com>
Reviewed-by: Atish Patra <atish.patra@wdc.com>
Diffstat (limited to 'lib')
-rw-r--r-- | lib/utils/irqchip/fdt_irqchip.c | 72 | ||||
-rw-r--r-- | lib/utils/irqchip/fdt_irqchip_plic.c | 110 | ||||
-rw-r--r-- | lib/utils/irqchip/objects.mk | 2 |
3 files changed, 184 insertions, 0 deletions
diff --git a/lib/utils/irqchip/fdt_irqchip.c b/lib/utils/irqchip/fdt_irqchip.c new file mode 100644 index 0000000..5f5cf97 --- /dev/null +++ b/lib/utils/irqchip/fdt_irqchip.c @@ -0,0 +1,72 @@ +/* + * SPDX-License-Identifier: BSD-2-Clause + * + * Copyright (c) 2020 Western Digital Corporation or its affiliates. + * + * Authors: + * Anup Patel <anup.patel@wdc.com> + */ + +#include <sbi/sbi_scratch.h> +#include <sbi_utils/fdt/fdt_helper.h> +#include <sbi_utils/irqchip/fdt_irqchip.h> + +extern struct fdt_irqchip fdt_irqchip_plic; + +static struct fdt_irqchip *irqchip_drivers[] = { + &fdt_irqchip_plic +}; + +static struct fdt_irqchip *current_driver = NULL; + +void fdt_irqchip_exit(void) +{ + if (current_driver && current_driver->exit) + current_driver->exit(); +} + +static int fdt_irqchip_warm_init(void) +{ + if (current_driver && current_driver->warm_init) + return current_driver->warm_init(); + return 0; +} + +static int fdt_irqchip_cold_init(void) +{ + int pos, noff, rc; + struct fdt_irqchip *drv; + const struct fdt_match *match; + void *fdt = sbi_scratch_thishart_arg1_ptr(); + + for (pos = 0; pos < array_size(irqchip_drivers); pos++) { + drv = irqchip_drivers[pos]; + + noff = fdt_find_match(fdt, drv->match_table, &match); + if (noff < 0) + continue; + + if (drv->cold_init) { + rc = drv->cold_init(fdt, noff, match); + if (rc) + return rc; + } + current_driver = drv; + break; + } + + return 0; +} + +int fdt_irqchip_init(bool cold_boot) +{ + int rc; + + if (cold_boot) { + rc = fdt_irqchip_cold_init(); + if (rc) + return rc; + } + + return fdt_irqchip_warm_init(); +} diff --git a/lib/utils/irqchip/fdt_irqchip_plic.c b/lib/utils/irqchip/fdt_irqchip_plic.c new file mode 100644 index 0000000..5bac6a7 --- /dev/null +++ b/lib/utils/irqchip/fdt_irqchip_plic.c @@ -0,0 +1,110 @@ +/* + * SPDX-License-Identifier: BSD-2-Clause + * + * Copyright (c) 2020 Western Digital Corporation or its affiliates. + * + * Authors: + * Anup Patel <anup.patel@wdc.com> + */ + +#include <libfdt.h> +#include <sbi/riscv_asm.h> +#include <sbi/sbi_error.h> +#include <sbi/sbi_hartmask.h> +#include <sbi_utils/fdt/fdt_helper.h> +#include <sbi_utils/irqchip/fdt_irqchip.h> +#include <sbi_utils/irqchip/plic.h> + +static int plic_hartid2context[SBI_HARTMASK_MAX_BITS][2]; + +static int irqchip_plic_warm_init(void) +{ + u32 hartid = current_hartid(); + + return plic_warm_irqchip_init(hartid, + plic_hartid2context[hartid][0], + plic_hartid2context[hartid][1]); +} + +static int irqchip_plic_parse_hartid2context(void *fdt, int nodeoff) +{ + const fdt32_t *val; + u32 phandle, hwirq, hartid; + int i, err, count, cpu_offset, cpu_intc_offset; + + for (i = 0; i < SBI_HARTMASK_MAX_BITS; i++) { + plic_hartid2context[i][0] = -1; + plic_hartid2context[i][1] = -1; + } + + val = fdt_getprop(fdt, nodeoff, "interrupts-extended", &count); + if (!val || count < sizeof(fdt32_t)) + return SBI_EINVAL; + count = count / sizeof(fdt32_t); + + for (i = 0; i < count; i += 2) { + phandle = fdt32_to_cpu(val[i]); + hwirq = fdt32_to_cpu(val[i + 1]); + + cpu_intc_offset = fdt_node_offset_by_phandle(fdt, phandle); + if (cpu_intc_offset < 0) + continue; + + cpu_offset = fdt_parent_offset(fdt, cpu_intc_offset); + if (cpu_intc_offset < 0) + continue; + + err = fdt_parse_hart_id(fdt, cpu_offset, &hartid); + if (err) + continue; + + if (SBI_HARTMASK_MAX_BITS <= hartid) + continue; + + switch (hwirq) { + case IRQ_M_EXT: + plic_hartid2context[hartid][0] = i / 2; + break; + case IRQ_S_EXT: + plic_hartid2context[hartid][1] = i / 2; + break; + } + } + + return 0; +} + +static int irqchip_plic_cold_init(void *fdt, int nodeoff, + const struct fdt_match *match) +{ + int rc; + u32 max_hartid; + struct platform_plic_data plic; + + rc = fdt_parse_max_hart_id(fdt, &max_hartid); + if (rc) + return rc; + + rc = fdt_parse_plic_node(fdt, nodeoff, &plic); + if (rc) + return rc; + + rc = plic_cold_irqchip_init(plic.addr, plic.num_src, max_hartid + 1); + if (rc) + return rc; + + return irqchip_plic_parse_hartid2context(fdt, nodeoff); +} + +static const struct fdt_match irqchip_plic_match[] = { + { .compatible = "riscv,plic0" }, + { .compatible = "sifive,plic-1.0.0" }, + { }, +}; + +struct fdt_irqchip fdt_irqchip_plic = { + .match_table = irqchip_plic_match, + .cold_init = irqchip_plic_cold_init, + .warm_init = irqchip_plic_warm_init, + .exit = NULL, +}; diff --git a/lib/utils/irqchip/objects.mk b/lib/utils/irqchip/objects.mk index e3a0902..934f706 100644 --- a/lib/utils/irqchip/objects.mk +++ b/lib/utils/irqchip/objects.mk @@ -7,4 +7,6 @@ # Anup Patel <anup.patel@wdc.com> # +libsbiutils-objs-y += irqchip/fdt_irqchip.o +libsbiutils-objs-y += irqchip/fdt_irqchip_plic.o libsbiutils-objs-y += irqchip/plic.o |