1 | /* |
1 | /* |
2 | * Copyright (c) 2001 Marc Alexander Lehmann <pcg@goof.com> |
2 | * Copyright (c) 2001-2005 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_SJLJ || CORO_LOOSE || CORO_LINUX || CORO_IRIX |
35 | #if !defined(STACK_ADJUST_PTR) |
36 | |
|
|
37 | /* IRIX is decidedly NON-unix */ |
36 | /* IRIX is decidedly NON-unix */ |
38 | #if __sgi |
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 |
39 | # define STACK_ADJUST(sp,ss) ((ss) - 8 + (char *)(sp)) |
41 | # define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss)) |
40 | #else |
|
|
41 | # define STACK_ADJUST(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) |
|
|
46 | # else |
|
|
47 | # define STACK_ADJUST_PTR(sp,ss) (sp) |
|
|
48 | # define STACK_ADJUST_SIZE(sp,ss) (ss) |
42 | #endif |
49 | # endif |
|
|
50 | #endif |
43 | |
51 | |
|
|
52 | #if CORO_SJLJ || CORO_LOSER || CORO_LINUX || CORO_IRIX |
|
|
53 | |
|
|
54 | #include <stdlib.h> |
|
|
55 | |
|
|
56 | #if CORO_SJLJ |
|
|
57 | # include <stdio.h> |
44 | #include <signal.h> |
58 | # include <signal.h> |
|
|
59 | # include <unistd.h> |
|
|
60 | #endif |
45 | |
61 | |
46 | static volatile coro_func coro_init_func; |
62 | static volatile coro_func coro_init_func; |
47 | static volatile void *coro_init_arg; |
63 | static volatile void *coro_init_arg; |
48 | static volatile coro_context *new_coro, *create_coro; |
64 | static volatile coro_context *new_coro, *create_coro; |
49 | |
65 | |
… | |
… | |
65 | |
81 | |
66 | static volatile int trampoline_count; |
82 | static volatile int trampoline_count; |
67 | |
83 | |
68 | /* trampoline signal handler */ |
84 | /* trampoline signal handler */ |
69 | static void |
85 | static void |
70 | trampoline(int sig) |
86 | trampoline (int sig) |
71 | { |
87 | { |
72 | if (setjmp (((coro_context *)new_coro)->env)) |
88 | if (setjmp (((coro_context *)new_coro)->env)) |
73 | coro_init (); /* start it */ |
89 | coro_init (); /* start it */ |
74 | else |
90 | else |
75 | trampoline_count++; |
91 | trampoline_count++; |
… | |
… | |
87 | #if CORO_UCONTEXT |
103 | #if CORO_UCONTEXT |
88 | |
104 | |
89 | getcontext (&(ctx->uc)); |
105 | getcontext (&(ctx->uc)); |
90 | |
106 | |
91 | ctx->uc.uc_link = 0; |
107 | ctx->uc.uc_link = 0; |
92 | ctx->uc.uc_stack.ss_sp = STACK_ADJUST(sptr,ssize); |
108 | ctx->uc.uc_stack.ss_sp = STACK_ADJUST_PTR (sptr,ssize); |
93 | ctx->uc.uc_stack.ss_size = (size_t) ssize; |
109 | ctx->uc.uc_stack.ss_size = (size_t) STACK_ADJUST_SIZE (sptr,ssize); |
94 | ctx->uc.uc_stack.ss_flags = 0; |
110 | ctx->uc.uc_stack.ss_flags = 0; |
95 | |
111 | |
96 | makecontext (&(ctx->uc), (void (*)()) coro, 1, arg); |
112 | makecontext (&(ctx->uc), (void (*)()) coro, 1, arg); |
97 | |
113 | |
98 | #elif CORO_SJLJ || CORO_LOOSE || CORO_LINUX || CORO_IRIX |
114 | #elif CORO_SJLJ || CORO_LOSER || CORO_LINUX || CORO_IRIX |
99 | |
115 | |
100 | # if CORO_SJLJ |
116 | # if CORO_SJLJ |
101 | stack_t ostk, nstk; |
117 | stack_t ostk, nstk; |
102 | struct sigaction osa, nsa; |
118 | struct sigaction osa, nsa; |
103 | sigset_t nsig, osig; |
119 | sigset_t nsig, osig; |
… | |
… | |
123 | |
139 | |
124 | if (sigaction (SIGUSR2, &nsa, &osa)) |
140 | if (sigaction (SIGUSR2, &nsa, &osa)) |
125 | perror ("sigaction"); |
141 | perror ("sigaction"); |
126 | |
142 | |
127 | /* set the new stack */ |
143 | /* set the new stack */ |
128 | nstk.ss_sp = STACK_ADJUST(sptr,ssize); /* yes, some platforms (IRIX) get this wrong. */ |
144 | nstk.ss_sp = STACK_ADJUST_PTR (sptr,ssize); /* yes, some platforms (IRIX) get this wrong. */ |
129 | nstk.ss_size = ssize; |
145 | nstk.ss_size = STACK_ADJUST_SIZE (sptr,ssize); |
130 | nstk.ss_flags = 0; |
146 | nstk.ss_flags = 0; |
131 | |
147 | |
132 | if (sigaltstack (&nstk, &ostk) < 0) |
148 | if (sigaltstack (&nstk, &ostk) < 0) |
133 | perror ("sigaltstack"); |
149 | perror ("sigaltstack"); |
134 | |
150 | |
… | |
… | |
149 | abort (); |
165 | abort (); |
150 | |
166 | |
151 | if (~ostk.ss_flags & SS_DISABLE) |
167 | if (~ostk.ss_flags & SS_DISABLE) |
152 | sigaltstack (&ostk, 0); |
168 | sigaltstack (&ostk, 0); |
153 | |
169 | |
154 | sigaction (SIGUSR1, &osa, 0); |
170 | sigaction (SIGUSR2, &osa, 0); |
155 | |
171 | |
156 | sigprocmask (SIG_SETMASK, &osig, 0); |
172 | sigprocmask (SIG_SETMASK, &osig, 0); |
157 | |
173 | |
158 | # elif CORO_LOOSE |
174 | # elif CORO_LOSER |
159 | |
175 | |
160 | setjmp (ctx->env); |
176 | setjmp (ctx->env); |
161 | ctx->env[7] = (int)((char *)sptr + ssize); |
177 | ctx->env[7] = (long)((char *)sptr + ssize); |
162 | ctx->env[8] = (int)coro_init; |
178 | ctx->env[8] = (long)coro_init; |
163 | |
179 | |
164 | # elif CORO_LINUX |
180 | # elif CORO_LINUX |
165 | |
181 | |
166 | setjmp (ctx->env); |
182 | setjmp (ctx->env); |
167 | #if defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
183 | #if defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
168 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(JB_PC) && defined(JB_SP) |
184 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(JB_PC) && defined(JB_SP) |
169 | ctx->env[0].__jmpbuf[JB_PC] = (int)coro_init; |
185 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
170 | ctx->env[0].__jmpbuf[JB_SP] = (int)((char *)sptr + ssize); |
186 | ctx->env[0].__jmpbuf[JB_SP] = (long)STACK_ADJUST_PTR (sptr,ssize); |
171 | #elif defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
187 | #elif defined(__GLIBC__) && defined(__GLIBC_MINOR__) \ |
172 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(__mc68000__) |
188 | && __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined(__mc68000__) |
173 | ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init; |
189 | ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init; |
174 | ctx->env[0].__jmpbuf[0].__sp = (int *)((char *)sptr + ssize); |
190 | ctx->env[0].__jmpbuf[0].__sp = (int *)((char *)sptr + ssize); |
175 | #elif defined(__GNU_LIBRARY__) && defined(__i386__) |
191 | #elif defined(__GNU_LIBRARY__) && defined(__i386__) |
176 | ctx->env[0].__jmpbuf[0].__pc = (char *)coro_init; |
192 | ctx->env[0].__jmpbuf[0].__pc = (char *)coro_init; |
177 | ctx->env[0].__jmpbuf[0].__sp = (void *)((char *)sptr + ssize); |
193 | ctx->env[0].__jmpbuf[0].__sp = (void *)((char *)sptr + ssize); |
|
|
194 | #elif defined(__GNU_LIBRARY__) && defined(__amd64__) |
|
|
195 | ctx->env[0].__jmpbuf[JB_PC] = (long)coro_init; |
|
|
196 | ctx->env[0].__jmpbuf[JB_RSP] = (long)STACK_ADJUST_PTR (sptr,ssize); |
178 | #else |
197 | #else |
179 | #error "linux libc or architecture not supported" |
198 | #error "linux libc or architecture not supported" |
180 | #endif |
199 | #endif |
181 | |
200 | |
182 | # elif CORO_IRIX |
201 | # elif CORO_IRIX |
183 | |
202 | |
184 | setjmp (ctx->env); |
203 | setjmp (ctx->env); |
185 | ctx->env[JB_PC] = (__uint64_t)coro_init; |
204 | ctx->env[JB_PC] = (__uint64_t)coro_init; |
186 | ctx->env[JB_SP] = (__uint64_t)STACK_ADJUST(sptr,ssize); |
205 | ctx->env[JB_SP] = (__uint64_t)STACK_ADJUST_PTR (sptr,ssize); |
187 | |
206 | |
188 | # endif |
207 | # endif |
189 | |
208 | |
190 | coro_transfer ((coro_context *)create_coro, (coro_context *)new_coro); |
209 | coro_transfer ((coro_context *)create_coro, (coro_context *)new_coro); |
191 | |
210 | |