Skip to content

Implement and use generic mips libco #155

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Open
wants to merge 5 commits into
base: master
Choose a base branch
from
Open

Implement and use generic mips libco #155

Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
5 commits
Select commit Hold shift + click to select a range
9292bc4
libco mips
phcoder Apr 26, 2020
f6e0e48
Add VFP saving and restore
phcoder Apr 26, 2020
13ce550
libco/mips: Optimize storage for 32-bit CPUs
phcoder Apr 26, 2020
e9b940d
Clarify license status
phcoder Apr 26, 2020
ad043c1
Increase sp alignment to 16 bytes for safety
phcoder Apr 27, 2020
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
2 changes: 2 additions & 0 deletions libco/libco.c
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -33,6 +33,8 @@ void genode_free_secondary_stack(void *stack);
#include "psp1.c"
#elif defined VITA
#include "scefiber.c"
#elif defined(__mips__)
#include "mips.c"
#elif defined(__ARM_EABI__) || defined(__arm__)
#include "armeabi.c"
#else
Expand Down
243 changes: 243 additions & 0 deletions libco/mips.c
View file
Open in desktop
Original file line number Diff line number Diff line change
@@ -0,0 +1,243 @@
/*
libco.mips (2020-04-20)
author: phcoder
copyright: Google
license: MIT
*/

#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

#if __mips >= 3
/* If we have 64-bit registers. */
#define STORE_REG "sd"
#define LOAD_REG "ld"
#define _GPR_OFF(x) (x * 8)
#define _VFPOFF0 (12 * 8 + 12 * 4)
typedef uint64_t gpr_t;
#else
/* 32-bit only variant. */
#define STORE_REG "sw"
#define LOAD_REG "lw"
#define _GPR_OFF(x) (x * 4)
typedef uint32_t gpr_t;
#endif
#define _STR(x) #x
#define STR(x) _STR(x)
#define GPR_OFF(x) STR(_GPR_OFF(x))
/* Argument to GPR_OFF must be divisible by 4 and be >= number of saved GPR registers. */
#define _FPR_OFF(x) ((x * 4) + _GPR_OFF(12))
#define FPR_OFF(x) STR(_FPR_OFF(x))
/* Argument to FPR_OFF must be divisible by 4 and be >= number of saved FPR registers. */
#define _VFP_OFF(x) ((x * 16) + _FPR_OFF(12))
#define VFP_OFF(x) STR(_VFP_OFF(x))
#define HAVE_FP 1
#ifdef __psp__
#define HAVE_VFP 1
#else
#define HAVE_VFP 0
#endif

#define CONTEXT_SIZE 0x300

static thread_local uint64_t co_active_buffer[CONTEXT_SIZE / 8] __attribute__((__aligned__((16))));
static thread_local cothread_t co_active_handle;

__asm__ (
".align 4\n"
".globl co_switch_mips\n"
".globl _co_switch_mips\n"
"co_switch_mips:\n"
"_co_switch_mips:\n"
STORE_REG " $s0, " GPR_OFF(0) "($a1)\n"
STORE_REG " $s1, " GPR_OFF(1) "($a1)\n"
STORE_REG " $s2, " GPR_OFF(2) "($a1)\n"
STORE_REG " $s3, " GPR_OFF(3) "($a1)\n"
STORE_REG " $s4, " GPR_OFF(4) "($a1)\n"
STORE_REG " $s5, " GPR_OFF(5) "($a1)\n"
STORE_REG " $s6, " GPR_OFF(6) "($a1)\n"
STORE_REG " $s7, " GPR_OFF(7) "($a1)\n"
STORE_REG " $gp, " GPR_OFF(8) "($a1)\n"
STORE_REG " $sp, " GPR_OFF(9) "($a1)\n"
STORE_REG " $fp, " GPR_OFF(10) "($a1)\n"
STORE_REG " $ra, " GPR_OFF(11) "($a1)\n"
#if HAVE_FP
" swc1 $f20, " FPR_OFF(0) "($a1)\n"
" swc1 $f21, " FPR_OFF(1) "($a1)\n"
" swc1 $f22, " FPR_OFF(2) "($a1)\n"
" swc1 $f23, " FPR_OFF(3) "($a1)\n"
" swc1 $f24, " FPR_OFF(4) "($a1)\n"
" swc1 $f25, " FPR_OFF(5) "($a1)\n"
" swc1 $f26, " FPR_OFF(6) "($a1)\n"
" swc1 $f27, " FPR_OFF(7) "($a1)\n"
" swc1 $f28, " FPR_OFF(8) "($a1)\n"
" swc1 $f29, " FPR_OFF(9) "($a1)\n"
" swc1 $f30, " FPR_OFF(10) "($a1)\n"
#endif
#if HAVE_VFP
" sv.q c000, " VFP_OFF(0) "($a1), wt\n"
" sv.q c010, " VFP_OFF(1) "($a1), wt\n"
" sv.q c020, " VFP_OFF(2) "($a1), wt\n"
" sv.q c030, " VFP_OFF(3) "($a1), wt\n"
" sv.q c100, " VFP_OFF(4) "($a1), wt\n"
" sv.q c110, " VFP_OFF(5) "($a1), wt\n"
" sv.q c120, " VFP_OFF(6) "($a1), wt\n"
" sv.q c130, " VFP_OFF(7) "($a1), wt\n"
" sv.q c200, " VFP_OFF(8) "($a1), wt\n"
" sv.q c210, " VFP_OFF(9) "($a1), wt\n"
" sv.q c220, " VFP_OFF(10) "($a1), wt\n"
" sv.q c230, " VFP_OFF(11) "($a1), wt\n"
" sv.q c300, " VFP_OFF(12) "($a1), wt\n"
" sv.q c310, " VFP_OFF(13) "($a1), wt\n"
" sv.q c320, " VFP_OFF(14) "($a1), wt\n"
" sv.q c330, " VFP_OFF(15) "($a1), wt\n"
" sv.q c400, " VFP_OFF(16) "($a1), wt\n"
" sv.q c410, " VFP_OFF(17) "($a1), wt\n"
" sv.q c420, " VFP_OFF(18) "($a1), wt\n"
" sv.q c430, " VFP_OFF(19) "($a1), wt\n"
" sv.q c500, " VFP_OFF(20) "($a1), wt\n"
" sv.q c510, " VFP_OFF(21) "($a1), wt\n"
" sv.q c520, " VFP_OFF(22) "($a1), wt\n"
" sv.q c530, " VFP_OFF(23) "($a1), wt\n"
" sv.q c600, " VFP_OFF(24) "($a1), wt\n"
" sv.q c610, " VFP_OFF(25) "($a1), wt\n"
" sv.q c620, " VFP_OFF(26) "($a1), wt\n"
" sv.q c630, " VFP_OFF(27) "($a1), wt\n"
" sv.q c700, " VFP_OFF(28) "($a1), wt\n"
" sv.q c710, " VFP_OFF(29) "($a1), wt\n"
" sv.q c720, " VFP_OFF(30) "($a1), wt\n"
" sv.q c730, " VFP_OFF(31) "($a1), wt\n"
#endif
LOAD_REG " $s0, " GPR_OFF(0) "($a0)\n"
LOAD_REG " $s1, " GPR_OFF(1) "($a0)\n"
LOAD_REG " $s2, " GPR_OFF(2) "($a0)\n"
LOAD_REG " $s3, " GPR_OFF(3) "($a0)\n"
LOAD_REG " $s4, " GPR_OFF(4) "($a0)\n"
LOAD_REG " $s5, " GPR_OFF(5) "($a0)\n"
LOAD_REG " $s6, " GPR_OFF(6) "($a0)\n"
LOAD_REG " $s7, " GPR_OFF(7) "($a0)\n"
LOAD_REG " $gp, " GPR_OFF(8) "($a0)\n"
LOAD_REG " $sp, " GPR_OFF(9) "($a0)\n"
LOAD_REG " $fp, " GPR_OFF(10) "($a0)\n"
LOAD_REG " $ra, " GPR_OFF(11) "($a0)\n"
#if HAVE_FP
" lwc1 $f20, " FPR_OFF(0) "($a0)\n"
" lwc1 $f21, " FPR_OFF(1) "($a0)\n"
" lwc1 $f22, " FPR_OFF(2) "($a0)\n"
" lwc1 $f23, " FPR_OFF(3) "($a0)\n"
" lwc1 $f24, " FPR_OFF(4) "($a0)\n"
" lwc1 $f25, " FPR_OFF(5) "($a0)\n"
" lwc1 $f26, " FPR_OFF(6) "($a0)\n"
" lwc1 $f27, " FPR_OFF(7) "($a0)\n"
" lwc1 $f28, " FPR_OFF(8) "($a0)\n"
" lwc1 $f29, " FPR_OFF(9) "($a0)\n"
" lwc1 $f30, " FPR_OFF(10) "($a0)\n"
#endif
#if HAVE_VFP
" lv.q c000, " VFP_OFF(0) "($a0)\n"
" lv.q c010, " VFP_OFF(1) "($a0)\n"
" lv.q c020, " VFP_OFF(2) "($a0)\n"
" lv.q c030, " VFP_OFF(3) "($a0)\n"
" lv.q c100, " VFP_OFF(4) "($a0)\n"
" lv.q c110, " VFP_OFF(5) "($a0)\n"
" lv.q c120, " VFP_OFF(6) "($a0)\n"
" lv.q c130, " VFP_OFF(7) "($a0)\n"
" lv.q c200, " VFP_OFF(8) "($a0)\n"
" lv.q c210, " VFP_OFF(9) "($a0)\n"
" lv.q c220, " VFP_OFF(10) "($a0)\n"
" lv.q c230, " VFP_OFF(11) "($a0)\n"
" lv.q c300, " VFP_OFF(12) "($a0)\n"
" lv.q c310, " VFP_OFF(13) "($a0)\n"
" lv.q c320, " VFP_OFF(14) "($a0)\n"
" lv.q c330, " VFP_OFF(15) "($a0)\n"
" lv.q c400, " VFP_OFF(16) "($a0)\n"
" lv.q c410, " VFP_OFF(17) "($a0)\n"
" lv.q c420, " VFP_OFF(18) "($a0)\n"
" lv.q c430, " VFP_OFF(19) "($a0)\n"
" lv.q c500, " VFP_OFF(20) "($a0)\n"
" lv.q c510, " VFP_OFF(21) "($a0)\n"
" lv.q c520, " VFP_OFF(22) "($a0)\n"
" lv.q c530, " VFP_OFF(23) "($a0)\n"
" lv.q c600, " VFP_OFF(24) "($a0)\n"
" lv.q c610, " VFP_OFF(25) "($a0)\n"
" lv.q c620, " VFP_OFF(26) "($a0)\n"
" lv.q c630, " VFP_OFF(27) "($a0)\n"
" lv.q c700, " VFP_OFF(28) "($a0)\n"
" lv.q c710, " VFP_OFF(29) "($a0)\n"
" lv.q c720, " VFP_OFF(30) "($a0)\n"
" lv.q c730, " VFP_OFF(31) "($a0)\n"
#endif
" jr $ra\n"
" nop\n"
".align 4\n"
".globl store_gp\n"
".globl _store_gp\n"
"store_gp:\n"
"_store_gp:\n"
STORE_REG " $gp, 0($a0)\n"
" jr $ra\n"
" nop\n"
);

/* ASM */
void co_switch_mips(cothread_t handle, cothread_t current);
void store_gp(gpr_t *s);

cothread_t co_create(unsigned int size, void (*entrypoint)(void))
{
size = (size + CONTEXT_SIZE + 1023) & ~1023;
cothread_t handle = 0;
#if defined(__APPLE__) || HAVE_POSIX_MEMALIGN >= 1
if (posix_memalign(&handle, 1024, size) < 0)
return 0;
#else
handle = memalign(1024, size);
#endif

if (!handle)
return handle;

gpr_t *ptr = (gpr_t*)handle;
memset(ptr, 0, CONTEXT_SIZE);
/* Non-volatiles. */
/* ptr[0],..., ptr[7] -> s0,..., s7 */
store_gp(&ptr[8]); /* gp */
ptr[9] = (uintptr_t)ptr + size - 16; /* sp */
/* ptr[10] is fp */
ptr[11] = (uintptr_t)entrypoint; /* ra */
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_mips(co_active_handle = handle, co_previous_handle);
}

#ifdef __cplusplus
}
#endif