| 1 | #define LIBCO_C |
| 2 | #include "libco.h" |
| 3 | |
| 4 | #include <stdlib.h> |
| 5 | #include <stdint.h> |
| 6 | #include <kernel.h> |
| 7 | |
| 8 | /* Since cothread_t is a void pointer it must contain an address. We can't return a reference to a local variable |
| 9 | * because it would go out of scope, so we create a static variable instead so we can return a reference to it. |
| 10 | */ |
| 11 | static int32_t active_thread_id = -1; |
| 12 | extern void *_gp; |
| 13 | |
| 14 | cothread_t co_active() |
| 15 | { |
| 16 | active_thread_id = GetThreadId(); |
| 17 | return &active_thread_id; |
| 18 | } |
| 19 | |
| 20 | cothread_t co_create(unsigned int size, void (*entrypoint)(void)) |
| 21 | { |
| 22 | /* Similar scenario as with active_thread_id except there will only be one active_thread_id while there could be many |
| 23 | * new threads each with their own handle, so we create them on the heap instead and delete them manually when they're |
| 24 | * no longer needed in co_delete(). |
| 25 | */ |
| 26 | ee_thread_t thread; |
| 27 | int32_t new_thread_id; |
| 28 | cothread_t handle = malloc(sizeof(cothread_t)); |
| 29 | void *threadStack = (void *)malloc(size); |
| 30 | |
| 31 | if (!threadStack) |
| 32 | return -1; |
| 33 | |
| 34 | thread.stack_size = size; |
| 35 | thread.gp_reg = &_gp; |
| 36 | thread.func = (void *)entrypoint; |
| 37 | thread.stack = threadStack; |
| 38 | thread.option = 0; |
| 39 | thread.initial_priority = 1; |
| 40 | |
| 41 | new_thread_id = CreateThread(&thread); |
| 42 | StartThread(new_thread_id, NULL); |
| 43 | *(uint32_t *)handle = new_thread_id; |
| 44 | return handle; |
| 45 | } |
| 46 | |
| 47 | void co_delete(cothread_t handle) |
| 48 | { |
| 49 | TerminateThread(*(uint32_t *)handle); |
| 50 | DeleteThread(*(uint32_t *)handle); |
| 51 | free(handle); |
| 52 | } |
| 53 | |
| 54 | void co_switch(cothread_t handle) |
| 55 | { |
| 56 | WakeupThread(*(uint32_t *)handle); |
| 57 | /* Sleep the currently active thread so the new thread can start */ |
| 58 | SleepThread(); |
| 59 | } |