#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <unistd.h>

#include "../../context.h"

int cpu_num = 1;
int length = 102400;
int split = 8;
int* array_ptr;
int gpu_num = 0;
int CPU_ANY = -1;
int CPU_CUDA = -1;

void print_queue(struct Element* element) {
    while (element) {
        printf("%p\n", ((struct Task *)(element->data)));
        element = element->next;
    }
}

void print_tree(struct Node* node) {
    if (node != 0) {
        printf("%d\n", node->value->Array.index);
        print_tree(node->left);
        print_tree(node->right);
    }
}

void *start_taskManager(struct Context *context) {
    goto initDataGears(context, Gearef(context, LoopCounter), Gearef(context, TaskManager));
    return 0;
}

#ifdef USE_CUDAWorker
#ifdef USE_CUDA_MAIN_THREAD
extern volatile int cuda_initialized;
#endif
#endif

__code initDataGears(struct LoopCounter* loopCounter, struct TaskManager* taskManager) {
    // loopCounter->tree = createRedBlackTree(context);
    loopCounter->i = 0;
    taskManager->taskManager = (union Data*)createTaskManagerImpl(context, cpu_num, gpu_num, 0);
#ifdef USE_CUDAWorker
#ifdef USE_CUDA_MAIN_THREAD
    while(! cuda_initialized) {};
#endif
#endif
    goto meta(context, C_code1);
}

__code initDataGears_stub(struct Context* context) {
    struct TaskManager* taskManager =  Gearef(context, TaskManager);
    taskManager->taskManager = 0;
#if (! defined(USE_CUDAWorker) || ! defined(USE_CUDA_MAIN_THREAD))
    struct LoopCounter* loopCounter = Gearef(context, LoopCounter);
    goto initDataGears(context, loopCounter, taskManager);
#else
    cuda_initialized = 0;
    pthread_t thread;
    pthread_create(&thread, NULL, (void*)&start_taskManager, context);
    while (taskManager->taskManager == 0);
    TaskManager *t = (TaskManager*)taskManager->taskManager;
    TaskManagerImpl *im = (TaskManagerImpl*)t->taskManager;
    struct Queue *q = (Queue *)im->workers[0];
    createCUDAWorker(context,0,q, im);
    pthread_join(thread,0);
    exit(0);
#endif
}

__code code1(struct Time* time) {
    printf("cpus:\t\t%d\n", cpu_num);
    printf("gpus:\t\t%d\n", gpu_num);
    printf("length:\t\t%d\n", length);
    printf("length/task:\t%d\n", length/split);
    /* puts("queue"); */
    /* print_queue(context->data[ActiveQueue]->queue.first); */
    /* puts("tree"); */
    /* print_tree(context->data[Tree]->tree.root); */
    /* puts("result"); */
    time->time = (union Data*)createTimeImpl(context);
    time->next = C_createTask1;
    goto meta(context, time->time->Time.start);
    //goto meta(context, C_createTask1);
    //goto meta(context, C_exit_code);
    //goto meta(context, C_start_time);
}

__code code2(struct LoopCounter* loopCounter) {
    int i = loopCounter->i;

    if (i < length) {
        //printf("%d\n", array_ptr[i]);
        if (array_ptr[i] == (i*2)) {
            loopCounter->i++;
            goto meta(context, C_code2);
        } else
            puts("wrong result");

    }

    goto meta(context, C_exit_code);
}

__code createTask1(struct LoopCounter* loopCounter, struct TaskManager* taskManager, struct Time* time) {
    int i = loopCounter->i;

    if ((length/split*i) < length) {
        goto meta(context, C_createTask2);
    }

    loopCounter->i = 0;
    taskManager->next = time->time->Time.end;
    time->next = C_code2;
#if ( defined(USE_CUDAWorker) && defined(USE_CUDA_MAIN_THREAD))
sleep(5);
#endif
    goto meta(context, taskManager->taskManager->TaskManager.shutdown);
}

__code createTask2(struct LoopCounter* loopCounter, struct TaskManager* taskManager) {
    struct Context** tasks = (struct Context**)ALLOC_ARRAY(context, Context, 1);

    int i = loopCounter->i;
    LoopCounter* loopCounter2 = &ALLOCATE_DATA_GEAR(context, LoopCounter)->LoopCounter;
    Array* array = &ALLOCATE_DATA_GEAR(context, Array)->Array;
    array->index = i;
    array->prefix = length/split;
    array->array = array_ptr;
    array->size = length;
    loopCounter2->i = 0;
    loopCounter->i++;

    // par goto twice(loopCounter2, array, __exit);
    struct Context* task = NEW(struct Context);
    initContext(task);
    task->taskManager = &taskManager->taskManager->TaskManager;
    task->idgCount = 0;
    if (gpu_num) {
#ifdef USE_CUDAWorker
        task->next = C_CUDAtwice;
        task->workerId = CPU_CUDA;
#else
        task->next = C_twice;
#endif
    } else {
        task->next = C_twice;
    }
    task->idg = task->dataNum;
    task->data[task->idg] = (union Data*)loopCounter2;
    task->data[task->idg+1] = (union Data*)array;
    task->maxIdg = task->idg + 2;
    task->odg = task->maxIdg;
    task->maxOdg = task->odg;
    tasks[0] = task;

    taskManager->contexts = tasks;
    // goto crateTask1();
    taskManager->next1 = C_createTask1;
    goto meta(context, taskManager->taskManager->TaskManager.spawnTasks);
}

void init(int argc, char** argv) {
    for (int i = 1; argv[i]; ++i) {
        if (strcmp(argv[i], "-cpu") == 0)
            cpu_num = (int)atoi(argv[i+1]);
        else if (strcmp(argv[i], "-l") == 0)
            length = (int)atoi(argv[i+1]);
        else if (strcmp(argv[i], "-s") == 0)
            split = (int)atoi(argv[i+1]);
        else if (strcmp(argv[i], "-cuda") == 0) {
            gpu_num = 1;
            CPU_CUDA = 0;
        }
    }
}


int main(int argc, char** argv) {
    init(argc, argv);

    array_ptr = NEWN(length, int);

    for(int i=0; i<length; i++)
        array_ptr[i]=i;

    struct Context* main_context = NEW(struct Context);
    initContext(main_context);
    main_context->next = C_initDataGears;

    goto start_code(main_context);
}