diff options
| author | Anup Patel <anup.patel@wdc.com> | 2021-05-20 13:00:46 +0530 |
|---|---|---|
| committer | Anup Patel <anup@brainfault.org> | 2021-06-24 09:39:44 +0530 |
| commit | 5a049fe1d6a5d1c381113853fce3afad6573bb56 (patch) | |
| tree | 174665abdf6afd99d080fc156dae1a77f3255799 /lib/utils | |
| parent | 4519e29c51315205119ce03ff0e5152def647ed5 (diff) | |
lib: utils/ipi: Add ACLINT MSWI library
We add common ACLINT MSWI library similar to the CLINT library
so that OpenSBI platforms can use it.
Signed-off-by: Anup Patel <anup.patel@wdc.com>
Reviewed-by: Bin Meng <bmeng.cn@gmail.com>
Reviewed-by: Xiang W <wxjstz@126.com>
Diffstat (limited to 'lib/utils')
| -rw-r--r-- | lib/utils/ipi/aclint_mswi.c | 100 | ||||
| -rw-r--r-- | lib/utils/ipi/objects.mk | 1 |
2 files changed, 101 insertions, 0 deletions
diff --git a/lib/utils/ipi/aclint_mswi.c b/lib/utils/ipi/aclint_mswi.c new file mode 100644 index 0000000..a3de2f5 --- /dev/null +++ b/lib/utils/ipi/aclint_mswi.c @@ -0,0 +1,100 @@ +/* + * SPDX-License-Identifier: BSD-2-Clause + * + * Copyright (c) 2021 Western Digital Corporation or its affiliates. + * + * Authors: + * Anup Patel <anup.patel@wdc.com> + */ + +#include <sbi/riscv_asm.h> +#include <sbi/riscv_atomic.h> +#include <sbi/riscv_io.h> +#include <sbi/sbi_domain.h> +#include <sbi/sbi_error.h> +#include <sbi/sbi_hartmask.h> +#include <sbi/sbi_ipi.h> +#include <sbi/sbi_timer.h> +#include <sbi_utils/ipi/aclint_mswi.h> + +static struct aclint_mswi_data *mswi_hartid2data[SBI_HARTMASK_MAX_BITS]; + +static void mswi_ipi_send(u32 target_hart) +{ + u32 *msip; + struct aclint_mswi_data *mswi; + + if (SBI_HARTMASK_MAX_BITS <= target_hart) + return; + mswi = mswi_hartid2data[target_hart]; + if (!mswi) + return; + + /* Set ACLINT IPI */ + msip = (void *)mswi->addr; + writel(1, &msip[target_hart - mswi->first_hartid]); +} + +static void mswi_ipi_clear(u32 target_hart) +{ + u32 *msip; + struct aclint_mswi_data *mswi; + + if (SBI_HARTMASK_MAX_BITS <= target_hart) + return; + mswi = mswi_hartid2data[target_hart]; + if (!mswi) + return; + + /* Clear ACLINT IPI */ + msip = (void *)mswi->addr; + writel(0, &msip[target_hart - mswi->first_hartid]); +} + +static struct sbi_ipi_device aclint_mswi = { + .name = "aclint-mswi", + .ipi_send = mswi_ipi_send, + .ipi_clear = mswi_ipi_clear +}; + +int aclint_mswi_warm_init(void) +{ + /* Clear IPI for current HART */ + mswi_ipi_clear(current_hartid()); + + return 0; +} + +int aclint_mswi_cold_init(struct aclint_mswi_data *mswi) +{ + u32 i; + int rc; + unsigned long pos, region_size; + struct sbi_domain_memregion reg; + + /* Sanity checks */ + if (!mswi || (mswi->addr & (ACLINT_MSWI_ALIGN - 1)) || + (mswi->size < ACLINT_MSWI_SIZE) || + (mswi->first_hartid >= SBI_HARTMASK_MAX_BITS) || + (mswi->hart_count > ACLINT_MSWI_MAX_HARTS)) + return SBI_EINVAL; + + /* Update MSWI hartid table */ + for (i = 0; i < mswi->hart_count; i++) + mswi_hartid2data[mswi->first_hartid + i] = mswi; + + /* Add MSWI regions to the root domain */ + for (pos = 0; pos < mswi->size; pos += ACLINT_MSWI_ALIGN) { + region_size = ((mswi->size - pos) < ACLINT_MSWI_ALIGN) ? + (mswi->size - pos) : ACLINT_MSWI_ALIGN; + sbi_domain_memregion_init(mswi->addr + pos, region_size, + SBI_DOMAIN_MEMREGION_MMIO, ®); + rc = sbi_domain_root_add_memregion(®); + if (rc) + return rc; + } + + sbi_ipi_set_device(&aclint_mswi); + + return 0; +} diff --git a/lib/utils/ipi/objects.mk b/lib/utils/ipi/objects.mk index 0071957..7e37816 100644 --- a/lib/utils/ipi/objects.mk +++ b/lib/utils/ipi/objects.mk @@ -7,5 +7,6 @@ # Anup Patel <anup.patel@wdc.com> # +libsbiutils-objs-y += ipi/aclint_mswi.o libsbiutils-objs-y += ipi/fdt_ipi.o libsbiutils-objs-y += ipi/fdt_ipi_clint.o |