update vibration handling
[pcsx_rearmed.git] / deps / libretro-common / libco / armeabi.c
1 /*
2   libco.armeabi (2013-04-05)
3   author: Themaister
4   license: public domain
5 */
6
7 #define LIBCO_C
8 #include <libco.h>
9 #include <assert.h>
10 #include <stdlib.h>
11 #include <string.h>
12 #include <stdint.h>
13
14 #ifndef __APPLE__
15 #include <malloc.h>
16 #endif
17
18 #ifdef __cplusplus
19 extern "C" {
20 #endif
21
22 static thread_local uint32_t co_active_buffer[64];
23 static thread_local cothread_t co_active_handle;
24
25 __asm__ (
26 #if defined(__thumb2__)
27       ".align 2\n"
28       ".globl co_switch_arm\n"
29       ".globl _co_switch_arm\n"
30       ".thumb\n"
31       ".thumb_func\n"
32       ".type   co_switch_arm, %function\n"
33       ".type   _co_switch_arm, %function\n"
34       "co_switch_arm:\n"
35       "_co_switch_arm:\n"
36       " mov r3, sp\n"
37       " stmia r1!, {r4, r5, r6, r7, r8, r9, r10, r11}\n"
38       " stmia r1!, {r3, lr}\n"
39       " ldmia r0!, {r4, r5, r6, r7, r8, r9, r10, r11}\n"
40       " ldmfd r0!, { r3 }\n"
41       " mov sp, r3\n"
42       " ldmfd r0!, { r3 }\n"
43       " mov pc, r3\n"
44 #else
45       ".arm\n"
46       ".align 4\n"
47       ".globl co_switch_arm\n"
48       ".globl _co_switch_arm\n"
49       "co_switch_arm:\n"
50       "_co_switch_arm:\n"
51       "  stmia r1!, {r4, r5, r6, r7, r8, r9, r10, r11, sp, lr}\n"
52       "  ldmia r0!, {r4, r5, r6, r7, r8, r9, r10, r11, sp, pc}\n"
53 #endif
54     );
55
56 /* ASM */
57 void co_switch_arm(cothread_t handle, cothread_t current);
58
59 cothread_t co_create(unsigned int size, void (*entrypoint)(void))
60 {
61    uint32_t *ptr     = NULL;
62    cothread_t handle = 0;
63    size              = (size + 1023) & ~1023;
64 #if defined(__APPLE__) || HAVE_POSIX_MEMALIGN >= 1
65    if (posix_memalign(&handle, 1024, size + 256) < 0)
66       return 0;
67 #else
68    handle = memalign(1024, size + 256);
69 #endif
70
71    if (!handle)
72       return handle;
73
74    ptr    = (uint32_t*)handle;
75    /* Non-volatiles.  */
76    ptr[0] = 0; /* r4  */
77    ptr[1] = 0; /* r5  */
78    ptr[2] = 0; /* r6  */
79    ptr[3] = 0; /* r7  */
80    ptr[4] = 0; /* r8  */
81    ptr[5] = 0; /* r9  */
82    ptr[6] = 0; /* r10 */
83    ptr[7] = 0; /* r11 */
84    /* Align stack to 64-bit */
85    ptr[8] = (uintptr_t)ptr + size + 256 - 8; /* r13, stack pointer */
86    ptr[9] = (uintptr_t)entrypoint; /* r15, PC (link register r14 gets saved here). */
87    return handle;
88 }
89
90 cothread_t co_active(void)
91 {
92    if (!co_active_handle)
93       co_active_handle = co_active_buffer;
94    return co_active_handle;
95 }
96
97 void co_delete(cothread_t handle)
98 {
99    free(handle);
100 }
101
102 void co_switch(cothread_t handle)
103 {
104    cothread_t co_previous_handle = co_active();
105    co_switch_arm(co_active_handle = handle, co_previous_handle);
106 }
107
108 #ifdef __cplusplus
109 }
110 #endif