91128ad729
- Add a percpu structure for each cpu, akin to x86-64 and riscv. Pointed to by x18, which is now reserved for this in the kernel. Tweaked exception and context switch routines to leave x18 alone. - Remove the cpu-trapping spinlock logic that is unused in mainline, probably. (Can add a new version of it back if it's necessary). - Switch fdtwalk helper to using the newer, cleaner way of initializing secondaries using the PSCI CPU_ON argument that should be pretty standard on modern implementations. (Possibly an issue with old firmware). - Remove the notion of computing the cpu ID from the Affinity levels, which doesn't really work properly on modern ARM CPUs which more or less abandoned the logical meaning of AFFn.
89 lines
2.5 KiB
C
89 lines
2.5 KiB
C
/*
|
|
* Copyright (c) 2008 Travis Geiselbrecht
|
|
*
|
|
* Use of this source code is governed by a MIT-style
|
|
* license that can be found in the LICENSE file or at
|
|
* https://opensource.org/licenses/MIT
|
|
*/
|
|
#include <arch/arm64.h>
|
|
#include <assert.h>
|
|
#include <kernel/thread.h>
|
|
#include <lk/debug.h>
|
|
#include <lk/trace.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sys/types.h>
|
|
|
|
#define LOCAL_TRACE 0
|
|
|
|
struct context_switch_frame {
|
|
vaddr_t tpidr_el0; // sp alignment requirements (16 bytes)
|
|
vaddr_t tpidrro_el0;
|
|
vaddr_t r19;
|
|
vaddr_t r20;
|
|
vaddr_t r21;
|
|
vaddr_t r22;
|
|
vaddr_t r23;
|
|
vaddr_t r24;
|
|
vaddr_t r25;
|
|
vaddr_t r26;
|
|
vaddr_t r27;
|
|
vaddr_t r28;
|
|
vaddr_t r29;
|
|
vaddr_t lr; // x30
|
|
};
|
|
static_assert(sizeof(struct context_switch_frame) % 16 == 0, "context_switch_frame size must be multiple of 16");
|
|
|
|
static void initial_thread_func(void) __NO_RETURN;
|
|
static void initial_thread_func(void) {
|
|
int ret;
|
|
|
|
thread_t *current_thread = get_current_thread();
|
|
|
|
LTRACEF("initial_thread_func: thread %p calling %p with arg %p\n", current_thread, current_thread->entry, current_thread->arg);
|
|
|
|
/* release the thread lock that was implicitly held across the reschedule */
|
|
spin_unlock(&thread_lock);
|
|
arch_enable_ints();
|
|
|
|
ret = current_thread->entry(current_thread->arg);
|
|
|
|
LTRACEF("initial_thread_func: thread %p exiting with %d\n", current_thread, ret);
|
|
|
|
thread_exit(ret);
|
|
}
|
|
|
|
void arch_thread_initialize(thread_t *t) {
|
|
// create a default stack frame on the stack
|
|
vaddr_t stack_top = (vaddr_t)t->stack + t->stack_size;
|
|
|
|
// make sure the top of the stack is 16 byte aligned for EABI compliance
|
|
stack_top = ROUNDDOWN(stack_top, 16);
|
|
|
|
struct context_switch_frame *frame = (struct context_switch_frame *)(stack_top);
|
|
frame--;
|
|
|
|
// fill it in
|
|
memset(frame, 0, sizeof(*frame));
|
|
frame->lr = (vaddr_t)&initial_thread_func;
|
|
|
|
// set the stack pointer
|
|
t->arch.sp = (vaddr_t)frame;
|
|
}
|
|
|
|
void arch_context_switch(thread_t *oldthread, thread_t *newthread) {
|
|
LTRACEF("old %p (%s), new %p (%s)\n", oldthread, oldthread->name, newthread, newthread->name);
|
|
arm64_fpu_pre_context_switch(oldthread);
|
|
#if WITH_SMP
|
|
DSB; /* broadcast tlb operations in case the thread moves to another cpu */
|
|
#endif
|
|
arm64_context_switch(&oldthread->arch.sp, newthread->arch.sp);
|
|
}
|
|
|
|
void arch_dump_thread(const thread_t *t) {
|
|
if (t->state != THREAD_RUNNING) {
|
|
dprintf(INFO, "\tarch: ");
|
|
dprintf(INFO, "sp 0x%lx\n", t->arch.sp);
|
|
}
|
|
}
|