libcoro/coro.c

/*
 * Copyright (c) 2001-2009 Marc Alexander Lehmann <schmorp@schmorp.de>
 * 
 * Redistribution and use in source and binary forms, with or without modifica-
 * tion, are permitted provided that the following conditions are met:
 * 
 *   1.  Redistributions of source code must retain the above copyright notice,
 *       this list of conditions and the following disclaimer.
 * 
 *   2.  Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in the
 *       documentation and/or other materials provided with the distribution.
 * 
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MER-
 * CHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO
 * EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPE-
 * CIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTH-
 * ERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
 * OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * Alternatively, the contents of this file may be used under the terms of
 * the GNU General Public License ("GPL") version 2 or any later version,
 * in which case the provisions of the GPL are applicable instead of
 * the above. If you wish to allow the use of your version of this file
 * only under the terms of the GPL and not to allow others to use your
 * version of this file under the BSD license, indicate your decision
 * by deleting the provisions above and replace them with the notice
 * and other provisions required by the GPL. If you do not delete the
 * provisions above, a recipient may use your version of this file under
 * either the BSD or the GPL.
 *
 * This library is modelled strictly after Ralf S. Engelschalls article at
 * http://www.gnu.org/software/pth/rse-pmt.ps. So most of the credit must
 * go to Ralf S. Engelschall <rse@engelschall.com>.
 */

#include "coro.h"

#include <string.h>

/*****************************************************************************/
/* ucontext/setjmp/asm backends                                              */
/*****************************************************************************/
#if CORO_UCONTEXT || CORO_SJLJ || CORO_LOSER || CORO_LINUX || CORO_IRIX || CORO_ASM

# if CORO_UCONTEXT
#  include <stddef.h>
# endif

# if !defined(STACK_ADJUST_PTR)
#  if __sgi
/* IRIX is decidedly NON-unix */
#   define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8)
#   define STACK_ADJUST_SIZE(sp,ss) ((ss) - 8)
#  elif (__i386__ && CORO_LINUX) || (_M_IX86 && CORO_LOSER)
#   define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss))
#   define STACK_ADJUST_SIZE(sp,ss) (ss)
#  elif (__amd64__ && CORO_LINUX) || ((_M_AMD64 || _M_IA64) && CORO_LOSER)
#   define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8)
#   define STACK_ADJUST_SIZE(sp,ss) (ss)
#  else
#   define STACK_ADJUST_PTR(sp,ss) (sp)
#   define STACK_ADJUST_SIZE(sp,ss) (ss)
#  endif
# endif

# include <stdlib.h>

# if CORO_SJLJ
#  include <stdio.h>
#  include <signal.h>
#  include <unistd.h>
# endif

static coro_func coro_init_func;
static void *coro_init_arg;
static coro_context *new_coro, *create_coro;

static void
coro_init (void)
{
  volatile coro_func func = coro_init_func;
  volatile void *arg = coro_init_arg;

  coro_transfer (new_coro, create_coro);

  func ((void *)arg);

  /* the new coro returned. bad. just abort() for now */
  abort ();
}

# if CORO_SJLJ

static volatile int trampoline_done;

/* trampoline signal handler */
static void
trampoline (int sig)
{
  if (coro_setjmp (new_coro->env))
    coro_init (); /* start it */
  else
    trampoline_done = 1;
}

# endif

# if CORO_ASM

  asm (
       ".text\n"
       ".globl coro_transfer\n"
       ".type coro_transfer, @function\n"
       "coro_transfer:\n"
       #if __amd64
         #define NUM_SAVED 6
         "\tpush %rbp\n"
         "\tpush %rbx\n"
         "\tpush %r12\n"
         "\tpush %r13\n"
         "\tpush %r14\n"
         "\tpush %r15\n"
         "\tmov  %rsp, (%rdi)\n"
         "\tmov  (%rsi), %rsp\n"
         "\tpop  %r15\n"
         "\tpop  %r14\n"
         "\tpop  %r13\n"
         "\tpop  %r12\n"
         "\tpop  %rbx\n"
         "\tpop  %rbp\n"
       #elif __i386
         #define NUM_SAVED 4
         "\tpush %ebp\n"
         "\tpush %ebx\n"
         "\tpush %esi\n"
         "\tpush %edi\n"
         "\tmov  %esp, (%eax)\n"
         "\tmov  (%edx), %esp\n"
         "\tpop  %edi\n"
         "\tpop  %esi\n"
         "\tpop  %ebx\n"
         "\tpop  %ebp\n"
       #else
         #error unsupported architecture
       #endif
       "\tret\n"
  );

# endif

void
coro_create (coro_context *ctx, coro_func coro, void *arg, void *sptr, long ssize)
{
  coro_context nctx;
# if CORO_SJLJ
  stack_t ostk, nstk;
  struct sigaction osa, nsa;
  sigset_t nsig, osig;
# endif

  if (!coro)
    return;

  coro_init_func = coro;
  coro_init_arg  = arg;

  new_coro    = ctx;
  create_coro = &nctx;

# if CORO_SJLJ
  /* we use SIGUSR2. first block it, then fiddle with it. */

  sigemptyset (&nsig);
  sigaddset (&nsig, SIGUSR2);
  sigprocmask (SIG_BLOCK, &nsig, &osig);

  nsa.sa_handler = trampoline;
  sigemptyset (&nsa.sa_mask);
  nsa.sa_flags = SA_ONSTACK;

  if (sigaction (SIGUSR2, &nsa, &osa))
    {
      perror ("sigaction");
      abort ();
    }

  /* set the new stack */
  nstk.ss_sp    = STACK_ADJUST_PTR (sptr,ssize); /* yes, some platforms (IRIX) get this wrong. */
  nstk.ss_size  = STACK_ADJUST_SIZE (sptr,ssize);
  nstk.ss_flags = 0;

  if (sigaltstack (&nstk, &ostk) < 0)
    {
      perror ("sigaltstack");
      abort ();
    }

  trampoline_done = 0;
  kill (getpid (), SIGUSR2);
  sigfillset (&nsig); sigdelset (&nsig, SIGUSR2);

  while (!trampoline_done)
    sigsuspend (&nsig);

  sigaltstack (0, &nstk);
  nstk.ss_flags = SS_DISABLE;
  if (sigaltstack (&nstk, 0) < 0)
    perror ("sigaltstack");

  sigaltstack (0, &nstk);
  if (~nstk.ss_flags & SS_DISABLE)
    abort ();

  if (~ostk.ss_flags & SS_DISABLE)
    sigaltstack (&ostk, 0);

  sigaction (SIGUSR2, &osa, 0);
  sigprocmask (SIG_SETMASK, &osig, 0);

# elif CORO_LOSER

  coro_setjmp (ctx->env);
  #if __CYGWIN__ && __i386
    ctx->env[8]                        = (long)    coro_init;
    ctx->env[7]                        = (long)    ((char *)sptr + ssize)         - sizeof (long);
  #elif __CYGWIN__ && __x86_64
    ctx->env[7]                        = (long)    coro_init;
    ctx->env[6]                        = (long)    ((char *)sptr + ssize)         - sizeof (long);
  #elif defined(__MINGW32__)
    ctx->env[5]                        = (long)    coro_init;
    ctx->env[4]                        = (long)    ((char *)sptr + ssize)         - sizeof (long);
  #elif defined(_M_IX86)
    ((_JUMP_BUFFER *)&ctx->env)->Eip   = (long)    coro_init;
    ((_JUMP_BUFFER *)&ctx->env)->Esp   = (long)    STACK_ADJUST_PTR (sptr, ssize) - sizeof (long);
  #elif defined(_M_AMD64)
    ((_JUMP_BUFFER *)&ctx->env)->Rip   = (__int64) coro_init;
    ((_JUMP_BUFFER *)&ctx->env)->Rsp   = (__int64) STACK_ADJUST_PTR (sptr, ssize) - sizeof (__int64);
  #elif defined(_M_IA64)
    ((_JUMP_BUFFER *)&ctx->env)->StIIP = (__int64) coro_init;
    ((_JUMP_BUFFER *)&ctx->env)->IntSp = (__int64) STACK_ADJUST_PTR (sptr, ssize) - sizeof (__int64);
  #else
    #error "microsoft libc or architecture not supported"
  #endif

# elif CORO_LINUX

  coro_setjmp (ctx->env);
  #if __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (JB_PC) && defined (JB_SP)
    ctx->env[0].__jmpbuf[JB_PC]        = (long)    coro_init;
    ctx->env[0].__jmpbuf[JB_SP]        = (long)    STACK_ADJUST_PTR (sptr, ssize) - sizeof (long);
  #elif __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (__mc68000__)
    ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init;
    ctx->env[0].__jmpbuf[0].__sp       = (int *)   ((char *)sptr + ssize)         - sizeof (long);
  #elif defined (__GNU_LIBRARY__) && defined (__i386__)
    ctx->env[0].__jmpbuf[0].__pc       = (char *)  coro_init;
    ctx->env[0].__jmpbuf[0].__sp       = (void *)  ((char *)sptr + ssize)         - sizeof (long);
  #elif defined (__GNU_LIBRARY__) && defined (__amd64__)
    ctx->env[0].__jmpbuf[JB_PC]        = (long)    coro_init;
    ctx->env[0].__jmpbuf[0].__sp       = (void *)  ((char *)sptr + ssize)         - sizeof (long);
  #else
    #error "linux libc or architecture not supported"
  #endif

# elif CORO_IRIX

  coro_setjmp (ctx->env, 0);
  ctx->env[JB_PC]                      = (__uint64_t)coro_init;
  ctx->env[JB_SP]                      = (__uint64_t)STACK_ADJUST_PTR (sptr, ssize) - sizeof (long);

# elif CORO_ASM

  ctx->sp = (void **)(ssize + (char *)sptr);
  *--ctx->sp = (void *)abort; /* needed for alignment only */
  *--ctx->sp = (void *)coro_init;
  ctx->sp -= NUM_SAVED;

# elif CORO_UCONTEXT

  getcontext (&(ctx->uc));

  ctx->uc.uc_link           =  0;
  ctx->uc.uc_stack.ss_sp    = sptr;
  ctx->uc.uc_stack.ss_size  = (size_t)ssize;
  ctx->uc.uc_stack.ss_flags = 0;

  makecontext (&(ctx->uc), (void (*)())coro_init, 0);

# endif

  coro_transfer (create_coro, new_coro);
}

/*****************************************************************************/
/* pthread backend                                                           */
/*****************************************************************************/
#elif CORO_PTHREAD

/* this mutex will be locked by the running coroutine */
pthread_mutex_t coro_mutex = PTHREAD_MUTEX_INITIALIZER;

struct coro_init_args
{
  coro_func func;
  void *arg;
  coro_context *self, *main;
};

static pthread_t null_tid;

/* I'd so love to cast pthread_mutex_unlock to void (*)(void *)... */
static void
mutex_unlock_wrapper (void *arg)
{
  pthread_mutex_unlock ((pthread_mutex_t *)arg);
}

static void *
coro_init (void *args_)
{
  struct coro_init_args *args = (struct coro_init_args *)args_;
  coro_func func = args->func;
  void *arg = args->arg;

  pthread_mutex_lock (&coro_mutex);

  /* we try to be good citizens and use deferred cancellation and cleanup handlers */
  pthread_cleanup_push (mutex_unlock_wrapper, &coro_mutex);
    coro_transfer (args->self, args->main);
    func (arg);
  pthread_cleanup_pop (1);

  return 0;
}

void
coro_transfer (coro_context *prev, coro_context *next)
{
  pthread_cond_signal (&next->cv);
  pthread_cond_wait (&prev->cv, &coro_mutex);
#if __FreeBSD__ /* freebsd is of course broken and needs manual testcancel calls... yay... */
  pthread_testcancel ();
#endif
}

void
coro_create (coro_context *ctx, coro_func coro, void *arg, void *sptr, long ssize)
{
  static coro_context nctx;
  static int once;

  if (!once)
    {
      once = 1;

      pthread_mutex_lock (&coro_mutex);
      pthread_cond_init (&nctx.cv, 0);
      null_tid = pthread_self ();
    }

  pthread_cond_init (&ctx->cv, 0);

  if (coro)
    {
      pthread_attr_t attr;
      struct coro_init_args args;

      args.func = coro;
      args.arg  = arg;
      args.self = ctx;
      args.main = &nctx;

      pthread_attr_init (&attr);
      pthread_attr_setstack (&attr, sptr, (size_t)ssize);
      pthread_attr_setscope (&attr, PTHREAD_SCOPE_PROCESS);
      pthread_create (&ctx->id, &attr, coro_init, &args);

      coro_transfer (args.main, args.self);
    }
  else
    ctx->id = null_tid;
}

void
coro_destroy (coro_context *ctx)
{
  if (!pthread_equal (ctx->id, null_tid))
    {
      pthread_cancel (ctx->id);
      pthread_mutex_unlock (&coro_mutex);
      pthread_join (ctx->id, 0);
      pthread_mutex_lock (&coro_mutex);
    }

  pthread_cond_destroy (&ctx->cv);
}

#else
# error unsupported backend
#endif

Revision:	1.48
Committed:	Fri Jan 29 20:35:23 2010 UTC (14 years, 4 months ago) by root
Content type:	text/plain
Branch:	MAIN
Changes since 1.47:	+6 -3 lines
Log Message:	* empty log message *
#	User	Rev	Content
1	root	1.1	/*
2	root	1.46	* Copyright (c) 2001-2009 Marc Alexander Lehmann <schmorp@schmorp.de>
3	root	1.1	*
4			* Redistribution and use in source and binary forms, with or without modifica-
5			* tion, are permitted provided that the following conditions are met:
6			*
7			* 1. Redistributions of source code must retain the above copyright notice,
8			* this list of conditions and the following disclaimer.
9			*
10			* 2. Redistributions in binary form must reproduce the above copyright
11			* notice, this list of conditions and the following disclaimer in the
12			* documentation and/or other materials provided with the distribution.
13			*
14			* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
15			* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MER-
16			* CHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO
17			* EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPE-
18			* CIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
19			* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
20			* OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
21			* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTH-
22			* ERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
23			* OF THE POSSIBILITY OF SUCH DAMAGE.
24			*
25	root	1.29	* Alternatively, the contents of this file may be used under the terms of
26			* the GNU General Public License ("GPL") version 2 or any later version,
27			* in which case the provisions of the GPL are applicable instead of
28			* the above. If you wish to allow the use of your version of this file
29			* only under the terms of the GPL and not to allow others to use your
30			* version of this file under the BSD license, indicate your decision
31			* by deleting the provisions above and replace them with the notice
32			* and other provisions required by the GPL. If you do not delete the
33			* provisions above, a recipient may use your version of this file under
34			* either the BSD or the GPL.
35			*
36	root	1.1	* This library is modelled strictly after Ralf S. Engelschalls article at
37	root	1.29	* http://www.gnu.org/software/pth/rse-pmt.ps. So most of the credit must
38	root	1.1	* go to Ralf S. Engelschall <rse@engelschall.com>.
39			*/
40
41			#include "coro.h"
42
43	root	1.38	#include <string.h>
44
45	root	1.39	/*****************************************************************************/
46			/* ucontext/setjmp/asm backends */
47			/*****************************************************************************/
48			#if CORO_UCONTEXT \|\| CORO_SJLJ \|\| CORO_LOSER \|\| CORO_LINUX \|\| CORO_IRIX \|\| CORO_ASM
49
50			# if CORO_UCONTEXT
51			# include <stddef.h>
52			# endif
53
54			# if !defined(STACK_ADJUST_PTR)
55			# if __sgi
56	root	1.5	/* IRIX is decidedly NON-unix */
57	root	1.39	# define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8)
58			# define STACK_ADJUST_SIZE(sp,ss) ((ss) - 8)
59			# elif (__i386__ && CORO_LINUX) \|\| (_M_IX86 && CORO_LOSER)
60			# define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss))
61			# define STACK_ADJUST_SIZE(sp,ss) (ss)
62			# elif (__amd64__ && CORO_LINUX) \|\| ((_M_AMD64 \|\| _M_IA64) && CORO_LOSER)
63			# define STACK_ADJUST_PTR(sp,ss) ((char *)(sp) + (ss) - 8)
64			# define STACK_ADJUST_SIZE(sp,ss) (ss)
65			# else
66			# define STACK_ADJUST_PTR(sp,ss) (sp)
67			# define STACK_ADJUST_SIZE(sp,ss) (ss)
68			# endif
69	root	1.8	# endif
70	root	1.1
71	root	1.38	# include <stdlib.h>
72	root	1.17
73	root	1.38	# if CORO_SJLJ
74			# include <stdio.h>
75			# include <signal.h>
76			# include <unistd.h>
77			# endif
78	root	1.1
79	root	1.40	static coro_func coro_init_func;
80			static void *coro_init_arg;
81			static coro_context new_coro, create_coro;
82	root	1.1
83			static void
84			coro_init (void)
85			{
86			volatile coro_func func = coro_init_func;
87			volatile void *arg = coro_init_arg;
88
89	root	1.40	coro_transfer (new_coro, create_coro);
90	root	1.1
91	root	1.3	func ((void *)arg);
92	root	1.1
93			/* the new coro returned. bad. just abort() for now */
94			abort ();
95			}
96
97			# if CORO_SJLJ
98
99	root	1.39	static volatile int trampoline_done;
100	root	1.1
101			/* trampoline signal handler */
102			static void
103	root	1.14	trampoline (int sig)
104	root	1.1	{
105	root	1.44	if (coro_setjmp (new_coro->env))
106			coro_init (); /* start it */
107	root	1.1	else
108	root	1.39	trampoline_done = 1;
109	root	1.1	}
110
111			# endif
112
113	root	1.39	# if CORO_ASM
114	root	1.38
115			asm (
116			".text\n"
117			".globl coro_transfer\n"
118			".type coro_transfer, @function\n"
119			"coro_transfer:\n"
120	root	1.39	#if __amd64
121			#define NUM_SAVED 6
122			"\tpush %rbp\n"
123			"\tpush %rbx\n"
124			"\tpush %r12\n"
125			"\tpush %r13\n"
126			"\tpush %r14\n"
127			"\tpush %r15\n"
128			"\tmov %rsp, (%rdi)\n"
129			"\tmov (%rsi), %rsp\n"
130			"\tpop %r15\n"
131			"\tpop %r14\n"
132			"\tpop %r13\n"
133			"\tpop %r12\n"
134			"\tpop %rbx\n"
135			"\tpop %rbp\n"
136			#elif __i386
137			#define NUM_SAVED 4
138			"\tpush %ebp\n"
139			"\tpush %ebx\n"
140			"\tpush %esi\n"
141			"\tpush %edi\n"
142			"\tmov %esp, (%eax)\n"
143			"\tmov (%edx), %esp\n"
144			"\tpop %edi\n"
145			"\tpop %esi\n"
146			"\tpop %ebx\n"
147			"\tpop %ebp\n"
148			#else
149			#error unsupported architecture
150			#endif
151	root	1.38	"\tret\n"
152			);
153
154	root	1.39	# endif
155	root	1.38
156			void
157			coro_create (coro_context ctx, coro_func coro, void arg, void *sptr, long ssize)
158	root	1.1	{
159	root	1.39	coro_context nctx;
160	root	1.1	# if CORO_SJLJ
161			stack_t ostk, nstk;
162			struct sigaction osa, nsa;
163			sigset_t nsig, osig;
164			# endif
165
166	root	1.38	if (!coro)
167			return;
168
169	root	1.1	coro_init_func = coro;
170			coro_init_arg = arg;
171
172			new_coro = ctx;
173			create_coro = &nctx;
174
175			# if CORO_SJLJ
176			/* we use SIGUSR2. first block it, then fiddle with it. */
177
178			sigemptyset (&nsig);
179			sigaddset (&nsig, SIGUSR2);
180			sigprocmask (SIG_BLOCK, &nsig, &osig);
181
182			nsa.sa_handler = trampoline;
183			sigemptyset (&nsa.sa_mask);
184			nsa.sa_flags = SA_ONSTACK;
185
186			if (sigaction (SIGUSR2, &nsa, &osa))
187	root	1.23	{
188			perror ("sigaction");
189			abort ();
190			}
191	root	1.1
192			/* set the new stack */
193	root	1.9	nstk.ss_sp = STACK_ADJUST_PTR (sptr,ssize); /* yes, some platforms (IRIX) get this wrong. */
194	root	1.8	nstk.ss_size = STACK_ADJUST_SIZE (sptr,ssize);
195	root	1.1	nstk.ss_flags = 0;
196
197			if (sigaltstack (&nstk, &ostk) < 0)
198	root	1.23	{
199			perror ("sigaltstack");
200			abort ();
201			}
202	root	1.1
203	root	1.39	trampoline_done = 0;
204	root	1.1	kill (getpid (), SIGUSR2);
205			sigfillset (&nsig); sigdelset (&nsig, SIGUSR2);
206
207	root	1.39	while (!trampoline_done)
208	root	1.1	sigsuspend (&nsig);
209
210			sigaltstack (0, &nstk);
211			nstk.ss_flags = SS_DISABLE;
212			if (sigaltstack (&nstk, 0) < 0)
213			perror ("sigaltstack");
214
215			sigaltstack (0, &nstk);
216			if (~nstk.ss_flags & SS_DISABLE)
217			abort ();
218
219			if (~ostk.ss_flags & SS_DISABLE)
220			sigaltstack (&ostk, 0);
221
222	root	1.19	sigaction (SIGUSR2, &osa, 0);
223	root	1.1	sigprocmask (SIG_SETMASK, &osig, 0);
224
225	root	1.16	# elif CORO_LOSER
226	root	1.1
227	root	1.44	coro_setjmp (ctx->env);
228	root	1.48	#if __CYGWIN__ && __i386
229	root	1.47	ctx->env[8] = (long) coro_init;
230			ctx->env[7] = (long) ((char *)sptr + ssize) - sizeof (long);
231	root	1.48	#elif __CYGWIN__ && __x86_64
232			ctx->env[7] = (long) coro_init;
233			ctx->env[6] = (long) ((char *)sptr + ssize) - sizeof (long);
234	root	1.45	#elif defined(__MINGW32__)
235	root	1.47	ctx->env[5] = (long) coro_init;
236			ctx->env[4] = (long) ((char *)sptr + ssize) - sizeof (long);
237	root	1.39	#elif defined(_M_IX86)
238	root	1.47	((_JUMP_BUFFER *)&ctx->env)->Eip = (long) coro_init;
239			((_JUMP_BUFFER *)&ctx->env)->Esp = (long) STACK_ADJUST_PTR (sptr, ssize) - sizeof (long);
240	root	1.39	#elif defined(_M_AMD64)
241	root	1.47	((_JUMP_BUFFER *)&ctx->env)->Rip = (__int64) coro_init;
242	root	1.48	((_JUMP_BUFFER *)&ctx->env)->Rsp = (__int64) STACK_ADJUST_PTR (sptr, ssize) - sizeof (__int64);
243	root	1.39	#elif defined(_M_IA64)
244	root	1.47	((_JUMP_BUFFER *)&ctx->env)->StIIP = (__int64) coro_init;
245	root	1.48	((_JUMP_BUFFER *)&ctx->env)->IntSp = (__int64) STACK_ADJUST_PTR (sptr, ssize) - sizeof (__int64);
246	root	1.39	#else
247			#error "microsoft libc or architecture not supported"
248			#endif
249	root	1.4
250			# elif CORO_LINUX
251
252	root	1.44	coro_setjmp (ctx->env);
253	root	1.39	#if __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (JB_PC) && defined (JB_SP)
254	root	1.47	ctx->env[0].__jmpbuf[JB_PC] = (long) coro_init;
255			ctx->env[0].__jmpbuf[JB_SP] = (long) STACK_ADJUST_PTR (sptr, ssize) - sizeof (long);
256	root	1.39	#elif __GLIBC__ >= 2 && __GLIBC_MINOR__ >= 0 && defined (__mc68000__)
257			ctx->env[0].__jmpbuf[0].__aregs[0] = (long int)coro_init;
258	root	1.47	ctx->env[0].__jmpbuf[0].__sp = (int ) ((char )sptr + ssize) - sizeof (long);
259	root	1.39	#elif defined (__GNU_LIBRARY__) && defined (__i386__)
260	root	1.47	ctx->env[0].__jmpbuf[0].__pc = (char *) coro_init;
261			ctx->env[0].__jmpbuf[0].__sp = (void ) ((char )sptr + ssize) - sizeof (long);
262	root	1.39	#elif defined (__GNU_LIBRARY__) && defined (__amd64__)
263	root	1.47	ctx->env[0].__jmpbuf[JB_PC] = (long) coro_init;
264			ctx->env[0].__jmpbuf[0].__sp = (void ) ((char )sptr + ssize) - sizeof (long);
265	root	1.39	#else
266			#error "linux libc or architecture not supported"
267			#endif
268	root	1.5
269			# elif CORO_IRIX
270
271	root	1.44	coro_setjmp (ctx->env, 0);
272	root	1.47	ctx->env[JB_PC] = (__uint64_t)coro_init;
273			ctx->env[JB_SP] = (__uint64_t)STACK_ADJUST_PTR (sptr, ssize) - sizeof (long);
274	root	1.1
275	root	1.27	# elif CORO_ASM
276
277	root	1.41	ctx->sp = (void *)(ssize + (char )sptr);
278	root	1.37	--ctx->sp = (void )abort; /* needed for alignment only */
279	root	1.27	--ctx->sp = (void )coro_init;
280	root	1.36	ctx->sp -= NUM_SAVED;
281	root	1.27
282	root	1.39	# elif CORO_UCONTEXT
283
284			getcontext (&(ctx->uc));
285
286			ctx->uc.uc_link = 0;
287			ctx->uc.uc_stack.ss_sp = sptr;
288			ctx->uc.uc_stack.ss_size = (size_t)ssize;
289			ctx->uc.uc_stack.ss_flags = 0;
290
291			makecontext (&(ctx->uc), (void (*)())coro_init, 0);
292
293	root	1.1	# endif
294
295	root	1.39	coro_transfer (create_coro, new_coro);
296			}
297
298			/*****************************************************************************/
299			/* pthread backend */
300			/*****************************************************************************/
301	root	1.40	#elif CORO_PTHREAD
302	root	1.1
303	root	1.39	/* this mutex will be locked by the running coroutine */
304			pthread_mutex_t coro_mutex = PTHREAD_MUTEX_INITIALIZER;
305	root	1.30
306	root	1.39	struct coro_init_args
307			{
308			coro_func func;
309			void *arg;
310			coro_context self, main;
311			};
312
313			static pthread_t null_tid;
314
315			/* I'd so love to cast pthread_mutex_unlock to void ()(void )... */
316			static void
317			mutex_unlock_wrapper (void *arg)
318			{
319			pthread_mutex_unlock ((pthread_mutex_t *)arg);
320			}
321
322			static void *
323			coro_init (void *args_)
324			{
325			struct coro_init_args args = (struct coro_init_args )args_;
326			coro_func func = args->func;
327			void *arg = args->arg;
328
329			pthread_mutex_lock (&coro_mutex);
330
331			/* we try to be good citizens and use deferred cancellation and cleanup handlers */
332			pthread_cleanup_push (mutex_unlock_wrapper, &coro_mutex);
333			coro_transfer (args->self, args->main);
334			func (arg);
335			pthread_cleanup_pop (1);
336
337			return 0;
338			}
339
340			void
341			coro_transfer (coro_context prev, coro_context next)
342			{
343			pthread_cond_signal (&next->cv);
344			pthread_cond_wait (&prev->cv, &coro_mutex);
345	root	1.43	#if __FreeBSD__ /* freebsd is of course broken and needs manual testcancel calls... yay... */
346			pthread_testcancel ();
347			#endif
348	root	1.39	}
349
350			void
351			coro_create (coro_context ctx, coro_func coro, void arg, void *sptr, long ssize)
352			{
353	root	1.38	static coro_context nctx;
354	root	1.30	static int once;
355
356			if (!once)
357			{
358	root	1.38	once = 1;
359
360	root	1.30	pthread_mutex_lock (&coro_mutex);
361	root	1.38	pthread_cond_init (&nctx.cv, 0);
362			null_tid = pthread_self ();
363	root	1.30	}
364
365	root	1.38	pthread_cond_init (&ctx->cv, 0);
366	root	1.30
367	root	1.38	if (coro)
368			{
369			pthread_attr_t attr;
370			struct coro_init_args args;
371
372			args.func = coro;
373			args.arg = arg;
374			args.self = ctx;
375			args.main = &nctx;
376
377			pthread_attr_init (&attr);
378			pthread_attr_setstack (&attr, sptr, (size_t)ssize);
379			pthread_attr_setscope (&attr, PTHREAD_SCOPE_PROCESS);
380	root	1.39	pthread_create (&ctx->id, &attr, coro_init, &args);
381	root	1.38
382			coro_transfer (args.main, args.self);
383			}
384			else
385			ctx->id = null_tid;
386	root	1.39	}
387
388			void
389			coro_destroy (coro_context *ctx)
390			{
391			if (!pthread_equal (ctx->id, null_tid))
392			{
393			pthread_cancel (ctx->id);
394			pthread_mutex_unlock (&coro_mutex);
395			pthread_join (ctx->id, 0);
396			pthread_mutex_lock (&coro_mutex);
397			}
398
399			pthread_cond_destroy (&ctx->cv);
400			}
401	root	1.30
402	root	1.40	#else
403			# error unsupported backend
404	root	1.1	#endif
405