diff --git a/platform/generic/spacemit/k1.c b/platform/generic/spacemit/k1.c index 7ee5f17a..5e699f8e 100644 --- a/platform/generic/spacemit/k1.c +++ b/platform/generic/spacemit/k1.c @@ -8,6 +8,7 @@ */ #include +#include #include #include #include @@ -86,16 +87,23 @@ static int spacemit_k1_early_init(bool cold_boot) return 0; } +static int spacemit_k1_nascent_init(void) +{ + csr_set(CSR_ML2SETUP, + BIT(current_hartid() % PLATFORM_MAX_CPUS_PER_CLUSTER)); + + return generic_nascent_init(); +} + static bool spacemit_cold_boot_allowed(u32 hartid) { - csr_set(CSR_ML2SETUP, 1 << (hartid % PLATFORM_MAX_CPUS_PER_CLUSTER)); - return !hartid; } static int spacemit_k1_platform_init(const void *fdt, int nodeoff, const struct fdt_match *match) { + generic_platform_ops.nascent_init = spacemit_k1_nascent_init; generic_platform_ops.early_init = spacemit_k1_early_init; generic_platform_ops.cold_boot_allowed = spacemit_cold_boot_allowed;