Blame


1 31cf0ab1 2004-12-28 devnull #include "threadimpl.h"
2 31cf0ab1 2004-12-28 devnull
3 31cf0ab1 2004-12-28 devnull extern int __isthreaded;
4 31cf0ab1 2004-12-28 devnull
5 31cf0ab1 2004-12-28 devnull /*
6 31cf0ab1 2004-12-28 devnull * spin locks
7 31cf0ab1 2004-12-28 devnull */
8 31cf0ab1 2004-12-28 devnull extern int _tas(int*);
9 31cf0ab1 2004-12-28 devnull
10 31cf0ab1 2004-12-28 devnull void
11 31cf0ab1 2004-12-28 devnull _threadunlock(Lock *l, ulong pc)
12 31cf0ab1 2004-12-28 devnull {
13 31cf0ab1 2004-12-28 devnull USED(pc);
14 31cf0ab1 2004-12-28 devnull
15 31cf0ab1 2004-12-28 devnull l->held = 0;
16 31cf0ab1 2004-12-28 devnull }
17 31cf0ab1 2004-12-28 devnull
18 31cf0ab1 2004-12-28 devnull int
19 31cf0ab1 2004-12-28 devnull _threadlock(Lock *l, int block, ulong pc)
20 31cf0ab1 2004-12-28 devnull {
21 31cf0ab1 2004-12-28 devnull int i;
22 31cf0ab1 2004-12-28 devnull
23 31cf0ab1 2004-12-28 devnull USED(pc);
24 31cf0ab1 2004-12-28 devnull
25 31cf0ab1 2004-12-28 devnull /* once fast */
26 31cf0ab1 2004-12-28 devnull if(!_tas(&l->held))
27 31cf0ab1 2004-12-28 devnull return 1;
28 31cf0ab1 2004-12-28 devnull if(!block)
29 31cf0ab1 2004-12-28 devnull return 0;
30 31cf0ab1 2004-12-28 devnull
31 31cf0ab1 2004-12-28 devnull /* a thousand times pretty fast */
32 31cf0ab1 2004-12-28 devnull for(i=0; i<1000; i++){
33 31cf0ab1 2004-12-28 devnull if(!_tas(&l->held))
34 31cf0ab1 2004-12-28 devnull return 1;
35 31cf0ab1 2004-12-28 devnull sched_yield();
36 31cf0ab1 2004-12-28 devnull }
37 31cf0ab1 2004-12-28 devnull /* now nice and slow */
38 31cf0ab1 2004-12-28 devnull for(i=0; i<1000; i++){
39 31cf0ab1 2004-12-28 devnull if(!_tas(&l->held))
40 31cf0ab1 2004-12-28 devnull return 1;
41 31cf0ab1 2004-12-28 devnull usleep(100*1000);
42 31cf0ab1 2004-12-28 devnull }
43 31cf0ab1 2004-12-28 devnull /* take your time */
44 31cf0ab1 2004-12-28 devnull while(_tas(&l->held))
45 31cf0ab1 2004-12-28 devnull usleep(1000*1000);
46 31cf0ab1 2004-12-28 devnull return 1;
47 31cf0ab1 2004-12-28 devnull }
48 31cf0ab1 2004-12-28 devnull
49 31cf0ab1 2004-12-28 devnull /*
50 31cf0ab1 2004-12-28 devnull * For FreeBSD libc.
51 31cf0ab1 2004-12-28 devnull */
52 31cf0ab1 2004-12-28 devnull
53 31cf0ab1 2004-12-28 devnull typedef struct {
54 31cf0ab1 2004-12-28 devnull volatile long access_lock;
55 31cf0ab1 2004-12-28 devnull volatile long lock_owner;
56 31cf0ab1 2004-12-28 devnull volatile char *fname;
57 31cf0ab1 2004-12-28 devnull volatile int lineno;
58 31cf0ab1 2004-12-28 devnull } spinlock_t;
59 31cf0ab1 2004-12-28 devnull
60 31cf0ab1 2004-12-28 devnull void
61 31cf0ab1 2004-12-28 devnull _spinlock(spinlock_t *lk)
62 31cf0ab1 2004-12-28 devnull {
63 31cf0ab1 2004-12-28 devnull lock((Lock*)&lk->access_lock);
64 31cf0ab1 2004-12-28 devnull }
65 31cf0ab1 2004-12-28 devnull
66 31cf0ab1 2004-12-28 devnull /*
67 31cf0ab1 2004-12-28 devnull * sleep and wakeup
68 31cf0ab1 2004-12-28 devnull */
69 31cf0ab1 2004-12-28 devnull static void
70 31cf0ab1 2004-12-28 devnull ign(int x)
71 31cf0ab1 2004-12-28 devnull {
72 31cf0ab1 2004-12-28 devnull USED(x);
73 31cf0ab1 2004-12-28 devnull }
74 31cf0ab1 2004-12-28 devnull
75 31cf0ab1 2004-12-28 devnull static void /*__attribute__((constructor))*/
76 31cf0ab1 2004-12-28 devnull ignusr1(int restart)
77 31cf0ab1 2004-12-28 devnull {
78 31cf0ab1 2004-12-28 devnull struct sigaction sa;
79 31cf0ab1 2004-12-28 devnull
80 31cf0ab1 2004-12-28 devnull memset(&sa, 0, sizeof sa);
81 31cf0ab1 2004-12-28 devnull sa.sa_handler = ign;
82 31cf0ab1 2004-12-28 devnull sigemptyset(&sa.sa_mask);
83 31cf0ab1 2004-12-28 devnull sigaddset(&sa.sa_mask, SIGUSR1);
84 31cf0ab1 2004-12-28 devnull if(restart)
85 31cf0ab1 2004-12-28 devnull sa.sa_flags = SA_RESTART;
86 31cf0ab1 2004-12-28 devnull sigaction(SIGUSR1, &sa, nil);
87 31cf0ab1 2004-12-28 devnull }
88 31cf0ab1 2004-12-28 devnull
89 31cf0ab1 2004-12-28 devnull void
90 31cf0ab1 2004-12-28 devnull _procsleep(_Procrendez *r)
91 31cf0ab1 2004-12-28 devnull {
92 31cf0ab1 2004-12-28 devnull sigset_t mask;
93 31cf0ab1 2004-12-28 devnull
94 31cf0ab1 2004-12-28 devnull /*
95 31cf0ab1 2004-12-28 devnull * Go to sleep.
96 31cf0ab1 2004-12-28 devnull *
97 31cf0ab1 2004-12-28 devnull * Block USR1, set the handler to interrupt system calls,
98 31cf0ab1 2004-12-28 devnull * unlock the vouslock so our waker can wake us,
99 31cf0ab1 2004-12-28 devnull * and then suspend.
100 31cf0ab1 2004-12-28 devnull */
101 31cf0ab1 2004-12-28 devnull again:
102 31cf0ab1 2004-12-28 devnull r->asleep = 1;
103 31cf0ab1 2004-12-28 devnull r->pid = getpid();
104 31cf0ab1 2004-12-28 devnull
105 31cf0ab1 2004-12-28 devnull sigprocmask(SIG_SETMASK, nil, &mask);
106 31cf0ab1 2004-12-28 devnull sigaddset(&mask, SIGUSR1);
107 31cf0ab1 2004-12-28 devnull sigprocmask(SIG_SETMASK, &mask, nil);
108 31cf0ab1 2004-12-28 devnull ignusr1(0);
109 31cf0ab1 2004-12-28 devnull unlock(r->l);
110 31cf0ab1 2004-12-28 devnull sigdelset(&mask, SIGUSR1);
111 31cf0ab1 2004-12-28 devnull sigsuspend(&mask);
112 31cf0ab1 2004-12-28 devnull
113 31cf0ab1 2004-12-28 devnull /*
114 31cf0ab1 2004-12-28 devnull * We're awake. Make USR1 not interrupt system calls.
115 31cf0ab1 2004-12-28 devnull */
116 31cf0ab1 2004-12-28 devnull lock(r->l);
117 31cf0ab1 2004-12-28 devnull ignusr1(1);
118 31cf0ab1 2004-12-28 devnull if(r->asleep && r->pid == getpid()){
119 31cf0ab1 2004-12-28 devnull /* Didn't really wake up - signal from something else */
120 31cf0ab1 2004-12-28 devnull goto again;
121 31cf0ab1 2004-12-28 devnull }
122 31cf0ab1 2004-12-28 devnull }
123 31cf0ab1 2004-12-28 devnull
124 31cf0ab1 2004-12-28 devnull void
125 31cf0ab1 2004-12-28 devnull _procwakeup(_Procrendez *r)
126 31cf0ab1 2004-12-28 devnull {
127 31cf0ab1 2004-12-28 devnull if(r->asleep){
128 31cf0ab1 2004-12-28 devnull r->asleep = 0;
129 31cf0ab1 2004-12-28 devnull assert(r->pid >= 1);
130 31cf0ab1 2004-12-28 devnull kill(r->pid, SIGUSR1);
131 31cf0ab1 2004-12-28 devnull }
132 4a8edd8d 2005-01-14 devnull }
133 4a8edd8d 2005-01-14 devnull
134 4a8edd8d 2005-01-14 devnull void
135 4a8edd8d 2005-01-14 devnull _procwakeupandunlock(_Procrendez *r)
136 4a8edd8d 2005-01-14 devnull {
137 4a8edd8d 2005-01-14 devnull _procwakeup(r);
138 4a8edd8d 2005-01-14 devnull unlock(r->l);
139 31cf0ab1 2004-12-28 devnull }
140 31cf0ab1 2004-12-28 devnull
141 4a8edd8d 2005-01-14 devnull
142 31cf0ab1 2004-12-28 devnull /*
143 31cf0ab1 2004-12-28 devnull * process creation and exit
144 31cf0ab1 2004-12-28 devnull */
145 31cf0ab1 2004-12-28 devnull typedef struct Stackfree Stackfree;
146 31cf0ab1 2004-12-28 devnull struct Stackfree
147 31cf0ab1 2004-12-28 devnull {
148 31cf0ab1 2004-12-28 devnull Stackfree *next;
149 31cf0ab1 2004-12-28 devnull int pid;
150 31cf0ab1 2004-12-28 devnull };
151 31cf0ab1 2004-12-28 devnull static Lock stacklock;
152 31cf0ab1 2004-12-28 devnull static Stackfree *stackfree;
153 31cf0ab1 2004-12-28 devnull
154 31cf0ab1 2004-12-28 devnull static void
155 31cf0ab1 2004-12-28 devnull delayfreestack(uchar *stk)
156 31cf0ab1 2004-12-28 devnull {
157 31cf0ab1 2004-12-28 devnull Stackfree *sf;
158 31cf0ab1 2004-12-28 devnull
159 31cf0ab1 2004-12-28 devnull sf = (Stackfree*)stk;
160 31cf0ab1 2004-12-28 devnull sf->pid = getpid();
161 31cf0ab1 2004-12-28 devnull lock(&stacklock);
162 31cf0ab1 2004-12-28 devnull sf->next = stackfree;
163 31cf0ab1 2004-12-28 devnull stackfree = sf;
164 31cf0ab1 2004-12-28 devnull unlock(&stacklock);
165 31cf0ab1 2004-12-28 devnull }
166 31cf0ab1 2004-12-28 devnull
167 31cf0ab1 2004-12-28 devnull static void
168 31cf0ab1 2004-12-28 devnull dofreestacks(void)
169 31cf0ab1 2004-12-28 devnull {
170 31cf0ab1 2004-12-28 devnull Stackfree *sf, *last, *next;
171 31cf0ab1 2004-12-28 devnull
172 31cf0ab1 2004-12-28 devnull if(stackfree==nil || !canlock(&stacklock))
173 31cf0ab1 2004-12-28 devnull return;
174 31cf0ab1 2004-12-28 devnull
175 31cf0ab1 2004-12-28 devnull for(last=nil,sf=stackfree; sf; last=sf,sf=next){
176 31cf0ab1 2004-12-28 devnull next = sf->next;
177 31cf0ab1 2004-12-28 devnull if(sf->pid >= 1 && kill(sf->pid, 0) < 0 && errno == ESRCH){
178 31cf0ab1 2004-12-28 devnull free(sf);
179 31cf0ab1 2004-12-28 devnull if(last)
180 31cf0ab1 2004-12-28 devnull last->next = next;
181 31cf0ab1 2004-12-28 devnull else
182 31cf0ab1 2004-12-28 devnull stackfree = next;
183 31cf0ab1 2004-12-28 devnull sf = last;
184 31cf0ab1 2004-12-28 devnull }
185 31cf0ab1 2004-12-28 devnull }
186 31cf0ab1 2004-12-28 devnull unlock(&stacklock);
187 31cf0ab1 2004-12-28 devnull }
188 31cf0ab1 2004-12-28 devnull
189 31cf0ab1 2004-12-28 devnull static int
190 31cf0ab1 2004-12-28 devnull startprocfn(void *v)
191 31cf0ab1 2004-12-28 devnull {
192 31cf0ab1 2004-12-28 devnull void **a;
193 31cf0ab1 2004-12-28 devnull uchar *stk;
194 31cf0ab1 2004-12-28 devnull void (*fn)(void*);
195 31cf0ab1 2004-12-28 devnull Proc *p;
196 31cf0ab1 2004-12-28 devnull
197 31cf0ab1 2004-12-28 devnull a = (void**)v;
198 31cf0ab1 2004-12-28 devnull fn = a[0];
199 31cf0ab1 2004-12-28 devnull p = a[1];
200 31cf0ab1 2004-12-28 devnull stk = a[2];
201 31cf0ab1 2004-12-28 devnull free(a);
202 31cf0ab1 2004-12-28 devnull p->osprocid = getpid();
203 31cf0ab1 2004-12-28 devnull
204 31cf0ab1 2004-12-28 devnull (*fn)(p);
205 31cf0ab1 2004-12-28 devnull
206 31cf0ab1 2004-12-28 devnull delayfreestack(stk);
207 31cf0ab1 2004-12-28 devnull _exit(0);
208 31cf0ab1 2004-12-28 devnull return 0;
209 31cf0ab1 2004-12-28 devnull }
210 31cf0ab1 2004-12-28 devnull
211 31cf0ab1 2004-12-28 devnull void
212 31cf0ab1 2004-12-28 devnull _procstart(Proc *p, void (*fn)(Proc*))
213 31cf0ab1 2004-12-28 devnull {
214 31cf0ab1 2004-12-28 devnull void **a;
215 31cf0ab1 2004-12-28 devnull uchar *stk;
216 31cf0ab1 2004-12-28 devnull int pid;
217 31cf0ab1 2004-12-28 devnull
218 31cf0ab1 2004-12-28 devnull dofreestacks();
219 31cf0ab1 2004-12-28 devnull a = malloc(3*sizeof a[0]);
220 31cf0ab1 2004-12-28 devnull if(a == nil)
221 31cf0ab1 2004-12-28 devnull sysfatal("_procstart malloc: %r");
222 31cf0ab1 2004-12-28 devnull stk = malloc(65536);
223 31cf0ab1 2004-12-28 devnull if(stk == nil)
224 31cf0ab1 2004-12-28 devnull sysfatal("_procstart malloc stack: %r");
225 31cf0ab1 2004-12-28 devnull
226 31cf0ab1 2004-12-28 devnull a[0] = fn;
227 31cf0ab1 2004-12-28 devnull a[1] = p;
228 31cf0ab1 2004-12-28 devnull a[2] = stk;
229 31cf0ab1 2004-12-28 devnull
230 31cf0ab1 2004-12-28 devnull pid = rfork_thread(RFPROC|RFMEM|RFNOWAIT, stk+65536-64, startprocfn, a);
231 31cf0ab1 2004-12-28 devnull if(pid < 0){
232 31cf0ab1 2004-12-28 devnull fprint(2, "_procstart rfork_thread: %r\n");
233 31cf0ab1 2004-12-28 devnull abort();
234 31cf0ab1 2004-12-28 devnull }
235 31cf0ab1 2004-12-28 devnull }
236 31cf0ab1 2004-12-28 devnull
237 31cf0ab1 2004-12-28 devnull static char *threadexitsmsg;
238 31cf0ab1 2004-12-28 devnull void
239 31cf0ab1 2004-12-28 devnull sigusr2handler(int s)
240 31cf0ab1 2004-12-28 devnull {
241 31cf0ab1 2004-12-28 devnull /* fprint(2, "%d usr2 %d\n", time(0), getpid()); */
242 31cf0ab1 2004-12-28 devnull if(threadexitsmsg)
243 31cf0ab1 2004-12-28 devnull _exits(threadexitsmsg);
244 31cf0ab1 2004-12-28 devnull }
245 31cf0ab1 2004-12-28 devnull
246 31cf0ab1 2004-12-28 devnull void
247 31cf0ab1 2004-12-28 devnull threadexitsall(char *msg)
248 31cf0ab1 2004-12-28 devnull {
249 31cf0ab1 2004-12-28 devnull static int pid[1024];
250 31cf0ab1 2004-12-28 devnull int i, npid, mypid;
251 31cf0ab1 2004-12-28 devnull Proc *p;
252 31cf0ab1 2004-12-28 devnull
253 31cf0ab1 2004-12-28 devnull if(msg == nil)
254 31cf0ab1 2004-12-28 devnull msg = "";
255 31cf0ab1 2004-12-28 devnull mypid = getpid();
256 31cf0ab1 2004-12-28 devnull lock(&_threadprocslock);
257 31cf0ab1 2004-12-28 devnull threadexitsmsg = msg;
258 31cf0ab1 2004-12-28 devnull npid = 0;
259 31cf0ab1 2004-12-28 devnull for(p=_threadprocs; p; p=p->next)
260 31cf0ab1 2004-12-28 devnull if(p->osprocid != mypid && p->osprocid >= 1)
261 31cf0ab1 2004-12-28 devnull pid[npid++] = p->osprocid;
262 31cf0ab1 2004-12-28 devnull for(i=0; i<npid; i++)
263 31cf0ab1 2004-12-28 devnull kill(pid[i], SIGUSR2);
264 31cf0ab1 2004-12-28 devnull unlock(&_threadprocslock);
265 31cf0ab1 2004-12-28 devnull exits(msg);
266 31cf0ab1 2004-12-28 devnull }
267 31cf0ab1 2004-12-28 devnull
268 31cf0ab1 2004-12-28 devnull /*
269 31cf0ab1 2004-12-28 devnull * per-process data, indexed by pid
270 31cf0ab1 2004-12-28 devnull *
271 31cf0ab1 2004-12-28 devnull * could use modify_ldt and a segment register
272 31cf0ab1 2004-12-28 devnull * to avoid the many calls to getpid(), but i don't
273 31cf0ab1 2004-12-28 devnull * care -- this is compatibility code. linux 2.6 with
274 31cf0ab1 2004-12-28 devnull * nptl is a good enough pthreads to avoid this whole file.
275 31cf0ab1 2004-12-28 devnull */
276 31cf0ab1 2004-12-28 devnull typedef struct Perproc Perproc;
277 31cf0ab1 2004-12-28 devnull struct Perproc
278 31cf0ab1 2004-12-28 devnull {
279 31cf0ab1 2004-12-28 devnull int pid;
280 31cf0ab1 2004-12-28 devnull Proc *proc;
281 31cf0ab1 2004-12-28 devnull };
282 31cf0ab1 2004-12-28 devnull
283 31cf0ab1 2004-12-28 devnull static Lock perlock;
284 31cf0ab1 2004-12-28 devnull static Perproc perproc[1024];
285 31cf0ab1 2004-12-28 devnull #define P ((Proc*)-1)
286 31cf0ab1 2004-12-28 devnull
287 31cf0ab1 2004-12-28 devnull static Perproc*
288 31cf0ab1 2004-12-28 devnull myperproc(void)
289 31cf0ab1 2004-12-28 devnull {
290 31cf0ab1 2004-12-28 devnull int i, pid, h;
291 31cf0ab1 2004-12-28 devnull Perproc *p;
292 31cf0ab1 2004-12-28 devnull
293 31cf0ab1 2004-12-28 devnull pid = getpid();
294 31cf0ab1 2004-12-28 devnull h = pid%nelem(perproc);
295 31cf0ab1 2004-12-28 devnull for(i=0; i<nelem(perproc); i++){
296 31cf0ab1 2004-12-28 devnull p = &perproc[(i+h)%nelem(perproc)];
297 31cf0ab1 2004-12-28 devnull if(p->pid == pid)
298 31cf0ab1 2004-12-28 devnull return p;
299 31cf0ab1 2004-12-28 devnull if(p->pid == 0){
300 31cf0ab1 2004-12-28 devnull print("found 0 at %d (h=%d)\n", (i+h)%nelem(perproc), h);
301 31cf0ab1 2004-12-28 devnull break;
302 31cf0ab1 2004-12-28 devnull }
303 31cf0ab1 2004-12-28 devnull }
304 31cf0ab1 2004-12-28 devnull fprint(2, "myperproc %d: cannot find self\n", pid);
305 31cf0ab1 2004-12-28 devnull abort();
306 31cf0ab1 2004-12-28 devnull return nil;
307 31cf0ab1 2004-12-28 devnull }
308 31cf0ab1 2004-12-28 devnull
309 31cf0ab1 2004-12-28 devnull static Perproc*
310 31cf0ab1 2004-12-28 devnull newperproc(void)
311 31cf0ab1 2004-12-28 devnull {
312 31cf0ab1 2004-12-28 devnull int i, pid, h;
313 31cf0ab1 2004-12-28 devnull Perproc *p;
314 31cf0ab1 2004-12-28 devnull
315 31cf0ab1 2004-12-28 devnull lock(&perlock);
316 31cf0ab1 2004-12-28 devnull pid = getpid();
317 31cf0ab1 2004-12-28 devnull h = pid%nelem(perproc);
318 31cf0ab1 2004-12-28 devnull for(i=0; i<nelem(perproc); i++){
319 31cf0ab1 2004-12-28 devnull p = &perproc[(i+h)%nelem(perproc)];
320 31cf0ab1 2004-12-28 devnull if(p->pid == pid || p->pid == -1 || p->pid == 0){
321 31cf0ab1 2004-12-28 devnull p->pid = pid;
322 31cf0ab1 2004-12-28 devnull unlock(&perlock);
323 31cf0ab1 2004-12-28 devnull return p;
324 31cf0ab1 2004-12-28 devnull }
325 31cf0ab1 2004-12-28 devnull }
326 31cf0ab1 2004-12-28 devnull fprint(2, "newperproc %d: out of procs\n", pid);
327 31cf0ab1 2004-12-28 devnull abort();
328 31cf0ab1 2004-12-28 devnull return nil;
329 31cf0ab1 2004-12-28 devnull }
330 31cf0ab1 2004-12-28 devnull
331 31cf0ab1 2004-12-28 devnull Proc*
332 31cf0ab1 2004-12-28 devnull _threadproc(void)
333 31cf0ab1 2004-12-28 devnull {
334 31cf0ab1 2004-12-28 devnull return myperproc()->proc;
335 31cf0ab1 2004-12-28 devnull }
336 31cf0ab1 2004-12-28 devnull
337 31cf0ab1 2004-12-28 devnull void
338 31cf0ab1 2004-12-28 devnull _threadsetproc(Proc *p)
339 31cf0ab1 2004-12-28 devnull {
340 31cf0ab1 2004-12-28 devnull Perproc *pp;
341 31cf0ab1 2004-12-28 devnull
342 31cf0ab1 2004-12-28 devnull if(p)
343 31cf0ab1 2004-12-28 devnull p->osprocid = getpid();
344 31cf0ab1 2004-12-28 devnull pp = newperproc();
345 31cf0ab1 2004-12-28 devnull pp->proc = p;
346 31cf0ab1 2004-12-28 devnull if(p == nil)
347 31cf0ab1 2004-12-28 devnull pp->pid = -1;
348 31cf0ab1 2004-12-28 devnull }
349 31cf0ab1 2004-12-28 devnull
350 31cf0ab1 2004-12-28 devnull void
351 31cf0ab1 2004-12-28 devnull _pthreadinit(void)
352 31cf0ab1 2004-12-28 devnull {
353 d54ead7f 2004-12-28 devnull __isthreaded = 1;
354 31cf0ab1 2004-12-28 devnull signal(SIGUSR2, sigusr2handler);
355 31cf0ab1 2004-12-28 devnull }
356 d54ead7f 2004-12-28 devnull
357 1d2533d0 2004-12-28 devnull void
358 1d2533d0 2004-12-28 devnull _threadpexit(void)
359 1d2533d0 2004-12-28 devnull {
360 1d2533d0 2004-12-28 devnull _exit(0);
361 1d2533d0 2004-12-28 devnull }
362 1d2533d0 2004-12-28 devnull
363 1d2533d0 2004-12-28 devnull
364 d54ead7f 2004-12-28 devnull /*
365 d54ead7f 2004-12-28 devnull * FreeBSD 4 and earlier needs the context functions.
366 d54ead7f 2004-12-28 devnull */
367 d54ead7f 2004-12-28 devnull void
368 d54ead7f 2004-12-28 devnull makecontext(ucontext_t *ucp, void (*func)(void), int argc, ...)
369 d54ead7f 2004-12-28 devnull {
370 d54ead7f 2004-12-28 devnull int *sp;
371 31cf0ab1 2004-12-28 devnull
372 d54ead7f 2004-12-28 devnull sp = (int*)ucp->uc_stack.ss_sp+ucp->uc_stack.ss_size/4;
373 d54ead7f 2004-12-28 devnull sp -= argc;
374 d54ead7f 2004-12-28 devnull memmove(sp, &argc+1, argc*sizeof(int));
375 d54ead7f 2004-12-28 devnull *--sp = 0; /* return address */
376 d54ead7f 2004-12-28 devnull ucp->uc_mcontext.mc_eip = (long)func;
377 d54ead7f 2004-12-28 devnull ucp->uc_mcontext.mc_esp = (int)sp;
378 d54ead7f 2004-12-28 devnull }
379 d54ead7f 2004-12-28 devnull
380 d54ead7f 2004-12-28 devnull extern int getmcontext(mcontext_t*);
381 d54ead7f 2004-12-28 devnull extern int setmcontext(mcontext_t*);
382 d54ead7f 2004-12-28 devnull
383 d54ead7f 2004-12-28 devnull int
384 d54ead7f 2004-12-28 devnull getcontext(ucontext_t *uc)
385 d54ead7f 2004-12-28 devnull {
386 d54ead7f 2004-12-28 devnull return getmcontext(&uc->uc_mcontext);
387 d54ead7f 2004-12-28 devnull }
388 d54ead7f 2004-12-28 devnull
389 d54ead7f 2004-12-28 devnull void
390 d54ead7f 2004-12-28 devnull setcontext(ucontext_t *uc)
391 d54ead7f 2004-12-28 devnull {
392 d54ead7f 2004-12-28 devnull setmcontext(&uc->uc_mcontext);
393 d54ead7f 2004-12-28 devnull }
394 d54ead7f 2004-12-28 devnull
395 d54ead7f 2004-12-28 devnull int
396 d54ead7f 2004-12-28 devnull swapcontext(ucontext_t *oucp, ucontext_t *ucp)
397 d54ead7f 2004-12-28 devnull {
398 d54ead7f 2004-12-28 devnull if(getcontext(oucp) == 0)
399 d54ead7f 2004-12-28 devnull setcontext(ucp);
400 d54ead7f 2004-12-28 devnull return 0;
401 d54ead7f 2004-12-28 devnull }
402 d54ead7f 2004-12-28 devnull