#include "../includes/sched.h"

#include <errno.h>
#include <stdio.h>

static struct scheduler sched;

/* Lance une tâche de la pile */
void *worker_routine(void *arg) {
  struct scheduler *s = (struct scheduler *)arg;

  while (1) {
    pthread_mutex_lock(&s->mutex);

    if (s->exit == 1) {
      pthread_mutex_unlock(&s->mutex);
      printf("finalement..rien a faire, ciao\n");

      break;
    }

    // S'il on a rien à faire
    if (s->top == -1) {
      // printf("attend..\n");
      pthread_cond_wait(&s->cond, &s->mutex);
      pthread_mutex_unlock(&s->mutex);
      // printf("reveillé!\n");
      continue;
    }
    // printf("lancement tâche #%d\n", s->top);

    // Extrait la tâche de la pile
    taskfunc f = s->tasks[s->top].f;
    void *closure = s->tasks[s->top].closure;
    s->top--;
    pthread_mutex_unlock(&s->mutex);

    // Exécute la tâche
    f(closure, s);

    // Signale s'il n'y a plus rien à faire
    if (s->top == -1) {
      printf("va falloir partir\n");
      pthread_mutex_lock(&s->mutex);
      s->exit = 1;
      pthread_cond_broadcast(&s->cond);
      pthread_mutex_unlock(&s->mutex);
    }
  }

  return NULL;
}

int sched_init(int nthreads, int qlen, taskfunc f, void *closure) {
  if (nthreads == 0) {
    nthreads = sched_default_threads();
  }

  // TODO : Actuellement on n'utilises pas qlen
  // => On utilise une pile de taille fixe
  (void)qlen;

  sched.top = -1;
  sched.exit = 0;

  if (pthread_mutex_init(&sched.mutex, NULL) != 0) {
    fprintf(stderr, "Can't init mutex\n");
    return -1;
  }

  if (pthread_cond_init(&sched.cond, NULL) != 0) {
    fprintf(stderr, "Can't init condition variable\n");
    return -1;
  }

  pthread_t threads[nthreads];
  for (int i = 0; i < nthreads; ++i) {
    if (pthread_create(&threads[i], NULL, worker_routine, &sched) != 0) {
      fprintf(stderr, "Can't create threads\n");
      return -1;
    }
  }

  if (sched_spawn(f, closure, &sched) != 0) {
    fprintf(stderr, "Can't create the initial task\n");
    return -1;
  }

  for (int i = 0; i < nthreads; ++i) {
    if ((pthread_join(threads[i], NULL) != 0)) {
      fprintf(stderr, "Can't wait the thread %d\n", i);
      return -1;
    }
  }

  return 1;
}

int sched_spawn(taskfunc f, void *closure, struct scheduler *s) {
  pthread_mutex_lock(&s->mutex);

  if (s->top + 1 >= MAX_TASKS) {
    pthread_mutex_unlock(&s->mutex);
    errno = EAGAIN;
    fprintf(stderr, "Stack is full\n");
    return -1;
  }

  s->tasks[++s->top] = (taskinfo){f, closure};

  pthread_cond_signal(&s->cond);
  pthread_mutex_unlock(&s->mutex);

  return 0;
}