1 | /* |
1 | /* |
2 | * Copyright (c) 2001-2005 Marc Alexander Lehmann <schmorp@schmorp.de> |
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, |
… | |
… | |
38 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8) |
38 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8) |
39 | # define STACK_ADJUST_SIZE(sp,ss) ((ss) - 8) |
39 | # define STACK_ADJUST_SIZE(sp,ss) ((ss) - 8) |
40 | # elif __i386__ && CORO_LINUX |
40 | # elif __i386__ && CORO_LINUX |
41 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss)) |
41 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss)) |
42 | # define STACK_ADJUST_SIZE(sp,ss) (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) |
43 | # else |
46 | # else |
44 | # define STACK_ADJUST_PTR(sp,ss) (sp) |
47 | # define STACK_ADJUST_PTR(sp,ss) (sp) |
45 | # define STACK_ADJUST_SIZE(sp,ss) (ss) |
48 | # define STACK_ADJUST_SIZE(sp,ss) (ss) |
46 | # endif |
49 | # endif |
47 | #endif |
50 | #endif |
48 | |
51 | |
|
|
52 | #if CORO_UCONTEXT |
|
|
53 | # include <stddef.h> |
|
|
54 | #endif |
|
|
55 | |
49 | #if CORO_SJLJ || CORO_LOSER || CORO_LINUX || CORO_IRIX |
56 | #if CORO_SJLJ || CORO_LOSER || CORO_LINUX || CORO_IRIX |
|
|
57 | |
|
|
58 | #include <stdlib.h> |
50 | |
59 | |
51 | #if CORO_SJLJ |
60 | #if CORO_SJLJ |
52 | # include <stdio.h> |
61 | # include <stdio.h> |
53 | # include <signal.h> |
62 | # include <signal.h> |
|
|
63 | # include <unistd.h> |
54 | #endif |
64 | #endif |
55 | |
65 | |
56 | static volatile coro_func coro_init_func; |
66 | static volatile coro_func coro_init_func; |
57 | static volatile void *coro_init_arg; |
67 | static volatile void *coro_init_arg; |
58 | static volatile coro_context *new_coro, *create_coro; |
68 | static volatile coro_context *new_coro, *create_coro; |
… | |
… | |
88 | # endif |
98 | # endif |
89 | |
99 | |
90 | #endif |
100 | #endif |
91 | |
101 | |
92 | /* initialize a machine state */ |
102 | /* initialize a machine state */ |
93 | void coro_create(coro_context *ctx, |
103 | void coro_create (coro_context *ctx, |
94 | coro_func coro, void *arg, |
104 | coro_func coro, void *arg, |
95 | void *sptr, long ssize) |
105 | void *sptr, long ssize) |
96 | { |
106 | { |
97 | #if CORO_UCONTEXT |
107 | #if CORO_UCONTEXT |
98 | |
108 | |
99 | getcontext (&(ctx->uc)); |
109 | getcontext (&(ctx->uc)); |
100 | |
110 | |
… | |
… | |
130 | nsa.sa_handler = trampoline; |
140 | nsa.sa_handler = trampoline; |
131 | sigemptyset (&nsa.sa_mask); |
141 | sigemptyset (&nsa.sa_mask); |
132 | nsa.sa_flags = SA_ONSTACK; |
142 | nsa.sa_flags = SA_ONSTACK; |
133 | |
143 | |
134 | if (sigaction (SIGUSR2, &nsa, &osa)) |
144 | if (sigaction (SIGUSR2, &nsa, &osa)) |
|
|
145 | { |
135 | perror ("sigaction"); |
146 | perror ("sigaction"); |
|
|
147 | abort (); |
|
|
148 | } |
136 | |
149 | |
137 | /* set the new stack */ |
150 | /* set the new stack */ |
138 | nstk.ss_sp = STACK_ADJUST_PTR (sptr,ssize); /* yes, some platforms (IRIX) get this wrong. */ |
151 | nstk.ss_sp = STACK_ADJUST_PTR (sptr,ssize); /* yes, some platforms (IRIX) get this wrong. */ |
139 | nstk.ss_size = STACK_ADJUST_SIZE (sptr,ssize); |
152 | nstk.ss_size = STACK_ADJUST_SIZE (sptr,ssize); |
140 | nstk.ss_flags = 0; |
153 | nstk.ss_flags = 0; |
141 | |
154 | |
142 | if (sigaltstack (&nstk, &ostk) < 0) |
155 | if (sigaltstack (&nstk, &ostk) < 0) |
|
|
156 | { |
143 | perror ("sigaltstack"); |
157 | perror ("sigaltstack"); |
|
|
158 | abort (); |
|
|
159 | } |
144 | |
160 | |
145 | trampoline_count = 0; |
161 | trampoline_count = 0; |
146 | kill (getpid (), SIGUSR2); |
162 | kill (getpid (), SIGUSR2); |
147 | sigfillset (&nsig); sigdelset (&nsig, SIGUSR2); |
163 | sigfillset (&nsig); sigdelset (&nsig, SIGUSR2); |
148 | |
164 | |
… | |
… | |
159 | abort (); |
175 | abort (); |
160 | |
176 | |
161 | if (~ostk.ss_flags & SS_DISABLE) |
177 | if (~ostk.ss_flags & SS_DISABLE) |
162 | sigaltstack (&ostk, 0); |
178 | sigaltstack (&ostk, 0); |
163 | |
179 | |
164 | sigaction (SIGUSR1, &osa, 0); |
180 | sigaction (SIGUSR2, &osa, 0); |
165 | |
181 | |
166 | sigprocmask (SIG_SETMASK, &osig, 0); |
182 | sigprocmask (SIG_SETMASK, &osig, 0); |
167 | |
183 | |
168 | # elif CORO_LOSER |
184 | # elif CORO_LOSER |
169 | |
185 | |
170 | setjmp (ctx->env); |
186 | setjmp (ctx->env); |
|
|
187 | #if __CYGWIN__ |
171 | ctx->env[7] = (long)((char *)sptr + ssize); |
188 | ctx->env[7] = (long)((char *)sptr + ssize); |
172 | ctx->env[8] = (long)coro_init; |
189 | ctx->env[8] = (long)coro_init; |
|
|
190 | #elif defined(_M_IX86) |
|
|
191 | ((_JUMP_BUFFER *)&ctx->env)->Eip = (long)coro_init; |
|
|
192 | ((_JUMP_BUFFER *)&ctx->env)->Esp = (long)STACK_ADJUST_PTR (sptr,ssize); |
|
|
193 | #elif defined(_M_AMD64) |
|
|
194 | ((_JUMP_BUFFER *)&ctx->env)->Rip = (__int64)coro_init; |
|
|
195 | ((_JUMP_BUFFER *)&ctx->env)->Rsp = (__int64)STACK_ADJUST_PTR (sptr,ssize); |
|
|
196 | #elif defined(_M_IA64) |
|
|
197 | ((_JUMP_BUFFER *)&ctx->env)->StIIP = (__int64)coro_init; |
|
|
198 | ((_JUMP_BUFFER *)&ctx->env)->IntSp = (__int64)STACK_ADJUST_PTR (sptr,ssize); |
|
|
199 | #else |
|
|
200 | #error "microsoft libc or architecture not supported" |
|
|
201 | #endif |
173 | |
202 | |
174 | # elif CORO_LINUX |
203 | # elif CORO_LINUX |
175 | |
204 | |
176 | setjmp (ctx->env); |
205 | _setjmp (ctx->env); |
177 | #if defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
|
|
178 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(JB_PC) && defined(JB_SP) |
206 | #if __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (JB_PC) && defined (JB_SP) |
179 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
207 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
180 | ctx->env[0].__jmpbuf[JB_SP] = (long)STACK_ADJUST_PTR (sptr,ssize); |
208 | ctx->env[0].__jmpbuf[JB_SP] = (long)STACK_ADJUST_PTR (sptr, ssize); |
181 | #elif defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
|
|
182 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(__mc68000__) |
209 | #elif __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (__mc68000__) |
183 | ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init; |
210 | ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init; |
184 | ctx->env[0].__jmpbuf[0].__sp = (int *)((char *)sptr + ssize); |
211 | ctx->env[0].__jmpbuf[0].__sp = (int *)((char *)sptr + ssize); |
185 | #elif defined(__GNU_LIBRARY__) && defined(__i386__) |
212 | #elif defined (__GNU_LIBRARY__) && defined (__i386__) |
186 | ctx->env[0].__jmpbuf[0].__pc = (char *)coro_init; |
213 | ctx->env[0].__jmpbuf[0].__pc = (char *)coro_init; |
187 | ctx->env[0].__jmpbuf[0].__sp = (void *)((char *)sptr + ssize); |
214 | ctx->env[0].__jmpbuf[0].__sp = (void *)((char *)sptr + ssize); |
188 | #elif defined(__GNU_LIBRARY__) && defined(__amd64__) |
215 | #elif defined (__GNU_LIBRARY__) && defined (__amd64__) |
189 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
216 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
190 | ctx->env[0].__jmpbuf[JB_RSP] = (long)((char *)sptr + ssize); |
217 | ctx->env[0].__jmpbuf[JB_RSP] = (long)STACK_ADJUST_PTR (sptr, ssize); |
191 | #else |
218 | #else |
192 | #error "linux libc or architecture not supported" |
219 | #error "linux libc or architecture not supported" |
193 | #endif |
220 | #endif |
194 | |
221 | |
195 | # elif CORO_IRIX |
222 | # elif CORO_IRIX |
196 | |
223 | |
197 | setjmp (ctx->env); |
224 | setjmp (ctx->env); |
198 | ctx->env[JB_PC] = (__uint64_t)coro_init; |
225 | ctx->env[JB_PC] = (__uint64_t)coro_init; |
199 | ctx->env[JB_SP] = (__uint64_t)STACK_ADJUST_PTR (sptr,ssize); |
226 | ctx->env[JB_SP] = (__uint64_t)STACK_ADJUST_PTR (sptr, ssize); |
200 | |
227 | |
201 | # endif |
228 | # endif |
202 | |
229 | |
203 | coro_transfer ((coro_context *)create_coro, (coro_context *)new_coro); |
230 | coro_transfer ((coro_context *)create_coro, (coro_context *)new_coro); |
204 | |
231 | |