#include "arena.h"
#include <stdbool.h>
#include <stddef.h>
#include <stdint.h>
#include <stdlib.h>
#include <string.h>

ArenaResult arena_init(size_t capacity) {
    if (capacity < 1) {
        ArenaResult err = {
            .is_valid = false,
            .err = ARENA_INVALID_SIZE,
        };
        return err;
    }

    void *buffer = malloc(capacity);
    if (buffer == NULL) {
        ArenaResult err = {
            .is_valid = false,
            .err = ARENA_BAD_ALLOC,
        };
        return err;
    }

    Arena new_arena = {
        .buffer = buffer,
        .capacity = capacity,
        .offset = 0,
    };
    ArenaResult val = {
        .is_valid = true,
        .arena = new_arena,
    };

    return val;
}

void arena_destroy(Arena *arena) {
    free(arena->buffer);
    arena->buffer = NULL;
    arena->offset = 0;
    arena->capacity = 0;
}

ArenaPointer arena_alloc(Arena *arena, size_t size, size_t alignment) {
    if (arena == NULL) {
        ArenaPointer err = {
            .is_valid = false,
            .err = ARENA_NULL_ARG,
        };
        return err;
    }

    SizeResult padding = get_arena_align_padding(arena, alignment);
    if (!padding.is_valid) {
        ArenaPointer err = {
            .is_valid = false,
            .err = padding.err,
        };
        return err;
    }


    if (arena->offset + padding.val >= arena->capacity) {
        ArenaPointer err = {
            .is_valid = false,
            .err = ARENA_OUT_OF_SPACE,
        };
        return err;
    }

    if (arena->offset > SIZE_MAX - padding.val - size) {
        ArenaPointer err = {
            .is_valid = false,
            .err = ARENA_CAPACITY_OVERFLOW,
        };
        return err;
    }

    size_t aligned_offset = arena->offset + padding.val;

    arena->offset = aligned_offset + size;
    ArenaPointer val = {
        .is_valid = true,
        .address = arena->buffer + aligned_offset,
    };
    return val;
}

ArenaErr arena_ensure_capacity(Arena *arena, size_t size, size_t alignment) {
    if (arena == NULL) {
        return ARENA_NULL_ARG;
    }

    SizeResult padding = get_arena_align_padding(arena, alignment);
    if (!padding.is_valid) {
        return padding.err;
    }
    while (true) {
        if (arena->offset > SIZE_MAX - padding.val - size) {
            return ARENA_CAPACITY_OVERFLOW;
        }

        size_t required = arena->offset + padding.val + size;

        if (required <= arena->capacity) {
            return ARENA_OK;
        }

        size_t new_capacity;
        if (mul_size_t_safe(arena->capacity, 2, &new_capacity)) {
            return ARENA_CAPACITY_OVERFLOW;
        }

        ArenaErr err = arena_realloc(arena, new_capacity);
        if (err != ARENA_OK) {
            return err;
        }
    }
}

ArenaPointer arena_push(Arena *arena, void *data, size_t size, size_t alignment) {
    if (arena == NULL || data == NULL) {
        ArenaPointer bad_pointer = {
            .is_valid = false,
            .err = ARENA_NULL_ARG,
        };
        return bad_pointer;
    }

    ArenaErr err = arena_ensure_capacity(arena, size, alignment);
    if (err != ARENA_OK) {
        ArenaPointer bad_pointer = {
            .is_valid = false,
            .err = err,
        };
        return bad_pointer;
    }

    ArenaPointer pointer = arena_alloc(arena, size, alignment);
    if (!pointer.is_valid) {
        return pointer;
    }
    
    memcpy(
        pointer.address,
        data,
        size);

    return pointer;
}

ArenaErr arena_realloc(Arena *arena, size_t new_capacity) {
    if (arena == NULL) {
        return ARENA_NULL_ARG;
    }

    uint8_t *tmp = realloc(arena->buffer, new_capacity);
    if (tmp == NULL) {
        return ARENA_BAD_ALLOC;
    }

    arena->buffer = tmp;
    arena->capacity = new_capacity;
    return ARENA_OK;
}

SizeResult get_arena_align_padding(Arena *arena, size_t alignment) {
    if (arena == NULL) {
        SizeResult err = {
            .is_valid = false,
            .err = ARENA_NULL_ARG,
        };
        return err;
    }

    if (alignment < 1) {
        SizeResult err = {
            .is_valid = false,
            .err = ARENA_INVALID_ALIGN,
        };
        return err;
    }

    uintptr_t current_address = (uintptr_t) (arena->buffer + arena->offset);
    uintptr_t aligned = ((current_address + (alignment - 1)) & ~(alignment - 1));
    SizeResult val = {
        .is_valid = true,
        .val = aligned - current_address,
    };
    return val;
}

bool mul_size_t_safe(size_t a, size_t b, size_t *out) {
    if (out == NULL) {
        return true;
    }

    if (a != 0 && b > SIZE_MAX / a) {
        return true;
    }

    *out = a * b;
    return false;
}