blob: ddd2a6f7689dbeb6c4fc567feedb9dcb282c8a4e (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
|
/* Copyright (c) 2021 Johannes Stoelp */
#include <cassert>
#include <cstdint> // uintN_t
#if !defined(__ARM_PCS_AAPCS64)
static_assert(false, "Must be compiled with the Arm64 Procedure Call Standard (aapcs64)!");
#endif
extern "C" void thread_create();
void* init_stack(void* stack_ptr, void (*entry)(void*), const void* ctx) {
static_assert(sizeof(uint64_t) == sizeof(std::uintptr_t), "Pointer must be 64bit!");
// Setup initial stack frame which will be popped when yielding
// first time into the thread.
// Basic idea is to yield into Thread::entry() function which will
// then call the user function.
uint64_t* stack = static_cast<uint64_t*>(stack_ptr);
// Arguments for `thread_create`.
*(--stack) = reinterpret_cast<uint64_t>(ctx);
*(--stack) = reinterpret_cast<uint64_t>(entry);
// Yield epilogue.
*(--stack) = reinterpret_cast<uint64_t>(thread_create); // x30 (LR)
*(--stack) = static_cast<uint64_t>(0); // x29 (FP)
// Callee saved registers.
*(--stack) = static_cast<uint64_t>(0); // x28
*(--stack) = static_cast<uint64_t>(0); // x27
*(--stack) = static_cast<uint64_t>(0); // x26
*(--stack) = static_cast<uint64_t>(0); // x25
*(--stack) = static_cast<uint64_t>(0); // x24
*(--stack) = static_cast<uint64_t>(0); // x23
*(--stack) = static_cast<uint64_t>(0); // x22
*(--stack) = static_cast<uint64_t>(0); // x21
*(--stack) = static_cast<uint64_t>(0); // x20
*(--stack) = static_cast<uint64_t>(0); // x19
assert((reinterpret_cast<std::uintptr_t>(stack) & 0xf) == 0); // 16byte aligned
return static_cast<void*>(stack);
}
|
