#include "ringbuffer.h"
#include <string.h>

void *get_ptr(RingBufferT T, struct RingBufferHead *head, size_t i)
{
    u8 *bytes = (u8 *)head;
    return bytes + T->OFFSET + T->SIZE * i;
}

size_t RingBufferEmpty(RingBufferT T, struct RingBufferHead *head)
{
    return T->LEN - head->len;
}

void *RingBufferGet(RingBufferT T, struct RingBufferHead *head, size_t i)
{
    size_t wrap_i = (head->start + i) % T->LEN;
    return get_ptr(T, head, wrap_i);
}

void *RingBufferNext(RingBufferT T, struct RingBufferHead *head)
{
    size_t wrap_i = (head->start + head->len) % T->LEN;
    return get_ptr(T, head, wrap_i);
}

void RingBufferAdd(RingBufferT T, struct RingBufferHead *dest, void *item)
{
    memcpy(RingBufferNext(T, dest), item, T->SIZE);
    dest->len += 1;
}

void RingBufferTransfer(
    RingBufferT T,
    struct RingBufferHead *dest,
    struct RingBufferHead *tmp
) {
    size_t copy_max = min_size(T->LEN - dest->len, tmp->len);

    for (size_t i = 0; i < copy_max; i++) {
        void *to = RingBufferGet(T, dest, dest->len + i);
        void *from = RingBufferGet(T, tmp, i);
        memcpy(to, from, T->SIZE);
    }

    dest->len += copy_max;
    tmp->len -= copy_max;
}

size_t RingBufferOut(
    RingBufferT T,
    size_t n,
    void *dest,
    struct RingBufferHead *src
) {
    size_t copy_max = min_size(n, src->len);

    for (size_t i = 0; i < copy_max; i++) {
        void *to = (u8 *)dest + i * T->SIZE;
        void *from = RingBufferGet(T, src, i);
        memcpy(to, from, T->SIZE);
    }

    src->len -= copy_max;

    return copy_max;
}