Chris@10: /*
Chris@10:  * Copyright (c) 2003, 2007-11 Matteo Frigo
Chris@10:  * Copyright (c) 2003, 2007-11 Massachusetts Institute of Technology
Chris@10:  *
Chris@10:  * This program is free software; you can redistribute it and/or modify
Chris@10:  * it under the terms of the GNU General Public License as published by
Chris@10:  * the Free Software Foundation; either version 2 of the License, or
Chris@10:  * (at your option) any later version.
Chris@10:  *
Chris@10:  * This program is distributed in the hope that it will be useful,
Chris@10:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
Chris@10:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
Chris@10:  * GNU General Public License for more details.
Chris@10:  *
Chris@10:  * You should have received a copy of the GNU General Public License
Chris@10:  * along with this program; if not, write to the Free Software
Chris@10:  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
Chris@10:  *
Chris@10:  */
Chris@10: 
Chris@10: /* threads.c: Portable thread spawning for loops, via the X(spawn_loop)
Chris@10:    function.  The first portion of this file is a set of macros to
Chris@10:    spawn and join threads on various systems. */
Chris@10: 
Chris@10: #include "threads.h"
Chris@10: 
Chris@10: #if defined(USING_POSIX_THREADS)
Chris@10: 
Chris@10: #include <pthread.h>
Chris@10: 
Chris@10: #ifdef HAVE_UNISTD_H
Chris@10: #  include <unistd.h>
Chris@10: #endif
Chris@10: 
Chris@10: /* imlementation of semaphores and mutexes: */
Chris@10: #if (defined(_POSIX_SEMAPHORES) && (_POSIX_SEMAPHORES >= 200112L))
Chris@10: 
Chris@10:    /* If optional POSIX semaphores are supported, use them to
Chris@10:       implement both semaphores and mutexes. */
Chris@10: #  include <semaphore.h>
Chris@10: #  include <errno.h>
Chris@10: 
Chris@10:    typedef sem_t os_sem_t;
Chris@10: 
Chris@10:    static void os_sem_init(os_sem_t *s) { sem_init(s, 0, 0); }
Chris@10:    static void os_sem_destroy(os_sem_t *s) { sem_destroy(s); }
Chris@10: 
Chris@10:    static void os_sem_down(os_sem_t *s)
Chris@10:    {
Chris@10: 	int err;
Chris@10: 	do {
Chris@10: 	     err = sem_wait(s);
Chris@10: 	} while (err == -1 && errno == EINTR);
Chris@10: 	CK(err == 0);
Chris@10:    }
Chris@10: 
Chris@10:    static void os_sem_up(os_sem_t *s) { sem_post(s); }
Chris@10: 
Chris@10:    /*
Chris@10:       The reason why we use sem_t to implement mutexes is that I have
Chris@10:       seen mysterious hangs with glibc-2.7 and linux-2.6.22 when using
Chris@10:       pthread_mutex_t, but no hangs with sem_t or with linux >=
Chris@10:       2.6.24.  For lack of better information, sem_t looks like the
Chris@10:       safest choice.
Chris@10:    */
Chris@10:    typedef sem_t os_mutex_t;
Chris@10:    static void os_mutex_init(os_mutex_t *s) { sem_init(s, 0, 1); }
Chris@10:    #define os_mutex_destroy os_sem_destroy
Chris@10:    #define os_mutex_lock os_sem_down
Chris@10:    #define os_mutex_unlock os_sem_up
Chris@10: 
Chris@10: #else
Chris@10: 
Chris@10:    /* If optional POSIX semaphores are not defined, use pthread
Chris@10:       mutexes for mutexes, and simulate semaphores with condition
Chris@10:       variables */
Chris@10:    typedef pthread_mutex_t os_mutex_t;
Chris@10: 
Chris@10:    static void os_mutex_init(os_mutex_t *s) 
Chris@10:    { 
Chris@10: 	pthread_mutex_init(s, (pthread_mutexattr_t *)0);
Chris@10:    }
Chris@10: 
Chris@10:    static void os_mutex_destroy(os_mutex_t *s) { pthread_mutex_destroy(s); }
Chris@10:    static void os_mutex_lock(os_mutex_t *s) { pthread_mutex_lock(s); }
Chris@10:    static void os_mutex_unlock(os_mutex_t *s) { pthread_mutex_unlock(s); }
Chris@10: 
Chris@10:    typedef struct {
Chris@10: 	pthread_mutex_t m;
Chris@10: 	pthread_cond_t c;
Chris@10: 	volatile int x;
Chris@10:    } os_sem_t; 
Chris@10: 
Chris@10:    static void os_sem_init(os_sem_t *s)
Chris@10:    {
Chris@10: 	pthread_mutex_init(&s->m, (pthread_mutexattr_t *)0);
Chris@10: 	pthread_cond_init(&s->c, (pthread_condattr_t *)0);
Chris@10: 
Chris@10: 	/* wrap initialization in lock to exploit the release
Chris@10: 	   semantics of pthread_mutex_unlock() */
Chris@10: 	pthread_mutex_lock(&s->m);
Chris@10: 	s->x = 0;
Chris@10: 	pthread_mutex_unlock(&s->m);
Chris@10:    }
Chris@10: 
Chris@10:    static void os_sem_destroy(os_sem_t *s)
Chris@10:    {
Chris@10: 	pthread_mutex_destroy(&s->m);
Chris@10: 	pthread_cond_destroy(&s->c);
Chris@10:    }
Chris@10: 
Chris@10:    static void os_sem_down(os_sem_t *s)
Chris@10:    {
Chris@10: 	pthread_mutex_lock(&s->m);
Chris@10: 	while (s->x <= 0) 
Chris@10: 	     pthread_cond_wait(&s->c, &s->m);
Chris@10: 	--s->x;
Chris@10: 	pthread_mutex_unlock(&s->m);
Chris@10:    }
Chris@10: 
Chris@10:    static void os_sem_up(os_sem_t *s)
Chris@10:    {
Chris@10: 	pthread_mutex_lock(&s->m);
Chris@10: 	++s->x;
Chris@10: 	pthread_cond_signal(&s->c);
Chris@10: 	pthread_mutex_unlock(&s->m);
Chris@10:    }
Chris@10: 
Chris@10: #endif
Chris@10: 
Chris@10: #define FFTW_WORKER void *
Chris@10: 
Chris@10: static void os_create_thread(FFTW_WORKER (*worker)(void *arg), 
Chris@10: 			     void *arg)
Chris@10: {
Chris@10:      pthread_attr_t attr;
Chris@10:      pthread_t tid;
Chris@10: 
Chris@10:      pthread_attr_init(&attr);
Chris@10:      pthread_attr_setscope(&attr, PTHREAD_SCOPE_SYSTEM); 
Chris@10:      pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
Chris@10: 
Chris@10:      pthread_create(&tid, &attr, worker, (void *)arg);
Chris@10:      pthread_attr_destroy(&attr);
Chris@10: }
Chris@10: 
Chris@10: static void os_destroy_thread(void)
Chris@10: {
Chris@10:      pthread_exit((void *)0);
Chris@10: }
Chris@10: 
Chris@10: #elif defined(__WIN32__) || defined(_WIN32) || defined(_WINDOWS)
Chris@10: /* hack: windef.h defines INT for its own purposes and this causes
Chris@10:    a conflict with our own INT in ifftw.h.  Divert the windows
Chris@10:    definition into another name unlikely to cause a conflict */
Chris@10: #define INT magnus_ab_INTegro_seclorum_nascitur_ordo
Chris@10: #include <windows.h>
Chris@10: #include <process.h>
Chris@10: #undef INT
Chris@10: 
Chris@10: typedef HANDLE os_mutex_t;
Chris@10: 
Chris@10: static void os_mutex_init(os_mutex_t *s) 
Chris@10: { 
Chris@10:      *s = CreateMutex(NULL, FALSE, NULL);
Chris@10: }
Chris@10: 
Chris@10: static void os_mutex_destroy(os_mutex_t *s) 
Chris@10: { 
Chris@10:      CloseHandle(*s);
Chris@10: }
Chris@10: 
Chris@10: static void os_mutex_lock(os_mutex_t *s)
Chris@10: { 
Chris@10:      WaitForSingleObject(*s, INFINITE);
Chris@10: }
Chris@10: 
Chris@10: static void os_mutex_unlock(os_mutex_t *s) 
Chris@10: { 
Chris@10:      ReleaseMutex(*s);
Chris@10: }
Chris@10: 
Chris@10: typedef HANDLE os_sem_t;
Chris@10: 
Chris@10: static void os_sem_init(os_sem_t *s) 
Chris@10: {
Chris@10:      *s = CreateSemaphore(NULL, 0, 0x7FFFFFFFL, NULL);
Chris@10: }
Chris@10: 
Chris@10: static void os_sem_destroy(os_sem_t *s) 
Chris@10: { 
Chris@10:      CloseHandle(*s);
Chris@10: }
Chris@10: 
Chris@10: static void os_sem_down(os_sem_t *s) 
Chris@10: { 
Chris@10:      WaitForSingleObject(*s, INFINITE);
Chris@10: }
Chris@10: 
Chris@10: static void os_sem_up(os_sem_t *s) 
Chris@10: {
Chris@10:      ReleaseSemaphore(*s, 1, NULL);
Chris@10: }
Chris@10: 
Chris@10: #define FFTW_WORKER unsigned __stdcall
Chris@10: typedef unsigned (__stdcall *winthread_start) (void *);
Chris@10: 
Chris@10: static void os_create_thread(winthread_start worker,
Chris@10: 			     void *arg)
Chris@10: {
Chris@10:      _beginthreadex((void *)NULL,               /* security attrib */
Chris@10: 		    0,				/* stack size */
Chris@10: 		    worker,                     /* start address */
Chris@10: 		    arg,			/* parameters */
Chris@10: 		    0,				/* creation flags */
Chris@10: 		    (unsigned *)NULL);		/* tid */
Chris@10: }
Chris@10: 
Chris@10: static void os_destroy_thread(void)
Chris@10: {
Chris@10:      _endthreadex(0);
Chris@10: }
Chris@10: 
Chris@10: 
Chris@10: #else
Chris@10: #error "No threading layer defined"
Chris@10: #endif
Chris@10: 
Chris@10: /************************************************************************/
Chris@10: 
Chris@10: /* Main code: */
Chris@10: struct worker {
Chris@10:      os_sem_t ready;
Chris@10:      os_sem_t done;
Chris@10:      struct work *w;
Chris@10:      struct worker *cdr;
Chris@10: };
Chris@10: 
Chris@10: static struct worker *make_worker(void)
Chris@10: {
Chris@10:      struct worker *q = (struct worker *)MALLOC(sizeof(*q), OTHER);
Chris@10:      os_sem_init(&q->ready);
Chris@10:      os_sem_init(&q->done);
Chris@10:      return q;
Chris@10: }
Chris@10: 
Chris@10: static void unmake_worker(struct worker *q)
Chris@10: {
Chris@10:      os_sem_destroy(&q->done);
Chris@10:      os_sem_destroy(&q->ready);
Chris@10:      X(ifree)(q);
Chris@10: }
Chris@10: 
Chris@10: struct work {
Chris@10:      spawn_function proc;
Chris@10:      spawn_data d;
Chris@10:      struct worker *q; /* the worker responsible for performing this work */
Chris@10: };
Chris@10: 
Chris@10: static os_mutex_t queue_lock;
Chris@10: static os_sem_t termination_semaphore;
Chris@10: 
Chris@10: static struct worker *worker_queue;
Chris@10: #define WITH_QUEUE_LOCK(what)			\
Chris@10: {						\
Chris@10:      os_mutex_lock(&queue_lock);		\
Chris@10:      what;					\
Chris@10:      os_mutex_unlock(&queue_lock);		\
Chris@10: }
Chris@10: 
Chris@10: static FFTW_WORKER worker(void *arg)
Chris@10: {
Chris@10:      struct worker *ego = (struct worker *)arg;
Chris@10:      struct work *w;
Chris@10: 
Chris@10:      for (;;) {
Chris@10: 	  /* wait until work becomes available */
Chris@10: 	  os_sem_down(&ego->ready);
Chris@10: 
Chris@10: 	  w = ego->w;
Chris@10: 
Chris@10: 	  /* !w->proc ==> terminate worker */
Chris@10: 	  if (!w->proc) break;
Chris@10: 
Chris@10: 	  /* do the work */
Chris@10:           w->proc(&w->d);
Chris@10: 
Chris@10: 	  /* signal that work is done */
Chris@10: 	  os_sem_up(&ego->done);
Chris@10:      }
Chris@10: 
Chris@10:      /* termination protocol */
Chris@10:      os_sem_up(&termination_semaphore);
Chris@10: 
Chris@10:      os_destroy_thread();
Chris@10:      /* UNREACHABLE */
Chris@10:      return 0;
Chris@10: }
Chris@10: 
Chris@10: static void enqueue(struct worker *q)
Chris@10: {
Chris@10:      WITH_QUEUE_LOCK({
Chris@10: 	  q->cdr = worker_queue;
Chris@10: 	  worker_queue = q;
Chris@10:      });
Chris@10: }
Chris@10: 
Chris@10: static struct worker *dequeue(void)
Chris@10: {
Chris@10:      struct worker *q;
Chris@10: 
Chris@10:      WITH_QUEUE_LOCK({
Chris@10: 	  q = worker_queue;
Chris@10: 	  if (q) 
Chris@10: 	       worker_queue = q->cdr;
Chris@10:      });
Chris@10: 
Chris@10:      if (!q) {
Chris@10: 	  /* no worker is available.  Create one */
Chris@10: 	  q = make_worker();
Chris@10: 	  os_create_thread(worker, q);
Chris@10:      }
Chris@10: 
Chris@10:      return q;
Chris@10: }
Chris@10: 
Chris@10: 
Chris@10: static void kill_workforce(void)
Chris@10: {
Chris@10:      struct work w;
Chris@10: 
Chris@10:      w.proc = 0;
Chris@10: 
Chris@10:      THREAD_ON; /* needed for debugging mode: since make_worker
Chris@10: 		   is called from dequeue which is only called in
Chris@10: 		   thread_on mode, we need to unmake_worker in thread_on. */
Chris@10:      WITH_QUEUE_LOCK({
Chris@10: 	  /* tell all workers that they must terminate.  
Chris@10: 
Chris@10: 	     Because workers enqueue themselves before signaling the
Chris@10: 	     completion of the work, all workers belong to the worker queue
Chris@10: 	     if we get here.  Also, all workers are waiting at
Chris@10: 	     os_sem_down(ready), so we can hold the queue lock without
Chris@10: 	     deadlocking */
Chris@10: 	  while (worker_queue) {
Chris@10: 	       struct worker *q = worker_queue;
Chris@10: 	       worker_queue = q->cdr;
Chris@10: 	       q->w = &w;
Chris@10: 	       os_sem_up(&q->ready);
Chris@10: 	       os_sem_down(&termination_semaphore);
Chris@10: 	       unmake_worker(q);
Chris@10: 	  }
Chris@10:      });
Chris@10:      THREAD_OFF;
Chris@10: }
Chris@10: 
Chris@10: int X(ithreads_init)(void)
Chris@10: {
Chris@10:      os_mutex_init(&queue_lock);
Chris@10:      os_sem_init(&termination_semaphore);
Chris@10: 
Chris@10:      WITH_QUEUE_LOCK({
Chris@10: 	  worker_queue = 0;
Chris@10:      })
Chris@10: 
Chris@10:      return 0; /* no error */
Chris@10: }
Chris@10: 
Chris@10: /* Distribute a loop from 0 to loopmax-1 over nthreads threads.
Chris@10:    proc(d) is called to execute a block of iterations from d->min
Chris@10:    to d->max-1.  d->thr_num indicate the number of the thread
Chris@10:    that is executing proc (from 0 to nthreads-1), and d->data is
Chris@10:    the same as the data parameter passed to X(spawn_loop).
Chris@10: 
Chris@10:    This function returns only after all the threads have completed. */
Chris@10: void X(spawn_loop)(int loopmax, int nthr, spawn_function proc, void *data)
Chris@10: {
Chris@10:      int block_size;
Chris@10:      struct work *r;
Chris@10:      int i;
Chris@10: 
Chris@10:      A(loopmax >= 0);
Chris@10:      A(nthr > 0);
Chris@10:      A(proc);
Chris@10: 
Chris@10:      if (!loopmax) return;
Chris@10: 
Chris@10:      /* Choose the block size and number of threads in order to (1)
Chris@10:         minimize the critical path and (2) use the fewest threads that
Chris@10:         achieve the same critical path (to minimize overhead).
Chris@10:         e.g. if loopmax is 5 and nthr is 4, we should use only 3
Chris@10:         threads with block sizes of 2, 2, and 1. */
Chris@10:      block_size = (loopmax + nthr - 1) / nthr;
Chris@10:      nthr = (loopmax + block_size - 1) / block_size;
Chris@10: 
Chris@10:      THREAD_ON; /* prevent debugging mode from failing under threads */
Chris@10:      STACK_MALLOC(struct work *, r, sizeof(struct work) * nthr);
Chris@10: 	  
Chris@10:      /* distribute work: */
Chris@10:      for (i = 0; i < nthr; ++i) {
Chris@10: 	  struct work *w = &r[i];
Chris@10: 	  spawn_data *d = &w->d;
Chris@10: 
Chris@10: 	  d->max = (d->min = i * block_size) + block_size;
Chris@10: 	  if (d->max > loopmax)
Chris@10: 	       d->max = loopmax;
Chris@10: 	  d->thr_num = i;
Chris@10: 	  d->data = data;
Chris@10: 	  w->proc = proc;
Chris@10: 	   
Chris@10: 	  if (i == nthr - 1) {
Chris@10: 	       /* do the work ourselves */
Chris@10: 	       proc(d);
Chris@10: 	  } else {
Chris@10: 	       /* assign a worker to W */
Chris@10: 	       w->q = dequeue();
Chris@10: 
Chris@10: 	       /* tell worker w->q to do it */
Chris@10: 	       w->q->w = w; /* Dirac could have written this */
Chris@10: 	       os_sem_up(&w->q->ready);
Chris@10: 	  }
Chris@10:      }
Chris@10: 
Chris@10:      for (i = 0; i < nthr - 1; ++i) { 
Chris@10: 	  struct work *w = &r[i];
Chris@10: 	  os_sem_down(&w->q->done);
Chris@10: 	  enqueue(w->q);
Chris@10:      }
Chris@10: 
Chris@10:      STACK_FREE(r);
Chris@10:      THREAD_OFF; /* prevent debugging mode from failing under threads */
Chris@10: }
Chris@10: 
Chris@10: void X(threads_cleanup)(void)
Chris@10: {
Chris@10:      kill_workforce();
Chris@10:      os_mutex_destroy(&queue_lock);
Chris@10:      os_sem_destroy(&termination_semaphore);
Chris@10: }