123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178 |
- /*
- * SPDX-License-Identifier: BSD-2-Clause
- *
- * Copyright (c) 2019 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/sbi_console.h>
- #include <sbi/sbi_ecall.h>
- #include <sbi/sbi_hart.h>
- #include <sbi/sbi_ipi.h>
- #include <sbi/sbi_platform.h>
- #include <sbi/sbi_system.h>
- #include <sbi/sbi_timer.h>
- #include <sbi/sbi_version.h>
- #define BANNER \
- " ____ _____ ____ _____\n" \
- " / __ \\ / ____| _ \\_ _|\n" \
- " | | | |_ __ ___ _ __ | (___ | |_) || |\n" \
- " | | | | '_ \\ / _ \\ '_ \\ \\___ \\| _ < | |\n" \
- " | |__| | |_) | __/ | | |____) | |_) || |_\n" \
- " \\____/| .__/ \\___|_| |_|_____/|____/_____|\n" \
- " | |\n" \
- " |_|\n\n"
- static void sbi_boot_prints(struct sbi_scratch *scratch, u32 hartid)
- {
- char str[64];
- const struct sbi_platform *plat = sbi_platform_ptr(scratch);
- misa_string(str, sizeof(str));
- sbi_printf("\nOpenSBI v%d.%d (%s %s)\n", OPENSBI_VERSION_MAJOR,
- OPENSBI_VERSION_MINOR, __DATE__, __TIME__);
- sbi_printf(BANNER);
- /* Platform details */
- sbi_printf("Platform Name : %s\n", sbi_platform_name(plat));
- sbi_printf("Platform HART Features : RV%d%s\n", misa_xlen(), str);
- sbi_printf("Platform Max HARTs : %d\n",
- sbi_platform_hart_count(plat));
- sbi_printf("Current Hart : %u\n", hartid);
- /* Firmware details */
- sbi_printf("Firmware Base : 0x%lx\n", scratch->fw_start);
- sbi_printf("Firmware Size : %d KB\n",
- (u32)(scratch->fw_size / 1024));
- /* Generic details */
- sbi_printf("Runtime SBI Version : %d.%d\n",
- sbi_ecall_version_major(), sbi_ecall_version_minor());
- sbi_printf("\n");
- sbi_hart_pmp_dump(scratch);
- }
- static void __noreturn init_coldboot(struct sbi_scratch *scratch, u32 hartid)
- {
- int rc;
- const struct sbi_platform *plat = sbi_platform_ptr(scratch);
- rc = sbi_system_early_init(scratch, TRUE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_hart_init(scratch, hartid);
- if (rc)
- sbi_hart_hang();
- rc = sbi_console_init(scratch);
- if (rc)
- sbi_hart_hang();
- rc = sbi_platform_irqchip_init(plat, TRUE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_ipi_init(scratch, TRUE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_timer_init(scratch, TRUE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_system_final_init(scratch, TRUE);
- if (rc)
- sbi_hart_hang();
- if (!(scratch->options & SBI_SCRATCH_NO_BOOT_PRINTS))
- sbi_boot_prints(scratch, hartid);
- if (!sbi_platform_has_hart_hotplug(plat))
- sbi_hart_wake_coldboot_harts(scratch, hartid);
- sbi_hart_mark_available(hartid);
- sbi_hart_switch_mode(hartid, scratch->next_arg1, scratch->next_addr,
- scratch->next_mode);
- }
- static void __noreturn init_warmboot(struct sbi_scratch *scratch, u32 hartid)
- {
- int rc;
- const struct sbi_platform *plat = sbi_platform_ptr(scratch);
- if (!sbi_platform_has_hart_hotplug(plat))
- sbi_hart_wait_for_coldboot(scratch, hartid);
- if (sbi_platform_hart_disabled(plat, hartid))
- sbi_hart_hang();
- rc = sbi_system_early_init(scratch, FALSE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_hart_init(scratch, hartid);
- if (rc)
- sbi_hart_hang();
- rc = sbi_platform_irqchip_init(plat, FALSE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_ipi_init(scratch, FALSE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_timer_init(scratch, FALSE);
- if (rc)
- sbi_hart_hang();
- rc = sbi_system_final_init(scratch, FALSE);
- if (rc)
- sbi_hart_hang();
- sbi_hart_mark_available(hartid);
- if (sbi_platform_has_hart_hotplug(plat))
- /* TODO: To be implemented in-future. */
- sbi_hart_hang();
- else
- sbi_hart_switch_mode(hartid, scratch->next_arg1,
- scratch->next_addr, scratch->next_mode);
- }
- static atomic_t coldboot_lottery = ATOMIC_INITIALIZER(0);
- /**
- * Initialize OpenSBI library for current HART and jump to next
- * booting stage.
- *
- * The function expects following:
- * 1. The 'mscratch' CSR is pointing to sbi_scratch of current HART
- * 2. Stack pointer (SP) is setup for current HART
- * 3. Interrupts are disabled in MSTATUS CSR
- * 4. All interrupts are disabled in MIE CSR
- *
- * @param scratch pointer to sbi_scratch of current HART
- */
- void __noreturn sbi_init(struct sbi_scratch *scratch)
- {
- bool coldboot = FALSE;
- u32 hartid = sbi_current_hartid();
- const struct sbi_platform *plat = sbi_platform_ptr(scratch);
- if (sbi_platform_hart_disabled(plat, hartid))
- sbi_hart_hang();
- if (atomic_add_return(&coldboot_lottery, 1) == 1)
- coldboot = TRUE;
- if (coldboot)
- init_coldboot(scratch, hartid);
- else
- init_warmboot(scratch, hartid);
- }
|