start implementing the libretro interface. (not working yet)
This commit is contained in:
aliaspider
parent
35e1e44a11
commit
365077772d
|
|
@ -0,0 +1,66 @@
|
||||||
|
TARGET := gpsp_libretro.so
|
||||||
|
|
||||||
|
CC = gcc
|
||||||
|
AR = psp-ar
|
||||||
|
STATIC_LINKING = 0
|
||||||
|
|
||||||
|
CFLAGS += -fPIC
|
||||||
|
CFLAGS += -DPC_BUILD -Wall -m32
|
||||||
|
CFLAGS += -D__LIBRETRO__
|
||||||
|
|
||||||
|
|
||||||
|
ifeq ($(DEBUG), 1)
|
||||||
|
OPTIMIZE := -O0 -g
|
||||||
|
OPTIMIZE_SAFE := -O0 -g
|
||||||
|
else
|
||||||
|
OPTIMIZE := -O3
|
||||||
|
OPTIMIZE_SAFE := -O2
|
||||||
|
endif
|
||||||
|
|
||||||
|
|
||||||
|
OBJS := main.o
|
||||||
|
OBJS += cpu.o
|
||||||
|
OBJS += memory.o
|
||||||
|
OBJS += video.o
|
||||||
|
OBJS += input.o
|
||||||
|
OBJS += sound.o
|
||||||
|
OBJS += cpu_threaded.o
|
||||||
|
|
||||||
|
OBJS += x86_stub.o
|
||||||
|
OBJS += cheats.o
|
||||||
|
OBJS += zip.o
|
||||||
|
|
||||||
|
OBJS += libretro.o
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
ASFLAGS = $(CFLAGS)
|
||||||
|
INCDIRS := -I.
|
||||||
|
LDFLAGS += -shared -m32
|
||||||
|
LDLIBS += -lz
|
||||||
|
|
||||||
|
|
||||||
|
all: $(TARGET)
|
||||||
|
|
||||||
|
$(TARGET): $(OBJS)
|
||||||
|
ifeq ($(STATIC_LINKING), 1)
|
||||||
|
$(AR) rcs $@ $(OBJS)
|
||||||
|
else
|
||||||
|
$(CC) -o $@ $(CFLAGS) $^ $(LDFLAGS) $(LDLIBS)
|
||||||
|
endif
|
||||||
|
|
||||||
|
%.o: %.c
|
||||||
|
$(CC) -c -o $@ $< $(CFLAGS) $(OPTIMIZE) $(INCDIRS)
|
||||||
|
|
||||||
|
cpu.o: cpu.c
|
||||||
|
$(CC) -c -o $@ $< $(CFLAGS) -Wno-unused-variable -Wno-unused-label $(OPTIMIZE_SAFE) $(INCDIRS)
|
||||||
|
|
||||||
|
%.o: %.S
|
||||||
|
$(CC) -c -o $@ $< $(ASFLAGS) $(OPTIMIZE)
|
||||||
|
|
||||||
|
clean:
|
||||||
|
# rm -f main.o cpu.o memory.o video.o input.o sound.o cpu_threaded.o x86_stub.o cheats.o zip.o libretro.o
|
||||||
|
rm -f $(OBJS)
|
||||||
|
rm -f $(TARGET)
|
||||||
|
|
||||||
|
.PHONY: $(TARGET) clean
|
||||||
|
|
@ -0,0 +1,37 @@
|
||||||
|
/*
|
||||||
|
libco
|
||||||
|
version: 0.16 (2010-12-24)
|
||||||
|
license: public domain
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef LIBCO_H
|
||||||
|
#define LIBCO_H
|
||||||
|
|
||||||
|
#ifdef LIBCO_C
|
||||||
|
#ifdef LIBCO_MP
|
||||||
|
#define thread_local __thread
|
||||||
|
#else
|
||||||
|
#define thread_local
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
typedef void* cothread_t;
|
||||||
|
|
||||||
|
cothread_t co_active(void);
|
||||||
|
|
||||||
|
cothread_t co_create(unsigned int, void (*)(void));
|
||||||
|
|
||||||
|
void co_delete(cothread_t);
|
||||||
|
|
||||||
|
void co_switch(cothread_t);
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* ifndef LIBCO_H */
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,161 @@
|
||||||
|
/*
|
||||||
|
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
|
||||||
|
|
@ -0,0 +1,95 @@
|
||||||
|
/*
|
||||||
|
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
|
||||||
|
|
||||||
|
|
@ -0,0 +1,58 @@
|
||||||
|
/*
|
||||||
|
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
|
||||||
|
|
@ -0,0 +1,21 @@
|
||||||
|
/*
|
||||||
|
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(__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
|
||||||
|
|
@ -0,0 +1,407 @@
|
||||||
|
/*
|
||||||
|
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 );
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,115 @@
|
||||||
|
/*
|
||||||
|
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
|
||||||
|
|
@ -0,0 +1,81 @@
|
||||||
|
/*
|
||||||
|
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
|
||||||
|
|
@ -0,0 +1,117 @@
|
||||||
|
/*
|
||||||
|
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
|
||||||
|
|
@ -0,0 +1,291 @@
|
||||||
|
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include "common.h"
|
||||||
|
#include "libco.h"
|
||||||
|
|
||||||
|
static retro_log_printf_t log_cb;
|
||||||
|
static retro_video_refresh_t video_cb;
|
||||||
|
static retro_input_poll_t input_poll_cb;
|
||||||
|
static retro_environment_t environ_cb;
|
||||||
|
|
||||||
|
struct retro_perf_callback perf_cb;
|
||||||
|
|
||||||
|
static cothread_t main_thread;
|
||||||
|
static cothread_t cpu_thread;
|
||||||
|
|
||||||
|
void switch_to_main_thread(void)
|
||||||
|
{
|
||||||
|
co_switch(main_thread);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void switch_to_cpu_thread(void)
|
||||||
|
{
|
||||||
|
co_switch(cpu_thread);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void cpu_thread_entry(void)
|
||||||
|
{
|
||||||
|
execute_arm_translate(reg[EXECUTE_CYCLES]);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void init_context_switch(void)
|
||||||
|
{
|
||||||
|
main_thread = co_active();
|
||||||
|
cpu_thread = co_create(0x20000, cpu_thread_entry);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void deinit_context_switch(void)
|
||||||
|
{
|
||||||
|
co_delete(cpu_thread);
|
||||||
|
}
|
||||||
|
|
||||||
|
void retro_get_system_info(struct retro_system_info *info)
|
||||||
|
{
|
||||||
|
info->library_name = "TempGBA";
|
||||||
|
info->library_version = "v0.0.1";
|
||||||
|
info->need_fullpath = true;
|
||||||
|
info->block_extract = false;
|
||||||
|
info->valid_extensions = "gba|bin|agb|gbz" ;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void retro_get_system_av_info(struct retro_system_av_info *info)
|
||||||
|
{
|
||||||
|
info->geometry.base_width = GBA_SCREEN_WIDTH;
|
||||||
|
info->geometry.base_height = GBA_SCREEN_HEIGHT;
|
||||||
|
info->geometry.max_width = GBA_SCREEN_WIDTH;
|
||||||
|
info->geometry.max_height = GBA_SCREEN_HEIGHT;
|
||||||
|
info->geometry.aspect_ratio = 0;
|
||||||
|
info->timing.fps = ((float) CPU_FREQUENCY) / (308 * 228 * 4); // 59.72750057 hz
|
||||||
|
info->timing.sample_rate = SOUND_FREQUENCY;
|
||||||
|
// info->timing.sample_rate = 32 * 1024;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void retro_init()
|
||||||
|
{
|
||||||
|
init_gamepak_buffer();
|
||||||
|
init_sound();
|
||||||
|
}
|
||||||
|
|
||||||
|
void retro_deinit()
|
||||||
|
{
|
||||||
|
perf_cb.perf_log();
|
||||||
|
quit_gba();
|
||||||
|
}
|
||||||
|
|
||||||
|
void retro_set_environment(retro_environment_t cb)
|
||||||
|
{
|
||||||
|
struct retro_log_callback log;
|
||||||
|
|
||||||
|
environ_cb = cb;
|
||||||
|
|
||||||
|
if (environ_cb(RETRO_ENVIRONMENT_GET_LOG_INTERFACE, &log))
|
||||||
|
log_cb = log.log;
|
||||||
|
else
|
||||||
|
log_cb = NULL;
|
||||||
|
|
||||||
|
environ_cb(RETRO_ENVIRONMENT_GET_PERF_INTERFACE, &perf_cb);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void retro_set_video_refresh(retro_video_refresh_t cb) { video_cb = cb; }
|
||||||
|
void retro_set_input_poll(retro_input_poll_t cb) { input_poll_cb = cb; }
|
||||||
|
|
||||||
|
void retro_set_controller_port_device(unsigned port, unsigned device) {}
|
||||||
|
|
||||||
|
void retro_reset()
|
||||||
|
{
|
||||||
|
deinit_context_switch();
|
||||||
|
|
||||||
|
update_backup();
|
||||||
|
reset_gba();
|
||||||
|
|
||||||
|
init_context_switch();
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
size_t retro_serialize_size()
|
||||||
|
{
|
||||||
|
return SAVESTATE_SIZE;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool retro_serialize(void *data, size_t size)
|
||||||
|
{
|
||||||
|
if (size < SAVESTATE_SIZE)
|
||||||
|
return false;
|
||||||
|
|
||||||
|
gba_save_state(data);
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool retro_unserialize(const void *data, size_t size)
|
||||||
|
{
|
||||||
|
if (size < SAVESTATE_SIZE)
|
||||||
|
return false;
|
||||||
|
|
||||||
|
gba_load_state(data);
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void retro_cheat_reset() {}
|
||||||
|
void retro_cheat_set(unsigned index, bool enabled, const char *code) {}
|
||||||
|
|
||||||
|
void error_msg(const char *text)
|
||||||
|
{
|
||||||
|
if (log_cb)
|
||||||
|
log_cb(RETRO_LOG_ERROR, text);
|
||||||
|
}
|
||||||
|
|
||||||
|
void info_msg(const char *text)
|
||||||
|
{
|
||||||
|
if (log_cb)
|
||||||
|
log_cb(RETRO_LOG_INFO, text);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void extract_directory(char *buf, const char *path, size_t size)
|
||||||
|
{
|
||||||
|
strncpy(buf, path, size - 1);
|
||||||
|
buf[size - 1] = '\0';
|
||||||
|
|
||||||
|
char *base = strrchr(buf, '/');
|
||||||
|
|
||||||
|
if (base)
|
||||||
|
*base = '\0';
|
||||||
|
else
|
||||||
|
strncpy(buf, ".", size);
|
||||||
|
}
|
||||||
|
|
||||||
|
bool retro_load_game(const struct retro_game_info *info)
|
||||||
|
{
|
||||||
|
char filename_bios[MAX_PATH];
|
||||||
|
const char *dir = NULL;
|
||||||
|
|
||||||
|
enum retro_pixel_format fmt = RETRO_PIXEL_FORMAT_RGB565;
|
||||||
|
if (!environ_cb(RETRO_ENVIRONMENT_SET_PIXEL_FORMAT, &fmt))
|
||||||
|
{
|
||||||
|
if (log_cb)
|
||||||
|
log_cb(RETRO_LOG_INFO, "[TempGBA]: 0RGB1555 is not supported.\n");
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
extract_directory(main_path,info->path,sizeof(main_path));
|
||||||
|
|
||||||
|
if (environ_cb(RETRO_ENVIRONMENT_GET_SYSTEM_DIRECTORY, &dir) && dir)
|
||||||
|
strncpy(filename_bios, dir, sizeof(filename_bios));
|
||||||
|
else
|
||||||
|
strncpy(filename_bios, main_path, sizeof(filename_bios));
|
||||||
|
|
||||||
|
strncat(filename_bios, "/gba_bios.bin",sizeof(filename_bios));
|
||||||
|
|
||||||
|
|
||||||
|
if (environ_cb(RETRO_ENVIRONMENT_GET_SAVE_DIRECTORY, &dir) && dir)
|
||||||
|
strncpy(dir_save, dir, sizeof(dir_save));
|
||||||
|
else
|
||||||
|
strncpy(dir_save, main_path, sizeof(dir_save));
|
||||||
|
|
||||||
|
strncat(dir_save, "/",sizeof(dir_save));
|
||||||
|
|
||||||
|
strncat(main_path, "/",sizeof(main_path));
|
||||||
|
|
||||||
|
if (load_bios(filename_bios) < 0)
|
||||||
|
{
|
||||||
|
error_msg("Could not load BIOS image file.\n");
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
gamepak_filename[0] = 0;
|
||||||
|
|
||||||
|
if (load_gamepak(info->path) < 0)
|
||||||
|
{
|
||||||
|
error_msg("Could not load the game file.\n");
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
reset_gba();
|
||||||
|
|
||||||
|
init_context_switch();
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
bool retro_load_game_special(unsigned game_type, const struct retro_game_info *info, size_t num_info)
|
||||||
|
{ return false; }
|
||||||
|
|
||||||
|
void retro_unload_game()
|
||||||
|
{
|
||||||
|
deinit_context_switch();
|
||||||
|
update_backup();
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned retro_get_region() { return RETRO_REGION_NTSC; }
|
||||||
|
|
||||||
|
void *retro_get_memory_data(unsigned id)
|
||||||
|
{
|
||||||
|
// switch (id)
|
||||||
|
// {
|
||||||
|
// case RETRO_MEMORY_SAVE_RAM:
|
||||||
|
// return gamepak_backup;
|
||||||
|
// }
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
size_t retro_get_memory_size(unsigned id)
|
||||||
|
{
|
||||||
|
// switch (id)
|
||||||
|
// {
|
||||||
|
// case RETRO_MEMORY_SAVE_RAM:
|
||||||
|
// switch(backup_type)
|
||||||
|
// {
|
||||||
|
// case BACKUP_SRAM:
|
||||||
|
// return sram_size;
|
||||||
|
|
||||||
|
// case BACKUP_FLASH:
|
||||||
|
// return flash_size;
|
||||||
|
|
||||||
|
// case BACKUP_EEPROM:
|
||||||
|
// return eeprom_size;
|
||||||
|
|
||||||
|
// case BACKUP_NONE:
|
||||||
|
// return 0x0;
|
||||||
|
|
||||||
|
// default:
|
||||||
|
// return 0x8000;
|
||||||
|
// }
|
||||||
|
// }
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void check_variables(void)
|
||||||
|
{
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void retro_run()
|
||||||
|
{
|
||||||
|
bool updated = false;
|
||||||
|
|
||||||
|
input_poll_cb();
|
||||||
|
|
||||||
|
switch_to_cpu_thread();
|
||||||
|
|
||||||
|
update_input();
|
||||||
|
|
||||||
|
render_audio();
|
||||||
|
|
||||||
|
video_cb(GBA_FRAME_TEXTURE, GBA_SCREEN_WIDTH, GBA_SCREEN_HEIGHT, 512);
|
||||||
|
|
||||||
|
if (environ_cb(RETRO_ENVIRONMENT_GET_VARIABLE_UPDATE, &updated) && updated)
|
||||||
|
check_variables();
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned retro_api_version() { return RETRO_API_VERSION; }
|
||||||
File diff suppressed because it is too large
Load Diff
Loading…
Reference in New Issue