git.pond.sub.org Git - empserver/blob - src/lib/empthread/pthread.c

   1 /*
   2  *  Empire - A multi-player, client/server Internet based war game.
   3  *  Copyright (C) 1986-2010, Dave Pare, Jeff Bailey, Thomas Ruschak,
   4  *                           Ken Stevens, Steve McClure
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation; either version 2 of the License, or
   9  *  (at your option) any later version.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  *
  20  *  ---
  21  *
  22  *  See files README, COPYING and CREDITS in the root of the source
  23  *  tree for related information and legal notices.  It is expected
  24  *  that future projects/authors will amend these files as needed.
  25  *
  26  *  ---
  27  *
  28  *  pthread.c: Interface from Empire threads to POSIX threads
  29  *
  30  *  Known contributors to this file:
  31  *     Sasha Mikheev
  32  *     Steve McClure, 1998
  33  *     Markus Armbruster, 2005-2009
  34  *     Ron Koenderink, 2007-2009
  35  */
  36
  37 /* Required for PTHREAD_STACK_MIN on some systems, e.g. Solaris: */
  38 #define _XOPEN_SOURCE 500
  39
  40 #include <config.h>
  41
  42 #include <errno.h>
  43 #include <limits.h>
  44 #include <pthread.h>
  45 #include <signal.h>
  46 #include <stdarg.h>
  47 #include <stdio.h>
  48 #include <stdlib.h>
  49 #include <string.h>
  50 #include <sys/select.h>
  51 #include <unistd.h>
  52 #include "misc.h"
  53 #include "empthread.h"
  54 #include "file.h"
  55 #include "prototypes.h"
  56
  57 struct empth_t {
  58     char *name;                 /* thread name */
  59     void *ud;                   /* user data */
  60     int wakeup;
  61     void (*ep)(void *);         /* entry point */
  62     pthread_t id;               /* thread id */
  63 };
  64
  65 struct empth_rwlock_t {
  66     /* Can't use pthread_rwlock_t, because it needn't prefer writers */
  67     char *name;
  68     int nread;                  /* #active readers */
  69     int nwrite;                 /* total #writers (active and waiting) */
  70     pthread_cond_t can_read;
  71     pthread_cond_t can_write;
  72 };
  73
  74 /* Thread-specific data key */
  75 static pthread_key_t ctx_key;
  76
  77 /* Flags that were passed to empth_init() */
  78 static int empth_flags;
  79
  80 /* Pointer to thread context variable */
  81 static void **udata;
  82
  83 /*
  84  * Non-preemption mutex.
  85  * Empire code outside this file is only executed while holding this
  86  * mutex.  This makes sure Empire code is never preempted by Empire
  87  * code.
  88  */
  89 static pthread_mutex_t mtx_ctxsw;
  90
  91 static void empth_status(char *format, ...)
  92     ATTRIBUTE((format (printf, 1, 2)));
  93 static void empth_alarm(int sig);
  94
  95 static void *
  96 empth_start(void *arg)
  97 {
  98     empth_t *ctx = arg;
  99
 100     ctx->id = pthread_self();
 101     pthread_setspecific(ctx_key, ctx);
 102     pthread_mutex_lock(&mtx_ctxsw);
 103     *udata = ctx->ud;
 104     ctx->ep(ctx->ud);
 105     empth_exit();
 106     return NULL;
 107 }
 108
 109 static void
 110 empth_status(char *format, ...)
 111 {
 112     va_list ap;
 113     static struct timeval startTime;
 114     struct timeval tv;
 115     char buf[1024];
 116     int sec, msec;
 117     empth_t *a;
 118
 119     va_start(ap, format);
 120     if (empth_flags & EMPTH_PRINT) {
 121         if (startTime.tv_sec == 0)
 122             gettimeofday(&startTime, 0);
 123         gettimeofday(&tv, 0);
 124         sec = tv.tv_sec - startTime.tv_sec;
 125         msec = (tv.tv_usec - startTime.tv_usec) / 1000;
 126         if (msec < 0) {
 127             sec++;
 128             msec += 1000;
 129         }
 130         vsprintf(buf, format, ap);
 131         a = empth_self();
 132         printf("%d:%02d.%03d %17s: %s\n", sec / 60, sec % 60, msec / 10,
 133                a->name, buf);
 134
 135     }
 136     va_end(ap);
 137 }
 138
 139
 140 int
 141 empth_init(void **ctx_ptr, int flags)
 142 {
 143     empth_t *ctx;
 144     sigset_t set;
 145     struct sigaction act;
 146
 147     empth_flags = flags;
 148     udata = ctx_ptr;
 149
 150     empth_init_signals();
 151     sigemptyset(&set);
 152     sigaddset(&set, SIGHUP);
 153     sigaddset(&set, SIGINT);
 154     sigaddset(&set, SIGTERM);
 155     pthread_sigmask(SIG_BLOCK, &set, NULL);
 156     act.sa_flags = 0;
 157     sigemptyset(&act.sa_mask);
 158     act.sa_handler = empth_alarm;
 159     sigaction(SIGALRM, &act, NULL);
 160
 161     pthread_key_create(&ctx_key, NULL);
 162     pthread_mutex_init(&mtx_ctxsw, NULL);
 163
 164     ctx = malloc(sizeof(empth_t));
 165     if (!ctx) {
 166         logerror("pthread init failed: not enough memory");
 167         exit(1);
 168     }
 169     ctx->name = "Main";
 170     ctx->ep = 0;
 171     ctx->ud = 0;
 172     ctx->id = pthread_self();
 173     ctx->wakeup = 0;
 174     pthread_setspecific(ctx_key, ctx);
 175     pthread_mutex_lock(&mtx_ctxsw);
 176     logerror("pthreads initialized");
 177     return 0;
 178 }
 179
 180
 181 empth_t *
 182 empth_create(void (*entry)(void *), int size, int flags,
 183              char *name, void *ud)
 184 {
 185     pthread_t t;
 186     pthread_attr_t attr;
 187     empth_t *ctx;
 188     int eno;
 189
 190     empth_status("creating new thread %s", name);
 191     ef_make_stale();
 192
 193     ctx = malloc(sizeof(empth_t));
 194     if (!ctx) {
 195         logerror("not enough memory to create thread %s", name);
 196         return NULL;
 197     }
 198     ctx->name = strdup(name);
 199     ctx->ud = ud;
 200     ctx->wakeup = 0;
 201     ctx->ep = entry;
 202
 203     eno = pthread_attr_init(&attr);
 204     if (eno) {
 205         logerror("can not create thread attribute %s: %s",
 206                  name, strerror(eno));
 207         goto bad;
 208     }
 209     if (size < PTHREAD_STACK_MIN)
 210         size = PTHREAD_STACK_MIN;
 211     pthread_attr_setstacksize(&attr, size);
 212     pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
 213
 214     eno = pthread_create(&t, &attr, empth_start, ctx);
 215     if (eno) {
 216         logerror("can not create thread: %s: %s", name, strerror(eno));
 217         goto bad;
 218     }
 219     empth_status("new thread id is %ld", (long)t);
 220     empth_yield();
 221     return ctx;
 222
 223   bad:
 224     pthread_attr_destroy(&attr);
 225     free(ctx);
 226     return NULL;
 227 }
 228
 229
 230 static void
 231 empth_restorectx(void)
 232 {
 233     empth_t *ctx_ptr;
 234
 235     ctx_ptr = pthread_getspecific(ctx_key);
 236     *udata = ctx_ptr->ud;
 237     ctx_ptr->wakeup = 0;
 238     empth_status("context restored");
 239 }
 240
 241 empth_t *
 242 empth_self(void)
 243 {
 244     return pthread_getspecific(ctx_key);
 245 }
 246
 247 char *
 248 empth_name(empth_t *thread)
 249 {
 250     return thread->name;
 251 }
 252
 253 void
 254 empth_set_name(empth_t *thread, char *name)
 255 {
 256     if (thread->name)
 257         free(thread->name);
 258     thread->name = strdup(name);
 259 }
 260
 261 void
 262 empth_exit(void)
 263 {
 264     empth_t *ctx = pthread_getspecific(ctx_key);
 265
 266     empth_status("empth_exit");
 267     ef_make_stale();
 268     pthread_mutex_unlock(&mtx_ctxsw);
 269     free(ctx->name);
 270     free(ctx);
 271     pthread_exit(0);
 272 }
 273
 274 void
 275 empth_yield(void)
 276 {
 277     ef_make_stale();
 278     pthread_mutex_unlock(&mtx_ctxsw);
 279     pthread_mutex_lock(&mtx_ctxsw);
 280     empth_restorectx();
 281 }
 282
 283 int
 284 empth_select(int fd, int flags, struct timeval *timeout)
 285 {
 286     fd_set readmask;
 287     fd_set writemask;
 288     struct timeval tv;
 289     int n;
 290     empth_t *ctx;
 291     int res = 0;
 292
 293     ef_make_stale();
 294     pthread_mutex_unlock(&mtx_ctxsw);
 295     empth_status("select on %d for %d", fd, flags);
 296
 297 again:
 298     FD_ZERO(&readmask);
 299     FD_ZERO(&writemask);
 300     if (flags & EMPTH_FD_READ)
 301         FD_SET(fd, &readmask);
 302     if (flags & EMPTH_FD_WRITE)
 303         FD_SET(fd, &writemask);
 304
 305     if (timeout)
 306         tv = *timeout;
 307     n = select(fd + 1, &readmask, &writemask, NULL, timeout ? &tv : NULL);
 308     if (n < 0) {
 309         ctx = pthread_getspecific(ctx_key);
 310         if (ctx->wakeup) {
 311             empth_status("select woken up");
 312             res = 0;
 313         } else if (errno == EINTR) {
 314             empth_status("select broken by signal");
 315             goto again;
 316         } else {
 317             empth_status("select failed (%s)", strerror(errno));
 318             res = -1;
 319         }
 320     } else if (n == 0) {
 321         empth_status("select timed out");
 322         res = 0;
 323     } else if (flags == EMPTH_FD_READ && FD_ISSET(fd, &readmask)) {
 324         empth_status("input ready");
 325         res = 1;
 326     } else if (flags == EMPTH_FD_WRITE && FD_ISSET(fd, &writemask)) {
 327         empth_status("output ready");
 328         res = 1;
 329     }
 330
 331     pthread_mutex_lock(&mtx_ctxsw);
 332     empth_restorectx();
 333     return res;
 334 }
 335
 336 static void
 337 empth_alarm(int sig)
 338 {
 339     /*
 340      * Nothing to do --- we handle this signal just to let
 341      * empth_wakeup() interrupt system calls.
 342      */
 343 }
 344
 345 void
 346 empth_wakeup(empth_t *a)
 347 {
 348     empth_status("waking up thread %s", a->name);
 349     a->wakeup = 1;
 350     pthread_kill(a->id, SIGALRM);
 351 }
 352
 353 int
 354 empth_sleep(time_t until)
 355 {
 356     empth_t *ctx = pthread_getspecific(ctx_key);
 357     time_t now;
 358     struct timeval tv;
 359     int res;
 360
 361     ef_make_stale();
 362     pthread_mutex_unlock(&mtx_ctxsw);
 363     do {
 364         now = time(NULL);
 365         tv.tv_sec = until >= now ? until - now : 0;
 366         tv.tv_usec = 0;
 367         empth_status("going to sleep %ld sec", (long)tv.tv_sec);
 368         res = select(0, NULL, NULL, NULL, &tv);
 369     } while (res < 0 && !ctx->wakeup);
 370     empth_status("sleep done. Waiting for lock");
 371     pthread_mutex_lock(&mtx_ctxsw);
 372     empth_restorectx();
 373     return res;
 374 }
 375
 376 int
 377 empth_wait_for_signal(void)
 378 {
 379     sigset_t set;
 380     int sig, err;
 381
 382     ef_make_stale();
 383     sigemptyset(&set);
 384     sigaddset(&set, SIGHUP);
 385     sigaddset(&set, SIGINT);
 386     sigaddset(&set, SIGTERM);
 387     pthread_mutex_unlock(&mtx_ctxsw);
 388     for (;;) {
 389         empth_status("waiting for signals");
 390         err = sigwait(&set, &sig);
 391         if (CANT_HAPPEN(err)) {
 392             sleep(60);
 393             continue;
 394         }
 395         empth_status("got awaited signal %d", sig);
 396         pthread_mutex_lock(&mtx_ctxsw);
 397         empth_restorectx();
 398         return sig;
 399     }
 400 }
 401
 402 empth_rwlock_t *
 403 empth_rwlock_create(char *name)
 404 {
 405     empth_rwlock_t *rwlock;
 406
 407     rwlock = malloc(sizeof(*rwlock));
 408     if (!rwlock)
 409         return NULL;
 410
 411     if (pthread_cond_init(&rwlock->can_read, NULL) != 0
 412         || pthread_cond_init(&rwlock->can_write, NULL) != 0) {
 413         free(rwlock);
 414         return NULL;
 415     }
 416
 417     rwlock->name = strdup(name);
 418     rwlock->nread = rwlock->nwrite = 0;
 419     return rwlock;
 420 }
 421
 422 void
 423 empth_rwlock_destroy(empth_rwlock_t *rwlock)
 424 {
 425     pthread_cond_destroy(&rwlock->can_read);
 426     pthread_cond_destroy(&rwlock->can_write);
 427     free(rwlock->name);
 428     free(rwlock);
 429 }
 430
 431 void
 432 empth_rwlock_wrlock(empth_rwlock_t *rwlock)
 433 {
 434     empth_status("wrlock %s %d %d",
 435                  rwlock->name, rwlock->nread, rwlock->nwrite);
 436     ef_make_stale();
 437     rwlock->nwrite++;
 438     while (rwlock->nread != 0 || rwlock->nwrite != 1) {
 439         empth_status("waiting for wrlock %s", rwlock->name);
 440         pthread_cond_wait(&rwlock->can_write, &mtx_ctxsw);
 441         empth_status("got wrlock %s %d %d",
 442                  rwlock->name, rwlock->nread, rwlock->nwrite);
 443         empth_restorectx();
 444     }
 445 }
 446
 447 void
 448 empth_rwlock_rdlock(empth_rwlock_t *rwlock)
 449 {
 450     empth_status("rdlock %s %d %d",
 451                  rwlock->name, rwlock->nread, rwlock->nwrite);
 452     ef_make_stale();
 453     while (rwlock->nwrite) {
 454         empth_status("waiting for rdlock %s", rwlock->name);
 455         pthread_cond_wait(&rwlock->can_read, &mtx_ctxsw);
 456         empth_status("got rdlock %s %d %d",
 457                      rwlock->name, rwlock->nread, rwlock->nwrite);
 458         empth_restorectx();
 459     }
 460     rwlock->nread++;
 461 }
 462
 463 void
 464 empth_rwlock_unlock(empth_rwlock_t *rwlock)
 465 {
 466     if (CANT_HAPPEN(!rwlock->nread && !rwlock->nwrite))
 467         return;
 468     if (rwlock->nread) {        /* holding read lock */
 469         if (!--rwlock->nread)
 470             pthread_cond_signal(&rwlock->can_write);
 471     } else {
 472         rwlock->nwrite--;
 473         pthread_cond_signal(&rwlock->can_write);
 474     }
 475     if (rwlock->nwrite == 0)
 476         pthread_cond_broadcast(&rwlock->can_read);
 477 }