[PATCH v2 12/13] lib: utils/irqchip: Add FDT based driver for APLIC
Anup Patel
anup at brainfault.org
Tue Feb 15 06:57:50 PST 2022
On Sat, Feb 12, 2022 at 6:26 AM Atish Patra <atishp at atishpatra.org> wrote:
>
> On Wed, Feb 9, 2022 at 7:06 AM Anup Patel <apatel at ventanamicro.com> wrote:
> >
> > We add simple FDT irqchip driver for APLIC so that generic platform (and
> > other FDT based platforms) can utilize common APLIC initialization library.
> >
> > Signed-off-by: Anup Patel <anup.patel at wdc.com>
> > Signed-off-by: Anup Patel <apatel at ventanamicro.com>
> > ---
> > include/sbi_utils/fdt/fdt_helper.h | 4 +
> > lib/utils/fdt/fdt_helper.c | 159 ++++++++++++++++++++++++++
> > lib/utils/irqchip/fdt_irqchip.c | 2 +
> > lib/utils/irqchip/fdt_irqchip_aplic.c | 56 +++++++++
> > lib/utils/irqchip/objects.mk | 1 +
> > 5 files changed, 222 insertions(+)
> > create mode 100644 lib/utils/irqchip/fdt_irqchip_aplic.c
> >
> > diff --git a/include/sbi_utils/fdt/fdt_helper.h b/include/sbi_utils/fdt/fdt_helper.h
> > index 4c8d29e..1232b26 100644
> > --- a/include/sbi_utils/fdt/fdt_helper.h
> > +++ b/include/sbi_utils/fdt/fdt_helper.h
> > @@ -68,6 +68,10 @@ int fdt_parse_uart8250_node(void *fdt, int nodeoffset,
> > int fdt_parse_uart8250(void *fdt, struct platform_uart_data *uart,
> > const char *compatible);
> >
> > +struct aplic_data;
> > +
> > +int fdt_parse_aplic_node(void *fdt, int nodeoff, struct aplic_data *aplic);
> > +
> > struct imsic_data;
> >
> > bool fdt_check_imsic_mlevel(void *fdt);
> > diff --git a/lib/utils/fdt/fdt_helper.c b/lib/utils/fdt/fdt_helper.c
> > index e179b79..3a306cb 100644
> > --- a/lib/utils/fdt/fdt_helper.c
> > +++ b/lib/utils/fdt/fdt_helper.c
> > @@ -13,6 +13,7 @@
> > #include <sbi/sbi_platform.h>
> > #include <sbi/sbi_scratch.h>
> > #include <sbi_utils/fdt/fdt_helper.h>
> > +#include <sbi_utils/irqchip/aplic.h>
> > #include <sbi_utils/irqchip/imsic.h>
> > #include <sbi_utils/irqchip/plic.h>
> >
> > @@ -466,6 +467,164 @@ int fdt_parse_uart8250(void *fdt, struct platform_uart_data *uart,
> > return fdt_parse_uart8250_node(fdt, nodeoffset, uart);
> > }
> >
> > +int fdt_parse_aplic_node(void *fdt, int nodeoff, struct aplic_data *aplic)
> > +{
> > + bool child_found;
> > + const fdt32_t *val;
> > + const fdt32_t *del;
> > + struct imsic_data imsic;
> > + int i, j, d, dcnt, len, noff, rc;
> > + uint64_t reg_addr, reg_size;
> > + struct aplic_delegate_data *deleg;
> > +
> > + if (nodeoff < 0 || !aplic || !fdt)
> > + return SBI_ENODEV;
> > + memset(aplic, 0, sizeof(*aplic));
> > +
> > + rc = fdt_get_node_addr_size(fdt, nodeoff, 0, ®_addr, ®_size);
> > + if (rc < 0 || !reg_addr || !reg_size)
> > + return SBI_ENODEV;
> > + aplic->addr = reg_addr;
> > + aplic->size = reg_size;
> > +
> > + val = fdt_getprop(fdt, nodeoff, "riscv,num-sources", &len);
> > + if (len > 0)
> > + aplic->num_source = fdt32_to_cpu(*val);
> > +
> > + val = fdt_getprop(fdt, nodeoff, "interrupts-extended", &len);
> > + if (val && len > sizeof(fdt32_t)) {
> > + len = len / sizeof(fdt32_t);
> > + for (i = 0; i < len; i += 2) {
> > + if (fdt32_to_cpu(val[i + 1]) == IRQ_M_EXT) {
> > + aplic->targets_mmode = true;
> > + break;
> > + }
> > + }
> > + aplic->num_idc = len / 2;
> > + goto aplic_msi_parent_done;
> > + }
> > +
> > + val = fdt_getprop(fdt, nodeoff, "msi-parent", &len);
> > + if (val && len >= sizeof(fdt32_t)) {
> > + noff = fdt_node_offset_by_phandle(fdt, fdt32_to_cpu(*val));
> > + if (noff < 0)
> > + return noff;
> > +
> > + rc = fdt_parse_imsic_node(fdt, noff, &imsic);
> > + if (rc)
> > + return rc;
> > +
> > + rc = imsic_data_check(&imsic);
> > + if (rc)
> > + return rc;
> > +
> > + aplic->targets_mmode = imsic.targets_mmode;
> > +
> > + if (imsic.targets_mmode) {
> > + aplic->has_msicfg_mmode = true;
> > + aplic->msicfg_mmode.lhxs = imsic.guest_index_bits;
> > + aplic->msicfg_mmode.lhxw = imsic.hart_index_bits;
> > + aplic->msicfg_mmode.hhxw = imsic.group_index_bits;
> > + aplic->msicfg_mmode.hhxs = imsic.group_index_shift;
> > + if (aplic->msicfg_mmode.hhxs <
> > + (2 * IMSIC_MMIO_PAGE_SHIFT))
> > + return SBI_EINVAL;
> > + aplic->msicfg_mmode.hhxs -= 24;
> > + aplic->msicfg_mmode.base_addr = imsic.regs[0].addr;
> > + } else {
> > + goto aplic_msi_parent_done;
> > + }
> > +
> > + val = fdt_getprop(fdt, nodeoff, "riscv,children", &len);
> > + if (!val || len < sizeof(fdt32_t))
> > + goto aplic_msi_parent_done;
> > +
> > + noff = fdt_node_offset_by_phandle(fdt, fdt32_to_cpu(*val));
> > + if (noff < 0)
> > + return noff;
> > +
> > + val = fdt_getprop(fdt, noff, "msi-parent", &len);
> > + if (!val || len < sizeof(fdt32_t))
> > + goto aplic_msi_parent_done;
> > +
> > + noff = fdt_node_offset_by_phandle(fdt, fdt32_to_cpu(*val));
> > + if (noff < 0)
> > + return noff;
> > +
> > + rc = fdt_parse_imsic_node(fdt, noff, &imsic);
> > + if (rc)
> > + return rc;
> > +
> > + rc = imsic_data_check(&imsic);
> > + if (rc)
> > + return rc;
> > +
> > + if (!imsic.targets_mmode) {
> > + aplic->has_msicfg_smode = true;
> > + aplic->msicfg_smode.lhxs = imsic.guest_index_bits;
> > + aplic->msicfg_smode.lhxw = imsic.hart_index_bits;
> > + aplic->msicfg_smode.hhxw = imsic.group_index_bits;
> > + aplic->msicfg_smode.hhxs = imsic.group_index_shift;
> > + if (aplic->msicfg_smode.hhxs <
> > + (2 * IMSIC_MMIO_PAGE_SHIFT))
> > + return SBI_EINVAL;
> > + aplic->msicfg_smode.hhxs -= 24;
> > + aplic->msicfg_smode.base_addr = imsic.regs[0].addr;
> > + }
> > + }
> > +aplic_msi_parent_done:
> > +
> > + for (d = 0; d < APLIC_MAX_DELEGATE; d++) {
> > + deleg = &aplic->delegate[d];
> > + deleg->first_irq = 0;
> > + deleg->last_irq = 0;
> > + deleg->child_index = 0;
> > + }
> > +
> > + del = fdt_getprop(fdt, nodeoff, "riscv,delegate", &len);
> > + if (!del || len < (3 * sizeof(fdt32_t)))
> > + goto skip_delegate_parse;
> > + d = 0;
> > + dcnt = len / sizeof(fdt32_t);
> > + for (i = 0; i < dcnt; i += 3) {
> > + if (d >= APLIC_MAX_DELEGATE)
> > + break;
> > + deleg = &aplic->delegate[d];
> > +
> > + deleg->first_irq = fdt32_to_cpu(del[i + 1]);
> > + deleg->last_irq = fdt32_to_cpu(del[i + 2]);
> > + deleg->child_index = 0;
> > +
> > + child_found = false;
> > + val = fdt_getprop(fdt, nodeoff, "riscv,children", &len);
> > + if (!val || len < sizeof(fdt32_t)) {
> > + deleg->first_irq = 0;
> > + deleg->last_irq = 0;
> > + deleg->child_index = 0;
> > + continue;
> > + }
> > + len = len / sizeof(fdt32_t);
> > + for (j = 0; j < len; j++) {
> > + if (del[i] != val[j])
> > + continue;
> > + deleg->child_index = j;
> > + child_found = true;
> > + break;
> > + }
> > +
> > + if (child_found) {
> > + d++;
> > + } else {
> > + deleg->first_irq = 0;
> > + deleg->last_irq = 0;
> > + deleg->child_index = 0;
> > + }
> > + }
> > +skip_delegate_parse:
> > +
> > + return 0;
> > +}
> > +
> > bool fdt_check_imsic_mlevel(void *fdt)
> > {
> > const fdt32_t *val;
> > diff --git a/lib/utils/irqchip/fdt_irqchip.c b/lib/utils/irqchip/fdt_irqchip.c
> > index cf64a2e..6007755 100644
> > --- a/lib/utils/irqchip/fdt_irqchip.c
> > +++ b/lib/utils/irqchip/fdt_irqchip.c
> > @@ -12,10 +12,12 @@
> > #include <sbi_utils/fdt/fdt_helper.h>
> > #include <sbi_utils/irqchip/fdt_irqchip.h>
> >
> > +extern struct fdt_irqchip fdt_irqchip_aplic;
> > extern struct fdt_irqchip fdt_irqchip_imsic;
> > extern struct fdt_irqchip fdt_irqchip_plic;
> >
> > static struct fdt_irqchip *irqchip_drivers[] = {
> > + &fdt_irqchip_aplic,
> > &fdt_irqchip_imsic,
> > &fdt_irqchip_plic
> > };
> > diff --git a/lib/utils/irqchip/fdt_irqchip_aplic.c b/lib/utils/irqchip/fdt_irqchip_aplic.c
> > new file mode 100644
> > index 0000000..965f023
> > --- /dev/null
> > +++ b/lib/utils/irqchip/fdt_irqchip_aplic.c
> > @@ -0,0 +1,56 @@
> > +/*
> > + * SPDX-License-Identifier: BSD-2-Clause
> > + *
> > + * Copyright (c) 2021 Western Digital Corporation or its affiliates.
> > + * Copyright (c) 2022 Ventana Micro Systems Inc.
> > + *
> > + * Authors:
> > + * Anup Patel <anup.patel at wdc.com>
> > + */
> > +
> > +#include <libfdt.h>
> > +#include <sbi/riscv_asm.h>
> > +#include <sbi/sbi_error.h>
> > +#include <sbi_utils/fdt/fdt_helper.h>
> > +#include <sbi_utils/irqchip/fdt_irqchip.h>
> > +#include <sbi_utils/irqchip/aplic.h>
> > +
> > +#define APLIC_MAX_NR 16
> > +
> > +static unsigned long aplic_count = 0;
> > +static struct aplic_data aplic[APLIC_MAX_NR];
> > +
> > +static int irqchip_aplic_warm_init(void)
> > +{
> > + /* Nothing to do here. */
> > + return 0;
> > +}
> > +
> > +static int irqchip_aplic_cold_init(void *fdt, int nodeoff,
> > + const struct fdt_match *match)
> > +{
> > + int rc;
> > + struct aplic_data *pd;
> > +
> > + if (APLIC_MAX_NR <= aplic_count)
> > + return SBI_ENOSPC;
> > + pd = &aplic[aplic_count++];
> > +
> > + rc = fdt_parse_aplic_node(fdt, nodeoff, pd);
> > + if (rc)
> > + return rc;
> > +
> > + return aplic_cold_irqchip_init(pd);
> > +}
> > +
> > +static const struct fdt_match irqchip_aplic_match[] = {
> > + { .compatible = "riscv,aplic" },
> > + { },
> > +};
> > +
> > +struct fdt_irqchip fdt_irqchip_aplic = {
> > + .match_table = irqchip_aplic_match,
> > + .cold_init = irqchip_aplic_cold_init,
> > + .warm_init = irqchip_aplic_warm_init,
> > + .exit = NULL,
> > +};
> > diff --git a/lib/utils/irqchip/objects.mk b/lib/utils/irqchip/objects.mk
> > index b2b3f79..fad4344 100644
> > --- a/lib/utils/irqchip/objects.mk
> > +++ b/lib/utils/irqchip/objects.mk
> > @@ -8,6 +8,7 @@
> > #
> >
> > libsbiutils-objs-y += irqchip/fdt_irqchip.o
> > +libsbiutils-objs-y += irqchip/fdt_irqchip_aplic.o
> > libsbiutils-objs-y += irqchip/fdt_irqchip_imsic.o
> > libsbiutils-objs-y += irqchip/fdt_irqchip_plic.o
> > libsbiutils-objs-y += irqchip/aplic.o
> > --
> > 2.25.1
> >
>
> Same comment as the FDT based IMSIC driver. Other than that,
Same response as PATCH9.
>
> Reviewed-by: Atish Patra <atishp at rivosinc.com>
>
>
> --
> Regards,
> Atish
Regards,
Anup
More information about the opensbi
mailing list