#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include <basic-geometry.h>

#ifdef _WIN64
#include <windows.h>
#else
#include <time.h>
#endif // _WINDOWS_

typedef struct {
//    fp32_versor_t versor1, versor2, result;
    fp32_matrix3x3_t matrix;
    fp32_vector3_t vector1, vector2;
} fp32_structure_t;

fp32_structure_t* allocate_structures(const unsigned int amount)
{
    return calloc(amount, sizeof(fp32_structure_t));
}

fp32_structure_t* make_structures(const unsigned int amount)
{
    fp32_structure_t* list = allocate_structures(amount);

    if (list == 0) {
        return 0;
    }

    const float multiplier = 2.0f / RAND_MAX;

    for (unsigned int i = 0; i < amount; i++) {
    /*
        fp32_versor_set_values(
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            &list[i].versor1
        );

        fp32_versor_set_values(
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            &list[i].versor2
        );

        fp32_versor_reset(&list[i].result);
*/
        fp32_matrix3x3_set_to_identity(&list[i].matrix);

        fp32_vector3_set_values(
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            &list[i].vector1
        );

        fp32_vector3_reset(&list[i].vector2);
    }

    return list;
}

void print_versor(const fp32_versor_t* versor)
{
    printf("Versor (%f, %f, %f, %f)\n", versor->s0, versor->x1, versor->x2, versor->x3);
}

void print_vector(const fp32_vector3_t* vector)
{
    printf("(%f, %f, %f) / %f\n", vector->x1,  vector->x2,  vector->x3,  fp32_vector3_get_modulus(vector));
}

void item_work(fp32_structure_t* item)
{
    //fp32_versor_combine(&item->versor1, &item->versor1, &item->result);
    //fp32_versor_make_rotation_matrix(&item->result, &item->matrix);
    fp32_matrix3x3_right_product(&item->matrix, &item->vector1, &item->vector2);
}

void circle_work(const unsigned int amount, fp32_structure_t* list)
{
    for (unsigned int i = 0; i < amount; i++) {
        //fp32_versor_combine(&list[i].versor1, &list[i].versor1, &list[i].result);
        //fp32_versor_make_rotation_matrix(&list[i].result, &list[i].matrix);
        fp32_matrix3x3_right_product(&list[i].matrix, &list[i].vector1, &list[i].vector2);
        //fp32_versor_turn(&list[i].result, &list[i].vector1, &list[i].vector2);
    }
}

int main()
{
    const unsigned int amount = 1000000;
    fp32_structure_t* list;

#ifdef _WIN64
    ULONGLONG now, start, end;
    now = GetTickCount64();
    srand((unsigned int)(now & 0xfffffff));
#else
    struct timespec start, end;
    clock_gettime(0, &start);
    srand((unsigned int)(start.tv_nsec & 0xfffffff));
#endif // _WIN64

    list = make_structures(amount);

#ifdef _WIN64
    end = GetTickCount64();
    printf("Setup time: %lld\n", end - now);

    start = GetTickCount64();
#else
    clock_gettime(CLOCK_REALTIME, &end);
    printf("Time: %lf\n", (end.tv_sec - start.tv_sec) * 1000.0 + (end.tv_nsec - start.tv_nsec) * 0.000001);

    clock_gettime(CLOCK_REALTIME, &start);
#endif // _WIN64

    for (int j = 0; j < 1000; j++) {
        //circle(amount, list);
        for (unsigned int i = 0; i < amount; i++) {
            //item_work(list + i);
            //fp32_versor_combine(&list[i].versor1, &list[i].versor1, &list[i].result);
            //fp32_versor_make_rotation_matrix(&list[i].result, &list[i].matrix);
            fp32_matrix3x3_right_product(&list[i].matrix, &list[i].vector1, &list[i].vector2);
            //fp32_versor_turn(&list[i].result, &list[i].vector1, &list[i].vector2);
        }
    }

#ifdef _WIN64
    end = GetTickCount64();

    printf("Time: %lld\n", end - start);
#else
    clock_gettime(CLOCK_REALTIME, &end);

    printf("Time: %lf\n", (end.tv_sec - start.tv_sec) * 1000.0 + (end.tv_nsec - start.tv_nsec) * 0.000001);
#endif // _WIN64

    //print_versor(&list[10].versor1);
    //print_versor(&list[10].versor2);
    //print_versor(&list[10].result);

    free(list);

    return 0;
}

/*
fp32_vector3_t* allocate_vectors3(const unsigned int amount)
{
    return calloc(amount, sizeof(fp32_vector3_t));
}

fp32_vector3_t* make_zero_vectors3(const unsigned int amount)
{
    fp32_vector3_t* list = allocate_vectors3(amount);

    if (list == 0) {
        return 0;
    }

    for (unsigned int i = 0; i < amount; i++) {
        fp32_vector3_reset(&list[i]);
    }

    return list;
}

fp32_vector3_t* make_random_vectors3(const unsigned int amount)
{
    fp32_vector3_t* list = allocate_vectors3(amount);

    if (list == 0) {
        return 0;
    }

    const float multiplier = 2.0f / RAND_MAX;

    for (unsigned int i = 0; i < amount; i++) {
        list[i].x1 = rand() * multiplier - 1.0f;
        list[i].x2 = rand() * multiplier - 1.0f;
        list[i].x3 = rand() * multiplier - 1.0f;
    }

    return list;
}

fp32_versor_t* allocate_versors(const unsigned int amount)
{
    return calloc(amount, sizeof(fp32_versor_t));
}

fp32_versor_t * make_zero_versors(const unsigned int amount)
{
    fp32_versor_t * list = allocate_versors(amount);

    if (list == 0) {
        return 0;
    }

    for (unsigned int i = 0; i < amount; i++) {
        fp32_versor_reset(&list[i]);
    }

    return list;
}

fp32_versor_t * make_random_versors(const unsigned int amount)
{
    fp32_versor_t * list = allocate_versors(amount);

    if (list == 0) {
        return 0;
    }

    const float multiplier = 2.0f / RAND_MAX;

    for (unsigned int i = 0; i < amount; i++) {
        fp32_versor_set_values(
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            rand() * multiplier - 1.0f,
            &list[i]
        );
    }

    return list;
}

int main()
{
    const unsigned int amount = 1000000;

#ifdef _WIN64
    ULONGLONG now, start, end;
    now = GetTickCount64();
    srand((unsigned int)(now & 0xfffffff));
#else
    struct timespec now, start, end;
    clock_gettime(0, &now);
    srand((unsigned int)(now.tv_nsec & 0xfffffff));
#endif // _WIN64

    fp32_versor_t * versors1 = make_random_versors(amount);

    if (versors1 == 0) {
        printf("Cannot allocate memory for versors1");
        return 0;
    }

    fp32_versor_t * versors2 = make_random_versors(amount);

    if (versors2 == 0) {
        printf("Cannot allocate memory for versors2");
        free(versors1);
        return 0;
    }

    fp32_versor_t * results = make_zero_versors(amount);

    if (results == 0) {
        printf("Cannot allocate memory for results");
        free(versors2);
        free(versors1);
        return 0;
    }

    fp32_matrix3x3_t* matrixes =malloc(amount * sizeof(fp32_matrix3x3_t));

    if (matrixes == 0) {
        printf("Cannot allocate memory for matrixes");
        free(results);
        free(versors2);
        free(versors1);
        return 0;
    }

    fp32_vector3_t* vectors = make_random_vectors3(amount);

    if (results == 0) {
        printf("Cannot allocate memory for result vectors");
        free(matrixes);
        free(results);
        free(versors2);
        free(versors1);
        return 0;
    }

#ifdef _WIN64
    end = GetTickCount64();
    printf("Setup time: %lld\n", end - now);

    start = GetTickCount64();
#else
    clock_gettime(CLOCK_REALTIME, &end);
    printf("Time: %lf\n", (end.tv_sec - now.tv_sec) * 1000.0 + (end.tv_nsec - now.tv_nsec) * 0.000001);

    clock_gettime(CLOCK_REALTIME, &start);
#endif // _WIN64
    for (int j = 0; j < 1000; j++) {
        for (unsigned int i = 0; i < amount; i++) {
            fp32_versor_combine(&versors1[i], &versors2[i], &results[i]);
            fp32_versor_make_rotation_matrix(&versors1[i], &matrixes[i]);
            fp32_matrix3x3_right_product(&matrixes[i], &vectors[i], &vectors[i]);
            //fp32_versor_turn(&results[i], &vectors[i], &vectors[i]);
        }
    }

#ifdef _WIN64
    end = GetTickCount64();

    printf("Time: %lld\n", end - start);
#else
    clock_gettime(CLOCK_REALTIME, &end);

    printf("Time: %lf\n", (end.tv_sec - start.tv_sec) * 1000.0 + (end.tv_nsec - start.tv_nsec) * 0.000001);
#endif // _WIN64

    print_versor(versors1 + 10);
    print_versor(versors2 + 10);
    print_versor(results + 10);

    free(vectors);
    free(matrixes);
    free(results);
    free(versors2);
    free(versors1);
    return 0;
}
*/