|
| 1 | +/* SPDX-License-Identifier: MIT */ |
| 2 | +#include <stdint.h> |
| 3 | +#include <ulmk/microkernel.h> |
| 4 | +#include <board_services.h> |
| 5 | +#include <board_console.h> |
| 6 | + |
| 7 | +static volatile uint32_t g_samples[32]; |
| 8 | +static volatile uint32_t g_n; |
| 9 | +static volatile uint32_t g_pin1_started; |
| 10 | +static ulmk_notif_t g_done; |
| 11 | + |
| 12 | +static void pin1(void *arg) |
| 13 | +{ |
| 14 | + uint32_t i; |
| 15 | + |
| 16 | + (void)arg; |
| 17 | + g_pin1_started = 1u; |
| 18 | + for (i = 0u; i < 32u; i++) { |
| 19 | + g_samples[i] = ulmk_cpu_id(); |
| 20 | + ulmk_thread_yield(); |
| 21 | + } |
| 22 | + g_n = 32u; |
| 23 | + ulmk_notif_signal(g_done, 0x1u); |
| 24 | + ulmk_thread_exit(); |
| 25 | +} |
| 26 | + |
| 27 | +void ulmk_root_thread(const ulmk_boot_info_t *info) |
| 28 | +{ |
| 29 | + ulmk_thread_attr_t attr = {0}; |
| 30 | + uint32_t bits = 0; |
| 31 | + uint32_t i; |
| 32 | + ulmk_tid_t tid; |
| 33 | + |
| 34 | + (void)info; |
| 35 | + board_services_init(info); |
| 36 | + board_console_puts("smp_affinity: begin\n"); |
| 37 | + |
| 38 | + if (ulmk_cpu_id() != 0u) { |
| 39 | + board_console_puts("smp_affinity: FAIL root cpu\n"); |
| 40 | + for (;;) |
| 41 | + ; |
| 42 | + } |
| 43 | + |
| 44 | + g_done = ulmk_notif_create(); |
| 45 | + board_console_puts("smp_affinity: notif\n"); |
| 46 | + |
| 47 | + attr.name = "pin1"; |
| 48 | + attr.entry = pin1; |
| 49 | + attr.priority = 1u; |
| 50 | + attr.stack_size = 2048u; |
| 51 | + attr.privilege = ULMK_PRIV_DRIVER; |
| 52 | + attr.cpu = 1u; |
| 53 | + tid = ulmk_thread_create(&attr); |
| 54 | + if (tid == ULMK_TID_INVALID) { |
| 55 | + board_console_puts("smp_affinity: FAIL spawn\n"); |
| 56 | + for (;;) |
| 57 | + ; |
| 58 | + } |
| 59 | + board_console_puts("smp_affinity: spawned\n"); |
| 60 | + |
| 61 | + for (i = 0u; i < 100000u && g_pin1_started == 0u; i++) |
| 62 | + ulmk_thread_yield(); |
| 63 | + |
| 64 | + if (g_pin1_started == 0u) { |
| 65 | + board_console_puts("smp_affinity: FAIL pin1 never ran\n"); |
| 66 | + for (;;) |
| 67 | + ; |
| 68 | + } |
| 69 | + board_console_puts("smp_affinity: pin1 ok\n"); |
| 70 | + |
| 71 | + ulmk_notif_wait(g_done, 0x1u, &bits); |
| 72 | + |
| 73 | + if (g_n != 32u) { |
| 74 | + board_console_puts("smp_affinity: FAIL short samples\n"); |
| 75 | + for (;;) |
| 76 | + ; |
| 77 | + } |
| 78 | + |
| 79 | + for (i = 0u; i < g_n; i++) { |
| 80 | + if (g_samples[i] != 1u) { |
| 81 | + board_console_puts("smp_affinity: FAIL migrated\n"); |
| 82 | + for (;;) |
| 83 | + ; |
| 84 | + } |
| 85 | + } |
| 86 | + board_console_puts("smp_affinity: PASS\n"); |
| 87 | + ulmk_thread_exit(); |
| 88 | +} |
0 commit comments