threads.cc

   1 #include <stdlib.h>
   2
   3 #include "libthreads.h"
   4 #include "schedule.h"
   5 #include "common.h"
   6 #include "threads.h"
   7
   8 /* global "model" object */
   9 #include "model.h"
  10
  11 #define STACK_SIZE (1024 * 1024)
  12
  13 static void * stack_allocate(size_t size)
  14 {
  15         return malloc(size);
  16 }
  17
  18 static void stack_free(void *stack)
  19 {
  20         free(stack);
  21 }
  22
  23 Thread * thread_current(void)
  24 {
  25         return model->scheduler->get_current_thread();
  26 }
  27
  28 int Thread::create_context()
  29 {
  30         int ret;
  31
  32         ret = getcontext(&context);
  33         if (ret)
  34                 return ret;
  35
  36         /* start_routine == NULL means this is our initial context */
  37         if (!start_routine)
  38                 return 0;
  39
  40         /* Initialize new managed context */
  41         stack = stack_allocate(STACK_SIZE);
  42         context.uc_stack.ss_sp = stack;
  43         context.uc_stack.ss_size = STACK_SIZE;
  44         context.uc_stack.ss_flags = 0;
  45         context.uc_link = &model->system_thread->context;
  46         makecontext(&context, start_routine, 1, arg);
  47
  48         return 0;
  49 }
  50
  51 int Thread::swap(Thread *t)
  52 {
  53         return swapcontext(&this->context, &t->context);
  54 }
  55
  56 void Thread::dispose()
  57 {
  58         DEBUG("completed thread %d\n", thread_current()->get_id());
  59         state = THREAD_COMPLETED;
  60         stack_free(stack);
  61 }
  62
  63 Thread::Thread(thrd_t *t, void (*func)(), void *a) {
  64         int ret;
  65
  66         user_thread = t;
  67         start_routine = func;
  68         arg = a;
  69
  70         /* Initialize state */
  71         ret = create_context();
  72         if (ret)
  73                 printf("Error in create_context\n");
  74
  75         state = THREAD_CREATED;
  76         id = model->get_next_id();
  77         *user_thread = id;
  78         model->scheduler->add_thread(this);
  79 }
  80
  81 Thread::Thread(thrd_t *t) {
  82         /* system thread */
  83         user_thread = t;
  84         start_routine = NULL;
  85         arg = NULL;
  86
  87         state = THREAD_CREATED;
  88         id = model->get_next_id();
  89         *user_thread = id;
  90         create_context();
  91         model->add_system_thread(this);
  92 }
  93
  94 thread_id_t Thread::get_id()
  95 {
  96         return id;
  97 }
  98
  99 /*
 100  * Return 1 if found next thread, 0 otherwise
 101  */
 102 static int thread_system_next(void)
 103 {
 104         Thread *curr, *next;
 105
 106         curr = thread_current();
 107         model->check_current_action();
 108         if (curr) {
 109                 if (curr->get_state() == THREAD_READY)
 110                         model->scheduler->add_thread(curr);
 111                 else if (curr->get_state() == THREAD_RUNNING)
 112                         /* Stopped while running; i.e., completed */
 113                         curr->dispose();
 114                 else
 115                         DEBUG("ERROR: current thread in unexpected state??\n");
 116         }
 117         next = model->scheduler->next_thread();
 118         if (next)
 119                 next->set_state(THREAD_RUNNING);
 120         DEBUG("(%d, %d)\n", curr ? curr->get_id() : -1, next ? next->get_id() : -1);
 121         if (!next)
 122                 return 1;
 123         return model->system_thread->swap(next);
 124 }
 125
 126 static void thread_wait_finish(void)
 127 {
 128
 129         DBG();
 130
 131         while (!thread_system_next());
 132 }
 133
 134 /*
 135  * Main system function
 136  */
 137 int main()
 138 {
 139         thrd_t user_thread, main_thread;
 140         Thread *th;
 141
 142         model = new ModelChecker();
 143
 144         th = new Thread(&main_thread);
 145
 146         do {
 147                 /* Start user program */
 148                 thrd_create(&user_thread, &user_main, NULL);
 149
 150                 /* Wait for all threads to complete */
 151                 thread_wait_finish();
 152
 153                 model->print_trace();
 154         } while (model->next_execution());
 155
 156         delete th;
 157         delete model;
 158
 159         DEBUG("Exiting\n");
 160         return 0;
 161 }