diff options
author | David Guillen Fandos | 2021-03-08 18:44:03 +0100 |
---|---|---|
committer | David Guillen Fandos | 2021-03-08 18:44:03 +0100 |
commit | 56dc6ecb70e6fc76d32d6a7194acb273b76bfe0e (patch) | |
tree | cf3b14a8d1bc593248398d0c544251ea8987b40e /libco | |
parent | 02e35339ee89f92d346d290c24497bbbae59ea79 (diff) | |
download | picogpsp-56dc6ecb70e6fc76d32d6a7194acb273b76bfe0e.tar.gz picogpsp-56dc6ecb70e6fc76d32d6a7194acb273b76bfe0e.tar.bz2 picogpsp-56dc6ecb70e6fc76d32d6a7194acb273b76bfe0e.zip |
Remove libco
This removes libco and all the usages of it (+pthreads).
Rewired all dynarecs and interpreter to return after every frame so that
libretro can process events. This required to make dynarec re-entrant.
Dynarecs were updated to check for new frame on every update (IRQ, cycle
exhaustion, I/O write, etc). The performance impact of doing so should
be minimal (and definitely outweight the libco gains). While at it,
fixed small issues to get a bit more perf: arm dynarec was not idling
correctly, mips was using stack when not needed, etc.
Tested on PSP (mips), OGA (armv7), Linux (x86 and interpreter). Not
tested on Android though.
Diffstat (limited to 'libco')
-rw-r--r-- | libco/aarch64.c | 123 | ||||
-rw-r--r-- | libco/amd64.c | 161 | ||||
-rw-r--r-- | libco/armeabi.c | 95 | ||||
-rw-r--r-- | libco/fiber.c | 58 | ||||
-rw-r--r-- | libco/libco.c | 27 | ||||
-rw-r--r-- | libco/ppc.c | 407 | ||||
-rw-r--r-- | libco/psp1.c | 45 | ||||
-rw-r--r-- | libco/psp2.c | 116 | ||||
-rw-r--r-- | libco/scefiber.c | 96 | ||||
-rw-r--r-- | libco/sjlj.c | 115 | ||||
-rw-r--r-- | libco/ucontext.c | 81 | ||||
-rw-r--r-- | libco/x86.c | 117 |
12 files changed, 0 insertions, 1441 deletions
diff --git a/libco/aarch64.c b/libco/aarch64.c deleted file mode 100644 index 2eb9ac6..0000000 --- a/libco/aarch64.c +++ /dev/null @@ -1,123 +0,0 @@ -/* - libco.aarch64 (2017-06-26) - author: webgeek1234 - license: public domain -*/ - -#define LIBCO_C -#include "libco.h" -#include <assert.h> -#include <stdlib.h> -#include <string.h> -#include <stdint.h> - -#ifndef __APPLE__ -#include <malloc.h> -#endif - -#ifdef __cplusplus -extern "C" { -#endif - -static thread_local uint64_t co_active_buffer[64]; -static thread_local cothread_t co_active_handle; - -asm ( - ".globl co_switch_aarch64\n" - ".globl _co_switch_aarch64\n" - "co_switch_aarch64:\n" - "_co_switch_aarch64:\n" - " stp x8, x9, [x1]\n" - " stp x10, x11, [x1, #16]\n" - " stp x12, x13, [x1, #32]\n" - " stp x14, x15, [x1, #48]\n" - " str x19, [x1, #72]\n" - " stp x20, x21, [x1, #80]\n" - " stp x22, x23, [x1, #96]\n" - " stp x24, x25, [x1, #112]\n" - " stp x26, x27, [x1, #128]\n" - " stp x28, x29, [x1, #144]\n" - " mov x16, sp\n" - " stp x16, x30, [x1, #160]\n" - - " ldp x8, x9, [x0]\n" - " ldp x10, x11, [x0, #16]\n" - " ldp x12, x13, [x0, #32]\n" - " ldp x14, x15, [x0, #48]\n" - " ldr x19, [x0, #72]\n" - " ldp x20, x21, [x0, #80]\n" - " ldp x22, x23, [x0, #96]\n" - " ldp x24, x25, [x0, #112]\n" - " ldp x26, x27, [x0, #128]\n" - " ldp x28, x29, [x0, #144]\n" - " ldp x16, x17, [x0, #160]\n" - " mov sp, x16\n" - " br x17\n" - ); - -/* ASM */ -void co_switch_aarch64(cothread_t handle, cothread_t current); - -cothread_t co_create(unsigned int size, void (*entrypoint)(void)) -{ - size = (size + 1023) & ~1023; - cothread_t handle = 0; -#if HAVE_POSIX_MEMALIGN >= 1 - if (posix_memalign(&handle, 1024, size + 512) < 0) - return 0; -#else - handle = memalign(1024, size + 512); -#endif - - if (!handle) - return handle; - - uint64_t *ptr = (uint64_t*)handle; - /* Non-volatiles. */ - ptr[0] = 0; /* x8 */ - ptr[1] = 0; /* x9 */ - ptr[2] = 0; /* x10 */ - ptr[3] = 0; /* x11 */ - ptr[4] = 0; /* x12 */ - ptr[5] = 0; /* x13 */ - ptr[6] = 0; /* x14 */ - ptr[7] = 0; /* x15 */ - ptr[8] = 0; /* padding */ - ptr[9] = 0; /* x19 */ - ptr[10] = 0; /* x20 */ - ptr[11] = 0; /* x21 */ - ptr[12] = 0; /* x22 */ - ptr[13] = 0; /* x23 */ - ptr[14] = 0; /* x24 */ - ptr[15] = 0; /* x25 */ - ptr[16] = 0; /* x26 */ - ptr[17] = 0; /* x27 */ - ptr[18] = 0; /* x28 */ - ptr[20] = (uintptr_t)ptr + size + 512 - 16; /* x30, stack pointer */ - ptr[19] = ptr[20]; /* x29, frame pointer */ - ptr[21] = (uintptr_t)entrypoint; /* PC (link register x31 gets saved here). */ - return handle; -} - -cothread_t co_active(void) -{ - if (!co_active_handle) - co_active_handle = co_active_buffer; - return co_active_handle; -} - -void co_delete(cothread_t handle) -{ - free(handle); -} - -void co_switch(cothread_t handle) -{ - cothread_t co_previous_handle = co_active(); - co_switch_aarch64(co_active_handle = handle, co_previous_handle); -} - -#ifdef __cplusplus -} -#endif - diff --git a/libco/amd64.c b/libco/amd64.c deleted file mode 100644 index a9f6ee5..0000000 --- a/libco/amd64.c +++ /dev/null @@ -1,161 +0,0 @@ -/* - libco.amd64 (2009-10-12) - author: byuu - license: public domain -*/ - -#define LIBCO_C -#include <libco.h> -#include <assert.h> -#include <stdlib.h> - -#ifdef __cplusplus -extern "C" { -#endif - -static thread_local long long co_active_buffer[64]; -static thread_local cothread_t co_active_handle = 0; -static void (*co_swap)(cothread_t, cothread_t) = 0; - -#ifdef _WIN32 -//ABI: Win64 -static unsigned char co_swap_function[] = { - 0x48, 0x89, 0x22, /* mov [rdx],rsp */ - 0x48, 0x8b, 0x21, /* mov rsp,[rcx] */ - 0x58, /* pop rax */ - 0x48, 0x89, 0x6a, 0x08, /* mov [rdx+0x8],rbp */ - 0x48, 0x89, 0x72, 0x10, /* mov [rdx+0x10],rsi */ - 0x48, 0x89, 0x7a, 0x18, /* mov [rdx+0x18],rdi */ - 0x48, 0x89, 0x5a, 0x20, /* mov [rdx+0x20],rbx */ - 0x4c, 0x89, 0x62, 0x28, /* mov [rdx+0x28],r12 */ - 0x4c, 0x89, 0x6a, 0x30, /* mov [rdx+0x30],r13 */ - 0x4c, 0x89, 0x72, 0x38, /* mov [rdx+0x38],r14 */ - 0x4c, 0x89, 0x7a, 0x40, /* mov [rdx+0x40],r15 */ - 0x48, 0x81, 0xc2, 0x80, 0x00, 0x00, 0x00, /* add rdx,0x80 */ - 0x48, 0x83, 0xe2, 0xf0, /* and rdx,-0x10 */ - 0x0f, 0x29, 0x32, /* movaps [rdx],xmm6 */ - 0x0f, 0x29, 0x7a, 0x10, /* movaps [rdx+0x10],xmm7 */ - 0x44, 0x0f, 0x29, 0x42, 0x20, /* movaps [rdx+0x20],xmm8 */ - 0x44, 0x0f, 0x29, 0x4a, 0x30, /* movaps [rdx+0x30],xmm9 */ - 0x44, 0x0f, 0x29, 0x52, 0x40, /* movaps [rdx+0x40],xmm10 */ - 0x44, 0x0f, 0x29, 0x5a, 0x50, /* movaps [rdx+0x50],xmm11 */ - 0x44, 0x0f, 0x29, 0x62, 0x60, /* movaps [rdx+0x60],xmm12 */ - 0x44, 0x0f, 0x29, 0x6a, 0x70, /* movaps [rdx+0x70],xmm13 */ - 0x44, 0x0f, 0x29, 0xb2, 0x80, 0x00, 0x00, 0x00, /* movaps [rdx+0x80],xmm14 */ - 0x44, 0x0f, 0x29, 0xba, 0x90, 0x00, 0x00, 0x00, /* movaps [rdx+0x90],xmm15 */ - 0x48, 0x8b, 0x69, 0x08, /* mov rbp,[rcx+0x8] */ - 0x48, 0x8b, 0x71, 0x10, /* mov rsi,[rcx+0x10] */ - 0x48, 0x8b, 0x79, 0x18, /* mov rdi,[rcx+0x18] */ - 0x48, 0x8b, 0x59, 0x20, /* mov rbx,[rcx+0x20] */ - 0x4c, 0x8b, 0x61, 0x28, /* mov r12,[rcx+0x28] */ - 0x4c, 0x8b, 0x69, 0x30, /* mov r13,[rcx+0x30] */ - 0x4c, 0x8b, 0x71, 0x38, /* mov r14,[rcx+0x38] */ - 0x4c, 0x8b, 0x79, 0x40, /* mov r15,[rcx+0x40] */ - 0x48, 0x81, 0xc1, 0x80, 0x00, 0x00, 0x00, /* add rcx,0x80 */ - 0x48, 0x83, 0xe1, 0xf0, /* and rcx,-0x10 */ - 0x0f, 0x29, 0x31, /* movaps [rcx],xmm6 */ - 0x0f, 0x29, 0x79, 0x10, /* movaps [rcx+0x10],xmm7 */ - 0x44, 0x0f, 0x29, 0x41, 0x20, /* movaps [rcx+0x20],xmm8 */ - 0x44, 0x0f, 0x29, 0x49, 0x30, /* movaps [rcx+0x30],xmm9 */ - 0x44, 0x0f, 0x29, 0x51, 0x40, /* movaps [rcx+0x40],xmm10 */ - 0x44, 0x0f, 0x29, 0x59, 0x50, /* movaps [rcx+0x50],xmm11 */ - 0x44, 0x0f, 0x29, 0x61, 0x60, /* movaps [rcx+0x60],xmm12 */ - 0x44, 0x0f, 0x29, 0x69, 0x70, /* movaps [rcx+0x70],xmm13 */ - 0x44, 0x0f, 0x29, 0xb1, 0x80, 0x00, 0x00, 0x00, /* movaps [rcx+0x80],xmm14 */ - 0x44, 0x0f, 0x29, 0xb9, 0x90, 0x00, 0x00, 0x00, /* movaps [rcx+0x90],xmm15 */ - 0xff, 0xe0, /* jmp rax */ -}; - -#include <windows.h> - -void co_init(void) -{ - DWORD old_privileges; - VirtualProtect(co_swap_function, - sizeof(co_swap_function), PAGE_EXECUTE_READWRITE, &old_privileges); -} -#else -//ABI: SystemV -static unsigned char co_swap_function[] = { - 0x48, 0x89, 0x26, /* mov [rsi],rsp */ - 0x48, 0x8b, 0x27, /* mov rsp,[rdi] */ - 0x58, /* pop rax */ - 0x48, 0x89, 0x6e, 0x08, /* mov [rsi+0x08],rbp */ - 0x48, 0x89, 0x5e, 0x10, /* mov [rsi+0x10],rbx */ - 0x4c, 0x89, 0x66, 0x18, /* mov [rsi+0x18],r12 */ - 0x4c, 0x89, 0x6e, 0x20, /* mov [rsi+0x20],r13 */ - 0x4c, 0x89, 0x76, 0x28, /* mov [rsi+0x28],r14 */ - 0x4c, 0x89, 0x7e, 0x30, /* mov [rsi+0x30],r15 */ - 0x48, 0x8b, 0x6f, 0x08, /* mov rbp,[rdi+0x08] */ - 0x48, 0x8b, 0x5f, 0x10, /* mov rbx,[rdi+0x10] */ - 0x4c, 0x8b, 0x67, 0x18, /* mov r12,[rdi+0x18] */ - 0x4c, 0x8b, 0x6f, 0x20, /* mov r13,[rdi+0x20] */ - 0x4c, 0x8b, 0x77, 0x28, /* mov r14,[rdi+0x28] */ - 0x4c, 0x8b, 0x7f, 0x30, /* mov r15,[rdi+0x30] */ - 0xff, 0xe0, /* jmp rax */ -}; - -#include <unistd.h> -#include <sys/mman.h> - -void co_init(void) -{ - unsigned long long addr = (unsigned long long)co_swap_function; - unsigned long long base = addr - (addr % sysconf(_SC_PAGESIZE)); - unsigned long long size = (addr - base) + sizeof(co_swap_function); - mprotect((void*)base, size, PROT_READ | PROT_WRITE | PROT_EXEC); -} -#endif - -static void crash(void) -{ - assert(0); /* called only if cothread_t entrypoint returns */ -} - -cothread_t co_active(void) -{ - if (!co_active_handle) - co_active_handle = &co_active_buffer; - return co_active_handle; -} - -cothread_t co_create(unsigned int size, void (*entrypoint)(void)) -{ - cothread_t handle; - - if(!co_swap) - { - co_init(); - co_swap = (void (*)(cothread_t, cothread_t))co_swap_function; - } - - if (!co_active_handle) - co_active_handle = &co_active_buffer; - size += 512; /* allocate additional space for storage */ - size &= ~15; /* align stack to 16-byte boundary */ - - if((handle = (cothread_t)malloc(size))) - { - long long *p = (long long*)((char*)handle + size); /* seek to top of stack */ - *--p = (long long)crash; /* crash if entrypoint returns */ - *--p = (long long)entrypoint; /* start of function */ - *(long long*)handle = (long long)p; /* stack pointer */ - } - - return handle; -} - -void co_delete(cothread_t handle) -{ - free(handle); -} - -void co_switch(cothread_t handle) -{ - register cothread_t co_previous_handle = co_active_handle; - co_swap(co_active_handle = handle, co_previous_handle); -} - -#ifdef __cplusplus -} -#endif diff --git a/libco/armeabi.c b/libco/armeabi.c deleted file mode 100644 index c9b68d0..0000000 --- a/libco/armeabi.c +++ /dev/null @@ -1,95 +0,0 @@ -/* - libco.armeabi (2013-04-05) - author: Themaister - license: public domain -*/ - -#define LIBCO_C -#include <libco.h> -#include <assert.h> -#include <stdlib.h> -#include <string.h> -#include <stdint.h> - -#ifndef IOS -#include <malloc.h> -#endif - -#ifdef __cplusplus -extern "C" { -#endif - -static thread_local uint32_t co_active_buffer[64]; -static thread_local cothread_t co_active_handle; - -asm ( - ".arm\n" - ".align 4\n" - ".globl co_switch_arm\n" - ".globl _co_switch_arm\n" - "co_switch_arm:\n" - "_co_switch_arm:\n" - " stmia r1!, {r4, r5, r6, r7, r8, r9, r10, r11, sp, lr}\n" - " ldmia r0!, {r4, r5, r6, r7, r8, r9, r10, r11, sp, pc}\n" - ); - -/* ASM */ -void co_switch_arm(cothread_t handle, cothread_t current); - -static void crash(void) -{ - /* Called only if cothread_t entrypoint returns. */ - assert(0); -} - -cothread_t co_create(unsigned int size, void (*entrypoint)(void)) -{ - size = (size + 1023) & ~1023; - cothread_t handle = 0; -#if HAVE_POSIX_MEMALIGN >= 1 - if (posix_memalign(&handle, 1024, size + 256) < 0) - return 0; -#else - handle = memalign(1024, size + 256); -#endif - - if (!handle) - return handle; - - uint32_t *ptr = (uint32_t*)handle; - /* Non-volatiles. */ - ptr[0] = 0; /* r4 */ - ptr[1] = 0; /* r5 */ - ptr[2] = 0; /* r6 */ - ptr[3] = 0; /* r7 */ - ptr[4] = 0; /* r8 */ - ptr[5] = 0; /* r9 */ - ptr[6] = 0; /* r10 */ - ptr[7] = 0; /* r11 */ - ptr[8] = (uintptr_t)ptr + size + 256 - 4; /* r13, stack pointer */ - ptr[9] = (uintptr_t)entrypoint; /* r15, PC (link register r14 gets saved here). */ - return handle; -} - -cothread_t co_active(void) -{ - if (!co_active_handle) - co_active_handle = co_active_buffer; - return co_active_handle; -} - -void co_delete(cothread_t handle) -{ - free(handle); -} - -void co_switch(cothread_t handle) -{ - cothread_t co_previous_handle = co_active(); - co_switch_arm(co_active_handle = handle, co_previous_handle); -} - -#ifdef __cplusplus -} -#endif - diff --git a/libco/fiber.c b/libco/fiber.c deleted file mode 100644 index 90ba115..0000000 --- a/libco/fiber.c +++ /dev/null @@ -1,58 +0,0 @@ -/* - libco.win (2008-01-28) - authors: Nach, byuu - license: public domain -*/ - -#define LIBCO_C -#include <libco.h> -#define WINVER 0x0400 -#define _WIN32_WINNT 0x0400 -#define WIN32_LEAN_AND_MEAN -#include <windows.h> - -#ifdef __cplusplus -extern "C" { -#endif - -static thread_local cothread_t co_active_ = 0; - -static void __stdcall co_thunk(void *coentry) -{ - ((void (*)(void))coentry)(); -} - -cothread_t co_active(void) -{ - if(!co_active_) - { - ConvertThreadToFiber(0); - co_active_ = GetCurrentFiber(); - } - return co_active_; -} - -cothread_t co_create(unsigned int heapsize, void (*coentry)(void)) -{ - if(!co_active_) - { - ConvertThreadToFiber(0); - co_active_ = GetCurrentFiber(); - } - return (cothread_t)CreateFiber(heapsize, co_thunk, (void*)coentry); -} - -void co_delete(cothread_t cothread) -{ - DeleteFiber(cothread); -} - -void co_switch(cothread_t cothread) -{ - co_active_ = cothread; - SwitchToFiber(cothread); -} - -#ifdef __cplusplus -} -#endif diff --git a/libco/libco.c b/libco/libco.c deleted file mode 100644 index 95a04f5..0000000 --- a/libco/libco.c +++ /dev/null @@ -1,27 +0,0 @@ -/* - libco - auto-selection module - license: public domain -*/ - -#if defined(__GNUC__) && defined(__i386__) || (defined(_MSC_VER) && defined(_M_IX86)) - #include "x86.c" -#elif defined(__GNUC__) && defined(__amd64__) || (defined(_MSC_VER) && defined(_M_AMD64)) - #include "amd64.c" -#elif defined(__GNUC__) && defined(_ARCH_PPC) - #include "ppc.c" -#elif defined(VITA) - #include "scefiber.c" -#elif defined(PSP) - #include "psp1.c" -#elif defined(__GNUC__) && defined(__aarch64__) - #include "aarch64.c" -#elif defined(__GNUC__) && (defined(__ARM_EABI__) || defined(__arm__)) - #include "armeabi.c" -#elif defined(__GNUC__) - #include "sjlj.c" -#elif defined(_MSC_VER) - #include "fiber.c" -#else - #error "libco: unsupported processor, compiler or operating system" -#endif diff --git a/libco/ppc.c b/libco/ppc.c deleted file mode 100644 index f6cb536..0000000 --- a/libco/ppc.c +++ /dev/null @@ -1,407 +0,0 @@ -/* - libco.ppc (2010-10-17) - author: blargg - license: public domain -*/ - -/* PowerPC 32/64 using embedded or external asm, with optional -floating-point and AltiVec save/restore */ - -#define LIBCO_C -#include <libco.h> -#include <stdlib.h> -#include <stdint.h> -#include <string.h> - -#define LIBCO_MPROTECT (__unix__ && !LIBCO_PPC_ASM) - -#if LIBCO_MPROTECT - #include <unistd.h> - #include <sys/mman.h> -#endif - -/* State format (offsets in 32-bit words) - -+0 Pointer to swap code - Rest of function descriptor for entry function -+8 PC -+10 SP - Special regs - GPRs - FPRs - VRs - stack -*/ - -enum { state_size = 1024 }; -enum { above_stack = 2048 }; -enum { stack_align = 256 }; - -static thread_local cothread_t co_active_handle = 0; - -/**** Determine environment ****/ - -#define LIBCO_PPC64 (_ARCH_PPC64 || __PPC64__ || __ppc64__ || __powerpc64__) - -/* Whether function calls are indirect through a descriptor, -or are directly to function */ -#ifndef LIBCO_PPCDESC - #if !_CALL_SYSV && (_CALL_AIX || _CALL_AIXDESC || LIBCO_PPC64) - #define LIBCO_PPCDESC 1 - #endif -#endif - -#ifdef LIBCO_PPC_ASM - - #ifdef __cplusplus - extern "C" - #endif - - /* Swap code is in ppc.S */ - void co_swap_asm( cothread_t, cothread_t ); - #define CO_SWAP_ASM( x, y ) co_swap_asm( x, y ) - -#else - -/* Swap code is here in array. Please leave dieassembly comments, -as they make it easy to see what it does, and reorder instructions -if one wants to see whether that improves performance. */ -static const uint32_t libco_ppc_code [] = { -#if LIBCO_PPC64 - 0x7d000026, /* mfcr r8 */ - 0xf8240028, /* std r1,40(r4) */ - 0x7d2802a6, /* mflr r9 */ - 0xf9c40048, /* std r14,72(r4) */ - 0xf9e40050, /* std r15,80(r4) */ - 0xfa040058, /* std r16,88(r4) */ - 0xfa240060, /* std r17,96(r4) */ - 0xfa440068, /* std r18,104(r4) */ - 0xfa640070, /* std r19,112(r4) */ - 0xfa840078, /* std r20,120(r4) */ - 0xfaa40080, /* std r21,128(r4) */ - 0xfac40088, /* std r22,136(r4) */ - 0xfae40090, /* std r23,144(r4) */ - 0xfb040098, /* std r24,152(r4) */ - 0xfb2400a0, /* std r25,160(r4) */ - 0xfb4400a8, /* std r26,168(r4) */ - 0xfb6400b0, /* std r27,176(r4) */ - 0xfb8400b8, /* std r28,184(r4) */ - 0xfba400c0, /* std r29,192(r4) */ - 0xfbc400c8, /* std r30,200(r4) */ - 0xfbe400d0, /* std r31,208(r4) */ - 0xf9240020, /* std r9,32(r4) */ - 0xe8e30020, /* ld r7,32(r3) */ - 0xe8230028, /* ld r1,40(r3) */ - 0x48000009, /* bl 1 */ - 0x7fe00008, /* trap */ - 0x91040030,/*1:stw r8,48(r4) */ - 0x80c30030, /* lwz r6,48(r3) */ - 0x7ce903a6, /* mtctr r7 */ - 0xe9c30048, /* ld r14,72(r3) */ - 0xe9e30050, /* ld r15,80(r3) */ - 0xea030058, /* ld r16,88(r3) */ - 0xea230060, /* ld r17,96(r3) */ - 0xea430068, /* ld r18,104(r3) */ - 0xea630070, /* ld r19,112(r3) */ - 0xea830078, /* ld r20,120(r3) */ - 0xeaa30080, /* ld r21,128(r3) */ - 0xeac30088, /* ld r22,136(r3) */ - 0xeae30090, /* ld r23,144(r3) */ - 0xeb030098, /* ld r24,152(r3) */ - 0xeb2300a0, /* ld r25,160(r3) */ - 0xeb4300a8, /* ld r26,168(r3) */ - 0xeb6300b0, /* ld r27,176(r3) */ - 0xeb8300b8, /* ld r28,184(r3) */ - 0xeba300c0, /* ld r29,192(r3) */ - 0xebc300c8, /* ld r30,200(r3) */ - 0xebe300d0, /* ld r31,208(r3) */ - 0x7ccff120, /* mtcr r6 */ -#else - 0x7d000026, /* mfcr r8 */ - 0x90240028, /* stw r1,40(r4) */ - 0x7d2802a6, /* mflr r9 */ - 0x91a4003c, /* stw r13,60(r4) */ - 0x91c40040, /* stw r14,64(r4) */ - 0x91e40044, /* stw r15,68(r4) */ - 0x92040048, /* stw r16,72(r4) */ - 0x9224004c, /* stw r17,76(r4) */ - 0x92440050, /* stw r18,80(r4) */ - 0x92640054, /* stw r19,84(r4) */ - 0x92840058, /* stw r20,88(r4) */ - 0x92a4005c, /* stw r21,92(r4) */ - 0x92c40060, /* stw r22,96(r4) */ - 0x92e40064, /* stw r23,100(r4) */ - 0x93040068, /* stw r24,104(r4) */ - 0x9324006c, /* stw r25,108(r4) */ - 0x93440070, /* stw r26,112(r4) */ - 0x93640074, /* stw r27,116(r4) */ - 0x93840078, /* stw r28,120(r4) */ - 0x93a4007c, /* stw r29,124(r4) */ - 0x93c40080, /* stw r30,128(r4) */ - 0x93e40084, /* stw r31,132(r4) */ - 0x91240020, /* stw r9,32(r4) */ - 0x80e30020, /* lwz r7,32(r3) */ - 0x80230028, /* lwz r1,40(r3) */ - 0x48000009, /* bl 1 */ - 0x7fe00008, /* trap */ - 0x91040030,/*1:stw r8,48(r4) */ - 0x80c30030, /* lwz r6,48(r3) */ - 0x7ce903a6, /* mtctr r7 */ - 0x81a3003c, /* lwz r13,60(r3) */ - 0x81c30040, /* lwz r14,64(r3) */ - 0x81e30044, /* lwz r15,68(r3) */ - 0x82030048, /* lwz r16,72(r3) */ - 0x8223004c, /* lwz r17,76(r3) */ - 0x82430050, /* lwz r18,80(r3) */ - 0x82630054, /* lwz r19,84(r3) */ - 0x82830058, /* lwz r20,88(r3) */ - 0x82a3005c, /* lwz r21,92(r3) */ - 0x82c30060, /* lwz r22,96(r3) */ - 0x82e30064, /* lwz r23,100(r3) */ - 0x83030068, /* lwz r24,104(r3) */ - 0x8323006c, /* lwz r25,108(r3) */ - 0x83430070, /* lwz r26,112(r3) */ - 0x83630074, /* lwz r27,116(r3) */ - 0x83830078, /* lwz r28,120(r3) */ - 0x83a3007c, /* lwz r29,124(r3) */ - 0x83c30080, /* lwz r30,128(r3) */ - 0x83e30084, /* lwz r31,132(r3) */ - 0x7ccff120, /* mtcr r6 */ -#endif - -#ifndef LIBCO_PPC_NOFP - 0xd9c400e0, /* stfd f14,224(r4) */ - 0xd9e400e8, /* stfd f15,232(r4) */ - 0xda0400f0, /* stfd f16,240(r4) */ - 0xda2400f8, /* stfd f17,248(r4) */ - 0xda440100, /* stfd f18,256(r4) */ - 0xda640108, /* stfd f19,264(r4) */ - 0xda840110, /* stfd f20,272(r4) */ - 0xdaa40118, /* stfd f21,280(r4) */ - 0xdac40120, /* stfd f22,288(r4) */ - 0xdae40128, /* stfd f23,296(r4) */ - 0xdb040130, /* stfd f24,304(r4) */ - 0xdb240138, /* stfd f25,312(r4) */ - 0xdb440140, /* stfd f26,320(r4) */ - 0xdb640148, /* stfd f27,328(r4) */ - 0xdb840150, /* stfd f28,336(r4) */ - 0xdba40158, /* stfd f29,344(r4) */ - 0xdbc40160, /* stfd f30,352(r4) */ - 0xdbe40168, /* stfd f31,360(r4) */ - 0xc9c300e0, /* lfd f14,224(r3) */ - 0xc9e300e8, /* lfd f15,232(r3) */ - 0xca0300f0, /* lfd f16,240(r3) */ - 0xca2300f8, /* lfd f17,248(r3) */ - 0xca430100, /* lfd f18,256(r3) */ - 0xca630108, /* lfd f19,264(r3) */ - 0xca830110, /* lfd f20,272(r3) */ - 0xcaa30118, /* lfd f21,280(r3) */ - 0xcac30120, /* lfd f22,288(r3) */ - 0xcae30128, /* lfd f23,296(r3) */ - 0xcb030130, /* lfd f24,304(r3) */ - 0xcb230138, /* lfd f25,312(r3) */ - 0xcb430140, /* lfd f26,320(r3) */ - 0xcb630148, /* lfd f27,328(r3) */ - 0xcb830150, /* lfd f28,336(r3) */ - 0xcba30158, /* lfd f29,344(r3) */ - 0xcbc30160, /* lfd f30,352(r3) */ - 0xcbe30168, /* lfd f31,360(r3) */ -#endif - -#ifdef __ALTIVEC__ - 0x7ca042a6, /* mfvrsave r5 */ - 0x39040180, /* addi r8,r4,384 */ - 0x39240190, /* addi r9,r4,400 */ - 0x70a00fff, /* andi. r0,r5,4095 */ - 0x90a40034, /* stw r5,52(r4) */ - 0x4182005c, /* beq- 2 */ - 0x7e8041ce, /* stvx v20,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7ea049ce, /* stvx v21,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7ec041ce, /* stvx v22,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7ee049ce, /* stvx v23,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7f0041ce, /* stvx v24,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7f2049ce, /* stvx v25,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7f4041ce, /* stvx v26,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7f6049ce, /* stvx v27,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7f8041ce, /* stvx v28,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7fa049ce, /* stvx v29,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7fc041ce, /* stvx v30,r0,r8 */ - 0x7fe049ce, /* stvx v31,r0,r9 */ - 0x80a30034,/*2:lwz r5,52(r3) */ - 0x39030180, /* addi r8,r3,384 */ - 0x39230190, /* addi r9,r3,400 */ - 0x70a00fff, /* andi. r0,r5,4095 */ - 0x7ca043a6, /* mtvrsave r5 */ - 0x4d820420, /* beqctr */ - 0x7e8040ce, /* lvx v20,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7ea048ce, /* lvx v21,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7ec040ce, /* lvx v22,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7ee048ce, /* lvx v23,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7f0040ce, /* lvx v24,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7f2048ce, /* lvx v25,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7f4040ce, /* lvx v26,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7f6048ce, /* lvx v27,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7f8040ce, /* lvx v28,r0,r8 */ - 0x39080020, /* addi r8,r8,32 */ - 0x7fa048ce, /* lvx v29,r0,r9 */ - 0x39290020, /* addi r9,r9,32 */ - 0x7fc040ce, /* lvx v30,r0,r8 */ - 0x7fe048ce, /* lvx v31,r0,r9 */ -#endif - - 0x4e800420, /* bctr */ -}; - - #if LIBCO_PPCDESC - /* Function call goes through indirect descriptor */ - #define CO_SWAP_ASM( x, y ) \ - ((void (*)( cothread_t, cothread_t )) (uintptr_t) x)( x, y ) - #else - /* Function call goes directly to code */ - #define CO_SWAP_ASM( x, y ) \ - ((void (*)( cothread_t, cothread_t )) (uintptr_t) libco_ppc_code)( x, y ) - #endif - -#endif - -static uint32_t* co_create_( unsigned size, uintptr_t entry ) -{ - uint32_t* t = (uint32_t*) malloc( size ); - - (void) entry; - - #if LIBCO_PPCDESC - if ( t ) - { - /* Copy entry's descriptor */ - memcpy( t, (void*) entry, sizeof (void*) * 3 ); - - /* Set function pointer to swap routine */ - #ifdef LIBCO_PPC_ASM - *(const void**) t = *(void**) &co_swap_asm; - #else - *(const void**) t = libco_ppc_code; - #endif - } - #endif - - return t; -} - -cothread_t co_create( unsigned int size, void (*entry_)( void ) ) -{ - uintptr_t entry = (uintptr_t) entry_; - uint32_t* t = NULL; - - /* Be sure main thread was successfully allocated */ - if ( co_active() ) - { - size += state_size + above_stack + stack_align; - t = co_create_( size, entry ); - } - - if ( t ) - { - uintptr_t sp; - int shift; - - /* Save current registers into new thread, so that any special ones will - have proper values when thread is begun */ - CO_SWAP_ASM( t, t ); - - #if LIBCO_PPCDESC - /* Get real address */ - entry = (uintptr_t) *(void**) entry; - #endif - - /* Put stack near end of block, and align */ - sp = (uintptr_t) t + size - above_stack; - sp -= sp % stack_align; - - /* On PPC32, we save and restore GPRs as 32 bits. For PPC64, we - save and restore them as 64 bits, regardless of the size the ABI - uses. So, we manually write pointers at the proper size. We always - save and restore at the same address, and since PPC is big-endian, - we must put the low byte first on PPC32. */ - - /* If uintptr_t is 32 bits, >>32 is undefined behavior, so we do two shifts - and don't have to care how many bits uintptr_t is. */ - #if LIBCO_PPC64 - shift = 16; - #else - shift = 0; - #endif - - /* Set up so entry will be called on next swap */ - t [8] = (uint32_t) (entry >> shift >> shift); - t [9] = (uint32_t) entry; - - t [10] = (uint32_t) (sp >> shift >> shift); - t [11] = (uint32_t) sp; - } - - return t; -} - -void co_delete( cothread_t t ) -{ - free(t); -} - -static void co_init_( void ) -{ -#if LIBCO_MPROTECT - /* TODO: pre- and post-pad PPC code so that this doesn't make other - data executable and writable */ - long page_size = sysconf( _SC_PAGESIZE ); - if ( page_size > 0 ) - { - uintptr_t align = page_size; - uintptr_t begin = (uintptr_t) libco_ppc_code; - uintptr_t end = begin + sizeof libco_ppc_code; - - /* Align beginning and end */ - end += align - 1; - end -= end % align; - begin -= begin % align; - - mprotect( (void*) begin, end - begin, PROT_READ | PROT_WRITE | PROT_EXEC ); - } -#endif - - co_active_handle = co_create_( state_size, (uintptr_t) &co_switch ); -} - -cothread_t co_active(void) -{ - if (!co_active_handle) - co_init_(); - - return co_active_handle; -} - -void co_switch(cothread_t t) -{ - cothread_t old = co_active_handle; - co_active_handle = t; - - CO_SWAP_ASM( t, old ); -} diff --git a/libco/psp1.c b/libco/psp1.c deleted file mode 100644 index 90702ce..0000000 --- a/libco/psp1.c +++ /dev/null @@ -1,45 +0,0 @@ -#define LIBCO_C -#include "libco.h" - -#include <stdlib.h> -#include <pspthreadman.h> - -/* Since cothread_t is a void pointer it must contain an address. We can't return a reference to a local variable - * because it would go out of scope, so we create a static variable instead so we can return a reference to it. - */ -static SceUID active_thread_id = 0; - -cothread_t co_active() -{ - active_thread_id = sceKernelGetThreadId(); - return &active_thread_id; -} - -cothread_t co_create(unsigned int size, void (*entrypoint)(void)) -{ - /* Similar scenario as with active_thread_id except there will only be one active_thread_id while there could be many - * new threads each with their own handle, so we create them on the heap instead and delete them manually when they're - * no longer needed in co_delete(). - */ - cothread_t handle = malloc(sizeof(cothread_t)); - - /* SceKernelThreadEntry has a different signature than entrypoint, but in practice this seems to work */ - SceUID new_thread_id = sceKernelCreateThread("cothread", (SceKernelThreadEntry)entrypoint, 0x12, size, 0, NULL); - sceKernelStartThread(new_thread_id, 0, NULL); - - *(SceUID *)handle = new_thread_id; - return handle; -} - -void co_delete(cothread_t handle) -{ - sceKernelTerminateDeleteThread(*(SceUID *)handle); - free(handle); -} - -void co_switch(cothread_t handle) -{ - sceKernelWakeupThread(*(SceUID *)handle); - /* Sleep the currently active thread so the new thread can start */ - sceKernelSleepThread(); -} diff --git a/libco/psp2.c b/libco/psp2.c deleted file mode 100644 index 3ab1bc7..0000000 --- a/libco/psp2.c +++ /dev/null @@ -1,116 +0,0 @@ -/* - libco.arm (2016-08-14) - author: frangarcj - license: public domain -*/ - -#define LIBCO_C -#include "libco.h" - -#include <assert.h> -#include <stdlib.h> -#include <unistd.h> -#include <psp2/kernel/sysmem.h> -#include <stdio.h> -#include <string.h> -#ifdef __cplusplus -extern "C" { -#endif - -static inline int align(int x, int n) { - return (((x >> n) + 1) << n ); -} -#define FOUR_KB_ALIGN(x) align(x, 12) -#define MB_ALIGN(x) align(x, 20) - -static thread_local unsigned long co_active_buffer[64]; -static thread_local cothread_t co_active_handle = 0; -static void (*co_swap)(cothread_t, cothread_t) = 0; -static int block; -static uint32_t co_swap_function[] = { - 0xe8a16ff0, /* stmia r1!, {r4-r11,sp,lr} */ - 0xe8b0aff0, /* ldmia r0!, {r4-r11,sp,pc} */ - 0xe12fff1e, /* bx lr */ -}; - -void co_init() { - int ret; - void *base; - - block = sceKernelAllocMemBlockForVM("libco", MB_ALIGN(FOUR_KB_ALIGN(sizeof co_swap_function))); - if (block < 0) - { - return; - } - - // get base address - ret = sceKernelGetMemBlockBase(block, &base); - if (ret < 0) - { - return; - } - - // set domain to be writable by user - ret = sceKernelOpenVMDomain(); - if (ret < 0) - { - return; - } - - - memcpy(base,co_swap_function,sizeof co_swap_function); - - // set domain back to read-only - ret = sceKernelCloseVMDomain(); - if (ret < 0) - { - return; - } - - // flush icache - ret = sceKernelSyncVMDomain(block, base, MB_ALIGN(FOUR_KB_ALIGN(sizeof co_swap_function))); - if (ret < 0) - { - return; - } - - co_swap = (void (*)(cothread_t, cothread_t))base; - - -} - -cothread_t co_active() { - if(!co_active_handle) co_active_handle = &co_active_buffer; - return co_active_handle; -} - -cothread_t co_create(unsigned int size, void (*entrypoint)(void)) { - unsigned long* handle = 0; - if(!co_swap) { - co_init(); - } - if(!co_active_handle) co_active_handle = &co_active_buffer; - size += 256; - size &= ~15; - - if((handle = (unsigned long*)malloc(size))) { - unsigned long* p = (unsigned long*)((unsigned char*)handle + size); - handle[8] = (unsigned long)p; - handle[9] = (unsigned long)entrypoint; - } - - return handle; -} - -void co_delete(cothread_t handle) { - free(handle); -} - -void co_switch(cothread_t handle) { - cothread_t co_previous_handle = co_active_handle; - co_swap(co_active_handle = handle, co_previous_handle); -} - -#ifdef __cplusplus -} -#endif diff --git a/libco/scefiber.c b/libco/scefiber.c deleted file mode 100644 index a233bec..0000000 --- a/libco/scefiber.c +++ /dev/null @@ -1,96 +0,0 @@ -/* - libco.win (2016-09-06) - authors: frangarcj - license: public domain -*/ - -#define LIBCO_C -#include <libco.h> -#include <stdlib.h> -#include <psp2/sysmodule.h> - -#ifdef __cplusplus -extern "C" { -#endif - -static thread_local cothread_t co_active_ = 0; - -typedef struct SceFiber { - char reserved[128]; -} SceFiber __attribute__( ( aligned ( 8 ) ) ) ; - -int32_t _sceFiberInitializeImpl(SceFiber* fiber, char* name, void* entry, uint32_t argOnInitialize, void* addrContext, int32_t sizeContext, void* params); - -int32_t sceFiberFinalize(SceFiber* fiber); - -int32_t sceFiberRun(SceFiber* fiber, uint32_t argOnRunTo, uint32_t* argOnRun); - -int32_t sceFiberSwitch(SceFiber* fiber, uint32_t argOnRunTo, uint32_t* argOnRun); - -int32_t sceFiberReturnToThread(uint32_t argOnReturn, uint32_t* argOnRun); - -void co_thunk(uint32_t argOnInitialize, uint32_t argOnRun) -{ - ((void (*)(void))argOnInitialize)(); -} - -cothread_t co_active(void) -{ - if(!co_active_) - { - sceSysmoduleLoadModule(SCE_SYSMODULE_FIBER); - co_active_ = (cothread_t)1; - } - return co_active_; -} - -cothread_t co_create(unsigned int heapsize, void (*coentry)(void)) -{ - SceFiber* tailFiber = malloc(sizeof(SceFiber)); - char * m_contextBuffer = malloc(sizeof(char)*heapsize); - if(!co_active_) - { - sceSysmoduleLoadModule(SCE_SYSMODULE_FIBER); - co_active_ = (cothread_t)1; - } - - //_sceFiberInitializeImpl - int ret = _sceFiberInitializeImpl(tailFiber, "tailFiber", co_thunk, (uint32_t)coentry, (void*) m_contextBuffer, heapsize, NULL); - if(ret==0){ - return (cothread_t)tailFiber; - }else{ - return (cothread_t)ret; - } - -} - -void co_delete(cothread_t cothread) -{ - if(cothread == (cothread_t)1){ - return; - } - sceFiberFinalize((SceFiber*)cothread); -} - -void co_switch(cothread_t cothread) -{ - - uint32_t argOnReturn = 0; - if(cothread == (cothread_t)1){ - co_active_ = cothread; - sceFiberReturnToThread(0, NULL); - }else{ - SceFiber* theFiber = (SceFiber*)cothread; - if(co_active_ == (cothread_t)1){ - co_active_ = cothread; - sceFiberRun(theFiber, 0, &argOnReturn); - }else{ - co_active_ = cothread; - sceFiberSwitch(theFiber, 0, &argOnReturn); - } - } -} - -#ifdef __cplusplus -} -#endif diff --git a/libco/sjlj.c b/libco/sjlj.c deleted file mode 100644 index f074714..0000000 --- a/libco/sjlj.c +++ /dev/null @@ -1,115 +0,0 @@ -/* - libco.sjlj (2008-01-28) - author: Nach - license: public domain -*/ - -/* - * Note this was designed for UNIX systems. Based on ideas expressed in a paper - * by Ralf Engelschall. - * For SJLJ on other systems, one would want to rewrite springboard() and - * co_create() and hack the jmb_buf stack pointer. - */ - -#define LIBCO_C -#include <libco.h> -#include <stdlib.h> -#include <signal.h> -#include <setjmp.h> - -#ifdef __cplusplus -extern "C" { -#endif - -typedef struct -{ - sigjmp_buf context; - void (*coentry)(void); - void *stack; -} cothread_struct; - -static thread_local cothread_struct co_primary; -static thread_local cothread_struct *creating, *co_running = 0; - -static void springboard(int ignored) -{ - if(sigsetjmp(creating->context, 0)) - co_running->coentry(); -} - -cothread_t co_active(void) -{ - if (!co_running) - co_running = &co_primary; - return (cothread_t)co_running; -} - -cothread_t co_create(unsigned int size, void (*coentry)(void)) -{ - if(!co_running) - co_running = &co_primary; - - cothread_struct *thread = (cothread_struct*)malloc(sizeof(cothread_struct)); - - if(thread) - { - struct sigaction handler; - struct sigaction old_handler; - - stack_t stack; - stack_t old_stack; - - thread->coentry = thread->stack = 0; - - stack.ss_flags = 0; - stack.ss_size = size; - thread->stack = stack.ss_sp = malloc(size); - - if(stack.ss_sp && !sigaltstack(&stack, &old_stack)) - { - handler.sa_handler = springboard; - handler.sa_flags = SA_ONSTACK; - sigemptyset(&handler.sa_mask); - creating = thread; - - if(!sigaction(SIGUSR1, &handler, &old_handler)) - { - if(!raise(SIGUSR1)) - thread->coentry = coentry; - sigaltstack(&old_stack, 0); - sigaction(SIGUSR1, &old_handler, 0); - } - } - - if(thread->coentry != coentry) - { - co_delete(thread); - thread = 0; - } - } - - return (cothread_t)thread; -} - -void co_delete(cothread_t cothread) -{ - if(cothread) - { - if(((cothread_struct*)cothread)->stack) - free(((cothread_struct*)cothread)->stack); - free(cothread); - } -} - -void co_switch(cothread_t cothread) -{ - if(!sigsetjmp(co_running->context, 0)) - { - co_running = (cothread_struct*)cothread; - siglongjmp(co_running->context, 1); - } -} - -#ifdef __cplusplus -} -#endif diff --git a/libco/ucontext.c b/libco/ucontext.c deleted file mode 100644 index 3e21816..0000000 --- a/libco/ucontext.c +++ /dev/null @@ -1,81 +0,0 @@ -/* - libco.ucontext (2008-01-28) - author: Nach - license: public domain -*/ - -/* - * WARNING: the overhead of POSIX ucontext is very high, - * assembly versions of libco or libco_sjlj should be much faster - * - * This library only exists for two reasons: - * 1 - as an initial test for the viability of a ucontext implementation - * 2 - to demonstrate the power and speed of libco over existing implementations, - * such as pth (which defaults to wrapping ucontext on unix targets) - * - * Use this library only as a *last resort* - */ - -#define LIBCO_C -#include <libco.h> -#include <stdlib.h> -#include <ucontext.h> - -#ifdef __cplusplus -extern "C" { -#endif - -static thread_local ucontext_t co_primary; -static thread_local ucontext_t *co_running = 0; - -cothread_t co_active(void) -{ - if (!co_running) - co_running = &co_primary; - return (cothread_t)co_running; -} - -cothread_t co_create(unsigned int heapsize, void (*coentry)(void)) -{ - if (!co_running) - co_running = &co_primary; - ucontext_t *thread = (ucontext_t*)malloc(sizeof(ucontext_t)); - - if(thread) - { - if((!getcontext(thread) && !(thread->uc_stack.ss_sp = 0)) && (thread->uc_stack.ss_sp = malloc(heapsize))) - { - thread->uc_link = co_running; - thread->uc_stack.ss_size = heapsize; - makecontext(thread, coentry, 0); - } - else - { - co_delete((cothread_t)thread); - thread = 0; - } - } - return (cothread_t)thread; -} - -void co_delete(cothread_t cothread) -{ - if (!cothread) - return; - - if(((ucontext_t*)cothread)->uc_stack.ss_sp) - free(((ucontext_t*)cothread)->uc_stack.ss_sp); - free(cothread); -} - -void co_switch(cothread_t cothread) -{ - ucontext_t *old_thread = co_running; - - co_running = (ucontext_t*)cothread; - swapcontext(old_thread, co_running); -} - -#ifdef __cplusplus -} -#endif diff --git a/libco/x86.c b/libco/x86.c deleted file mode 100644 index ae16766..0000000 --- a/libco/x86.c +++ /dev/null @@ -1,117 +0,0 @@ -/* - libco.x86 (2009-10-12) - author: byuu - license: public domain -*/ - -#define LIBCO_C -#include <libco.h> -#include <assert.h> -#include <stdlib.h> - -#ifdef __cplusplus -extern "C" { -#endif - -#if defined(_MSC_VER) - #define fastcall __fastcall -#elif defined(__GNUC__) - #define fastcall __attribute__((fastcall)) -#else - #error "libco: please define fastcall macro" -#endif - -static thread_local long co_active_buffer[64]; -static thread_local cothread_t co_active_handle = 0; -static void (fastcall *co_swap)(cothread_t, cothread_t) = 0; - -//ABI: fastcall -static unsigned char co_swap_function[] = { - 0x89, 0x22, /* mov [edx],esp */ - 0x8b, 0x21, /* mov esp,[ecx] */ - 0x58, /* pop eax */ - 0x89, 0x6a, 0x04, /* mov [edx+0x04],ebp */ - 0x89, 0x72, 0x08, /* mov [edx+0x08],esi */ - 0x89, 0x7a, 0x0c, /* mov [edx+0x0c],edi */ - 0x89, 0x5a, 0x10, /* mov [edx+0x10],ebx */ - 0x8b, 0x69, 0x04, /* mov ebp,[ecx+0x04] */ - 0x8b, 0x71, 0x08, /* mov esi,[ecx+0x08] */ - 0x8b, 0x79, 0x0c, /* mov edi,[ecx+0x0c] */ - 0x8b, 0x59, 0x10, /* mov ebx,[ecx+0x10] */ - 0xff, 0xe0, /* jmp eax */ -}; - -#ifdef _WIN32 -#include <windows.h> - -void co_init(void) -{ - DWORD old_privileges; - VirtualProtect(co_swap_function, - sizeof co_swap_function, PAGE_EXECUTE_READWRITE, &old_privileges); -} -#else -#include <unistd.h> -#include <sys/mman.h> - -void co_init(void) -{ - unsigned long addr = (unsigned long)co_swap_function; - unsigned long base = addr - (addr % sysconf(_SC_PAGESIZE)); - unsigned long size = (addr - base) + sizeof co_swap_function; - mprotect((void*)base, size, PROT_READ | PROT_WRITE | PROT_EXEC); -} -#endif - -static void crash(void) -{ - assert(0); /* called only if cothread_t entrypoint returns */ -} - -cothread_t co_active(void) -{ - if(!co_active_handle) - co_active_handle = &co_active_buffer; - return co_active_handle; -} - -cothread_t co_create(unsigned int size, void (*entrypoint)(void)) -{ - cothread_t handle; - if(!co_swap) - { - co_init(); - co_swap = (void (fastcall*)(cothread_t, cothread_t))co_swap_function; - } - - if(!co_active_handle) - co_active_handle = &co_active_buffer; - - size += 256; /* allocate additional space for storage */ - size &= ~15; /* align stack to 16-byte boundary */ - - if((handle = (cothread_t)malloc(size))) - { - long *p = (long*)((char*)handle + size); /* seek to top of stack */ - *--p = (long)crash; /* crash if entrypoint returns */ - *--p = (long)entrypoint; /* start of function */ - *(long*)handle = (long)p; /* stack pointer */ - } - - return handle; -} - -void co_delete(cothread_t handle) -{ - free(handle); -} - -void co_switch(cothread_t handle) -{ - register cothread_t co_previous_handle = co_active_handle; - co_swap(co_active_handle = handle, co_previous_handle); -} - -#ifdef __cplusplus -} -#endif |