| /* |
| * Copyright 2020, Data61, CSIRO (ABN 41 687 119 230) |
| * |
| * SPDX-License-Identifier: GPL-2.0-only |
| */ |
| |
| #include <autoconf.h> |
| #include <elfloader/gen_config.h> |
| |
| #if CONFIG_MAX_NUM_NODES > 1 |
| #include <types.h> |
| #include <elfloader.h> |
| #include <armv/machine.h> |
| #include <armv/smp.h> |
| #include <printf.h> |
| |
| unsigned long core_stacks[CONFIG_MAX_NUM_NODES][STACK_SIZE / sizeof(unsigned long)] ALIGN(BIT(12)); |
| volatile int core_up[CONFIG_MAX_NUM_NODES]; |
| |
| extern void core_entry_head(void); |
| extern void non_boot_main(void); |
| |
| void core_entry(uint32_t sp) |
| { |
| int id; |
| // get the logic ID |
| id = (sp - (unsigned long)&core_stacks[0][0]) / STACK_SIZE; |
| |
| core_up[id] = id; |
| dsb(); |
| non_boot_main(); |
| } |
| |
| int is_core_up(int i) |
| { |
| return core_up[i] == i; |
| } |
| |
| #endif |
