61 lines
1.3 KiB
C++
61 lines
1.3 KiB
C++
#include <BAN/Errors.h>
|
|
#include <kernel/Arch.h>
|
|
#include <kernel/InterruptController.h>
|
|
#include <kernel/kmalloc.h>
|
|
#include <kernel/Scheduler.h>
|
|
#include <kernel/Thread.h>
|
|
|
|
#define PAGE_SIZE 4096
|
|
|
|
namespace Kernel
|
|
{
|
|
|
|
static uint32_t s_next_tid = 0;
|
|
|
|
static constexpr size_t thread_stack_size = 16384;
|
|
|
|
template<size_t size, typename T>
|
|
static void write_to_stack(uintptr_t& rsp, const T& value)
|
|
{
|
|
rsp -= size;
|
|
memcpy((void*)rsp, (void*)&value, size);
|
|
}
|
|
|
|
BAN::ErrorOr<BAN::RefPtr<Thread>> Thread::create(entry_t entry, void* data)
|
|
{
|
|
auto thread = TRY(BAN::RefPtr<Thread>::create());
|
|
TRY(thread->initialize(entry, data));
|
|
return thread;
|
|
}
|
|
|
|
Thread::Thread()
|
|
: m_tid(s_next_tid++)
|
|
{}
|
|
|
|
BAN::ErrorOr<void> Thread::initialize(entry_t entry, void* data)
|
|
{
|
|
m_stack_base = kmalloc(thread_stack_size, PAGE_SIZE);
|
|
if (m_stack_base == nullptr)
|
|
return BAN::Error::from_errno(ENOMEM);
|
|
m_rsp = (uintptr_t)m_stack_base + thread_stack_size;
|
|
m_rip = (uintptr_t)entry;
|
|
|
|
write_to_stack<sizeof(void*)>(m_rsp, this);
|
|
write_to_stack<sizeof(void*)>(m_rsp, &Thread::on_exit);
|
|
write_to_stack<sizeof(void*)>(m_rsp, data);
|
|
|
|
return {};
|
|
}
|
|
|
|
Thread::~Thread()
|
|
{
|
|
kfree(m_stack_base);
|
|
}
|
|
|
|
void Thread::on_exit()
|
|
{
|
|
Scheduler::get().set_current_thread_done();
|
|
ASSERT_NOT_REACHED();
|
|
}
|
|
|
|
} |