123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174 |
- /*
- * 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/riscv_io.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>
- #define PLIC_MAX_NR 16
- static unsigned long plic_count = 0;
- static struct plic_data plic[PLIC_MAX_NR];
- static struct plic_data *plic_hartid2data[SBI_HARTMASK_MAX_BITS];
- static int plic_hartid2context[SBI_HARTMASK_MAX_BITS][2];
- void fdt_plic_priority_save(u8 *priority)
- {
- struct plic_data *plic = plic_hartid2data[current_hartid()];
- plic_priority_save(plic, priority);
- }
- void fdt_plic_priority_restore(const u8 *priority)
- {
- struct plic_data *plic = plic_hartid2data[current_hartid()];
- plic_priority_restore(plic, priority);
- }
- void fdt_plic_context_save(bool smode, u32 *enable, u32 *threshold)
- {
- u32 hartid = current_hartid();
- plic_context_save(plic_hartid2data[hartid],
- plic_hartid2context[hartid][smode],
- enable, threshold);
- }
- void fdt_plic_context_restore(bool smode, const u32 *enable, u32 threshold)
- {
- u32 hartid = current_hartid();
- plic_context_restore(plic_hartid2data[hartid],
- plic_hartid2context[hartid][smode],
- enable, threshold);
- }
- static int irqchip_plic_warm_init(void)
- {
- u32 hartid = current_hartid();
- return plic_warm_irqchip_init(plic_hartid2data[hartid],
- plic_hartid2context[hartid][0],
- plic_hartid2context[hartid][1]);
- }
- static int irqchip_plic_update_hartid_table(void *fdt, int nodeoff,
- struct plic_data *pd)
- {
- const fdt32_t *val;
- u32 phandle, hwirq, hartid;
- int i, err, count, cpu_offset, cpu_intc_offset;
- 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_offset < 0)
- continue;
- err = fdt_parse_hart_id(fdt, cpu_offset, &hartid);
- if (err)
- continue;
- if (SBI_HARTMASK_MAX_BITS <= hartid)
- continue;
- plic_hartid2data[hartid] = pd;
- 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 i, rc;
- struct plic_data *pd;
- if (PLIC_MAX_NR <= plic_count)
- return SBI_ENOSPC;
- pd = &plic[plic_count++];
- rc = fdt_parse_plic_node(fdt, nodeoff, pd);
- if (rc)
- return rc;
- if (match->data) {
- void (*plic_plat_init)(struct plic_data *) = match->data;
- plic_plat_init(pd);
- }
- rc = plic_cold_irqchip_init(pd);
- if (rc)
- return rc;
- if (plic_count == 1) {
- for (i = 0; i < SBI_HARTMASK_MAX_BITS; i++) {
- plic_hartid2data[i] = NULL;
- plic_hartid2context[i][0] = -1;
- plic_hartid2context[i][1] = -1;
- }
- }
- return irqchip_plic_update_hartid_table(fdt, nodeoff, pd);
- }
- #define THEAD_PLIC_CTRL_REG 0x1ffffc
- static void thead_plic_plat_init(struct plic_data *pd)
- {
- writel_relaxed(BIT(0), (char *)pd->addr + THEAD_PLIC_CTRL_REG);
- }
- void thead_plic_restore(void)
- {
- struct plic_data *plic = plic_hartid2data[current_hartid()];
- thead_plic_plat_init(plic);
- }
- static const struct fdt_match irqchip_plic_match[] = {
- { .compatible = "riscv,plic0" },
- { .compatible = "sifive,plic-1.0.0" },
- { .compatible = "thead,c900-plic",
- .data = thead_plic_plat_init },
- { },
- };
- 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,
- };
|