1 | /* |
1 | /* |
2 | * Copyright (c) 2001 Marc Alexander Lehmann <pcg@goof.com> |
2 | * Copyright (c) 2001-2006 Marc Alexander Lehmann <schmorp@schmorp.de> |
3 | * |
3 | * |
4 | * Redistribution and use in source and binary forms, with or without modifica- |
4 | * Redistribution and use in source and binary forms, with or without modifica- |
5 | * tion, are permitted provided that the following conditions are met: |
5 | * tion, are permitted provided that the following conditions are met: |
6 | * |
6 | * |
7 | * 1. Redistributions of source code must retain the above copyright notice, |
7 | * 1. Redistributions of source code must retain the above copyright notice, |
… | |
… | |
30 | * go to Ralf S. Engelschall <rse@engelschall.com>. |
30 | * go to Ralf S. Engelschall <rse@engelschall.com>. |
31 | */ |
31 | */ |
32 | |
32 | |
33 | #include "coro.h" |
33 | #include "coro.h" |
34 | |
34 | |
35 | #if CORO_LOOSE || CORO_SJLJ || CORO_LINUX |
35 | #if !defined(STACK_ADJUST_PTR) |
|
|
36 | /* IRIX is decidedly NON-unix */ |
|
|
37 | # if __sgi |
|
|
38 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8) |
|
|
39 | # define STACK_ADJUST_SIZE(sp,ss) ((ss) - 8) |
|
|
40 | # elif __i386__ && CORO_LINUX |
|
|
41 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss)) |
|
|
42 | # define STACK_ADJUST_SIZE(sp,ss) (ss) |
|
|
43 | # elif __amd64__ && CORO_LINUX |
|
|
44 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8) |
|
|
45 | # define STACK_ADJUST_SIZE(sp,ss) (ss) |
|
|
46 | # else |
|
|
47 | # define STACK_ADJUST_PTR(sp,ss) (sp) |
|
|
48 | # define STACK_ADJUST_SIZE(sp,ss) (ss) |
|
|
49 | # endif |
|
|
50 | #endif |
36 | |
51 | |
|
|
52 | #if CORO_UCONTEXT |
|
|
53 | # include <stddef.h> |
|
|
54 | #endif |
|
|
55 | |
|
|
56 | #if CORO_SJLJ || CORO_LOSER || CORO_LINUX || CORO_IRIX |
|
|
57 | |
|
|
58 | #include <stdlib.h> |
|
|
59 | |
|
|
60 | #if CORO_SJLJ |
|
|
61 | # include <stdio.h> |
37 | #include <signal.h> |
62 | # include <signal.h> |
|
|
63 | # include <unistd.h> |
|
|
64 | #endif |
38 | |
65 | |
39 | static volatile coro_func coro_init_func; |
66 | static volatile coro_func coro_init_func; |
40 | static volatile void *coro_init_arg; |
67 | static volatile void *coro_init_arg; |
41 | static volatile coro_context *new_coro, *create_coro; |
68 | static volatile coro_context *new_coro, *create_coro; |
|
|
69 | |
|
|
70 | /* what we really want to detect here is wether we use a new-enough version of GAS */ |
|
|
71 | /* instead, check for gcc 3 and ELF and hope for the best */ |
|
|
72 | #if __GNUC__ >= 3 && __ELF__ |
|
|
73 | # define HAVE_CFI 1 |
|
|
74 | #endif |
42 | |
75 | |
43 | static void |
76 | static void |
44 | coro_init (void) |
77 | coro_init (void) |
45 | { |
78 | { |
46 | volatile coro_func func = coro_init_func; |
79 | volatile coro_func func = coro_init_func; |
… | |
… | |
53 | /* the new coro returned. bad. just abort() for now */ |
86 | /* the new coro returned. bad. just abort() for now */ |
54 | abort (); |
87 | abort (); |
55 | } |
88 | } |
56 | |
89 | |
57 | # if CORO_SJLJ |
90 | # if CORO_SJLJ |
58 | # define coro_save(ctx) (void)setjmp((ctx)->env) |
|
|
59 | |
91 | |
60 | static volatile int trampoline_count; |
92 | static volatile int trampoline_count; |
61 | |
93 | |
62 | /* trampoline signal handler */ |
94 | /* trampoline signal handler */ |
63 | static void |
95 | static void |
64 | trampoline(int sig) |
96 | trampoline (int sig) |
65 | { |
97 | { |
66 | if (setjmp (((coro_context *)new_coro)->env)) |
98 | if (setjmp (((coro_context *)new_coro)->env)) |
|
|
99 | { |
|
|
100 | #if HAVE_CFI |
|
|
101 | asm (".cfi_startproc"); |
|
|
102 | #endif |
67 | coro_init (); /* start it */ |
103 | coro_init (); /* start it */ |
|
|
104 | #if HAVE_CFI |
|
|
105 | asm (".cfi_endproc"); |
|
|
106 | #endif |
|
|
107 | } |
68 | else |
108 | else |
69 | trampoline_count++; |
109 | trampoline_count++; |
70 | } |
110 | } |
71 | |
111 | |
72 | # endif |
112 | # endif |
73 | |
113 | |
74 | #elif CORO_UCONTEXT |
|
|
75 | # define coro_save(ctx) getcontext(&((ctx)->uc)) |
|
|
76 | #endif |
114 | #endif |
77 | |
115 | |
78 | /* initialize a machine state */ |
116 | /* initialize a machine state */ |
79 | void coro_create(coro_context *ctx, |
117 | void coro_create (coro_context *ctx, |
80 | coro_func coro, void *arg, |
118 | coro_func coro, void *arg, |
81 | void *sptr, long ssize) |
119 | void *sptr, long ssize) |
82 | { |
120 | { |
83 | #if CORO_UCONTEXT |
121 | #if CORO_UCONTEXT |
84 | |
122 | |
85 | getcontext (&(ctx->uc)); |
123 | getcontext (&(ctx->uc)); |
86 | |
124 | |
87 | ctx->uc.uc_link = 0; |
125 | ctx->uc.uc_link = 0; |
88 | ctx->uc.uc_stack.ss_sp = sptr; |
126 | ctx->uc.uc_stack.ss_sp = STACK_ADJUST_PTR (sptr,ssize); |
89 | ctx->uc.uc_stack.ss_size = (size_t) ssize; |
127 | ctx->uc.uc_stack.ss_size = (size_t) STACK_ADJUST_SIZE (sptr,ssize); |
90 | ctx->uc.uc_stack.ss_flags = 0; |
128 | ctx->uc.uc_stack.ss_flags = 0; |
91 | |
129 | |
92 | makecontext (&(ctx->uc), (void (*)()) coro, 1, arg); |
130 | makecontext (&(ctx->uc), (void (*)()) coro, 1, arg); |
93 | |
131 | |
94 | #elif CORO_SJLJ || CORO_LOOSE || CORO_LINUX |
132 | #elif CORO_SJLJ || CORO_LOSER || CORO_LINUX || CORO_IRIX |
95 | |
133 | |
96 | # if CORO_SJLJ |
134 | # if CORO_SJLJ |
97 | stack_t ostk, nstk; |
135 | stack_t ostk, nstk; |
98 | struct sigaction osa, nsa; |
136 | struct sigaction osa, nsa; |
99 | sigset_t nsig, osig; |
137 | sigset_t nsig, osig; |
… | |
… | |
116 | nsa.sa_handler = trampoline; |
154 | nsa.sa_handler = trampoline; |
117 | sigemptyset (&nsa.sa_mask); |
155 | sigemptyset (&nsa.sa_mask); |
118 | nsa.sa_flags = SA_ONSTACK; |
156 | nsa.sa_flags = SA_ONSTACK; |
119 | |
157 | |
120 | if (sigaction (SIGUSR2, &nsa, &osa)) |
158 | if (sigaction (SIGUSR2, &nsa, &osa)) |
|
|
159 | { |
121 | perror ("sigaction"); |
160 | perror ("sigaction"); |
|
|
161 | abort (); |
|
|
162 | } |
122 | |
163 | |
123 | /* set the new stack */ |
164 | /* set the new stack */ |
124 | nstk.ss_sp = sptr; |
165 | nstk.ss_sp = STACK_ADJUST_PTR (sptr,ssize); /* yes, some platforms (IRIX) get this wrong. */ |
125 | nstk.ss_size = ssize; |
166 | nstk.ss_size = STACK_ADJUST_SIZE (sptr,ssize); |
126 | nstk.ss_flags = 0; |
167 | nstk.ss_flags = 0; |
127 | |
168 | |
128 | if (sigaltstack (&nstk, &ostk) < 0) |
169 | if (sigaltstack (&nstk, &ostk) < 0) |
|
|
170 | { |
129 | perror ("sigaltstack"); |
171 | perror ("sigaltstack"); |
|
|
172 | abort (); |
|
|
173 | } |
130 | |
174 | |
131 | trampoline_count = 0; |
175 | trampoline_count = 0; |
132 | kill (getpid (), SIGUSR2); |
176 | kill (getpid (), SIGUSR2); |
133 | sigfillset (&nsig); sigdelset (&nsig, SIGUSR2); |
177 | sigfillset (&nsig); sigdelset (&nsig, SIGUSR2); |
134 | |
178 | |
… | |
… | |
145 | abort (); |
189 | abort (); |
146 | |
190 | |
147 | if (~ostk.ss_flags & SS_DISABLE) |
191 | if (~ostk.ss_flags & SS_DISABLE) |
148 | sigaltstack (&ostk, 0); |
192 | sigaltstack (&ostk, 0); |
149 | |
193 | |
150 | sigaction (SIGUSR1, &osa, 0); |
194 | sigaction (SIGUSR2, &osa, 0); |
151 | |
195 | |
152 | sigprocmask (SIG_SETMASK, &osig, 0); |
196 | sigprocmask (SIG_SETMASK, &osig, 0); |
153 | |
197 | |
154 | # elif CORO_LOOSE |
198 | # elif CORO_LOSER |
155 | |
199 | |
156 | setjmp (ctx->env); |
200 | setjmp (ctx->env); |
|
|
201 | #if __CYGWIN__ |
157 | ctx->env[7] = (int)((char *)sptr + ssize); |
202 | ctx->env[7] = (long)((char *)sptr + ssize); |
158 | ctx->env[8] = (int)coro_init; |
203 | ctx->env[8] = (long)coro_init; |
|
|
204 | #elif defined(_M_IX86) |
|
|
205 | ((_JUMP_BUFFER *)&ctx->env)->Eip = (long)coro_init; |
|
|
206 | ((_JUMP_BUFFER *)&ctx->env)->Esp = (long)STACK_ADJUST_PTR (sptr,ssize); |
|
|
207 | #elif defined(_M_AMD64) |
|
|
208 | ((_JUMP_BUFFER *)&ctx->env)->Rip = (__int64)coro_init; |
|
|
209 | ((_JUMP_BUFFER *)&ctx->env)->Rsp = (__int64)STACK_ADJUST_PTR (sptr,ssize); |
|
|
210 | #elif defined(_M_IA64) |
|
|
211 | ((_JUMP_BUFFER *)&ctx->env)->StIIP = (__int64)coro_init; |
|
|
212 | ((_JUMP_BUFFER *)&ctx->env)->IntSp = (__int64)STACK_ADJUST_PTR (sptr,ssize); |
|
|
213 | #else |
|
|
214 | #error "microsoft libc or architecture not supported" |
|
|
215 | #endif |
159 | |
216 | |
160 | # elif CORO_LINUX |
217 | # elif CORO_LINUX |
161 | |
218 | |
162 | setjmp (ctx->env); |
219 | _setjmp (ctx->env); |
163 | #if defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
|
|
164 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(JB_PC) && defined(JB_SP) |
220 | #if __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (JB_PC) && defined (JB_SP) |
165 | ctx->env[0].__jmpbuf[JB_PC] = (int)coro_init; |
221 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
166 | ctx->env[0].__jmpbuf[JB_SP] = (int)((char *)sptr + ssize); |
222 | ctx->env[0].__jmpbuf[JB_SP] = (long)STACK_ADJUST_PTR (sptr, ssize); |
167 | #elif defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
|
|
168 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(__mc68000__) |
223 | #elif __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (__mc68000__) |
169 | ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init; |
224 | ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init; |
170 | ctx->env[0].__jmpbuf[0].__sp = (int *)((char *)sptr + ssize); |
225 | ctx->env[0].__jmpbuf[0].__sp = (int *)((char *)sptr + ssize); |
171 | #elif defined(__GNU_LIBRARY__) && defined(__i386__) |
226 | #elif defined (__GNU_LIBRARY__) && defined (__i386__) |
172 | ctx->env[0].__jmpbuf[0].__pc = (char *)coro_init; |
227 | ctx->env[0].__jmpbuf[0].__pc = (char *)coro_init; |
173 | ctx->env[0].__jmpbuf[0].__sp = (void *)((char *)sptr + ssize); |
228 | ctx->env[0].__jmpbuf[0].__sp = (void *)((char *)sptr + ssize); |
|
|
229 | #elif defined (__GNU_LIBRARY__) && defined (__amd64__) |
|
|
230 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
|
|
231 | ctx->env[0].__jmpbuf[JB_RSP] = (long)STACK_ADJUST_PTR (sptr, ssize); |
174 | #else |
232 | #else |
175 | #error "Unsupported Linux (g)libc version and/or platform" |
233 | #error "linux libc or architecture not supported" |
176 | #endif |
234 | #endif |
|
|
235 | |
|
|
236 | # elif CORO_IRIX |
|
|
237 | |
|
|
238 | setjmp (ctx->env); |
|
|
239 | ctx->env[JB_PC] = (__uint64_t)coro_init; |
|
|
240 | ctx->env[JB_SP] = (__uint64_t)STACK_ADJUST_PTR (sptr, ssize); |
177 | |
241 | |
178 | # endif |
242 | # endif |
179 | |
243 | |
180 | coro_transfer ((coro_context *)create_coro, (coro_context *)new_coro); |
244 | coro_transfer ((coro_context *)create_coro, (coro_context *)new_coro); |
181 | |
245 | |