#include "macstorage.h"
#include "log.h"
#include "tc.h"

#include <stdint.h>
#include <pthread.h>
#include <time.h>
#include <string.h>
#include <unistd.h>

static uint8_t stop;

#define MAXENTRIES 30

struct Entry
{
    uint8_t mac[6];
    time_t timestamp;
    uint8_t prio;
} storage[MAXENTRIES];

uint8_t usedPrio[MAXENTRIES];

size_t count = 0;

pthread_mutex_t mux;

uint8_t _getNextFreePrio()
{
    for (size_t i=0; i<MAXENTRIES; i++)
    {
        if (usedPrio[i] == 0)
        {
            usedPrio[i] = 1;
            return i;
        }
    }
    return 255;
}

void _freePrio(uint8_t prio)
{
    usedPrio[prio] = 0;
}

void _addEntry(uint8_t mac[6])
{
    for (size_t i=0; i<count; i++)
    {
        if (memcmp(storage[i].mac, mac, 6) == 0)
        {
            storage[i].timestamp = time(NULL);
            return;
        }
    }

    if (count != MAXENTRIES)
    {
        log_debug("[m] new entry: %02x:%02x:%02x:%02x:%02x:%02x.\n",
              mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);

        uint8_t prio = _getNextFreePrio();
        memcpy(storage[count].mac, mac, 6);
        storage[count].timestamp = time(NULL);
        storage[count].prio = prio;
        count++;

        tc_allow_mac(mac, prio+1);
    }
}

void macStorage_add(uint8_t mac[6])
{
    pthread_mutex_lock(&mux);
    _addEntry(mac);
    pthread_mutex_unlock(&mux);
}

void _checkTimeout()
{
    pthread_mutex_lock(&mux);

    time_t t = time(NULL)-5;

    for (size_t i=0; i<count; i++)
    {
        if (storage[i].timestamp < t)
        {
            log_debug("[m] %02x:%02x:%02x:%02x:%02x:%02x timed out, removing.\n",
                  storage[i].mac[0], storage[i].mac[1], storage[i].mac[2],
                  storage[i].mac[3], storage[i].mac[4], storage[i].mac[5]);

            tc_disallow_mac(storage[i].mac, storage[i].prio+1);
            _freePrio(storage[i].prio);
            count--;
            memcpy(storage[i].mac, storage[count].mac, 6);
            storage[i].timestamp = storage[count].timestamp;
            i--;
        }
    }

    pthread_mutex_unlock(&mux);
}

void macStorage_stop()
{
    log_debug("[m] Stopping Storage\n");
    stop = 1;
}

void macStorage_run()
{
    stop = 0;

    for (size_t i=0; i<MAXENTRIES; i++)
    {
        usedPrio[i] = 0;
    }

    while (!stop)
    {
        _checkTimeout();
        for (size_t i=0; i<5; i++)
        {
            if (!stop)
            {
                usleep(1 * 1000 * 1000);
            }
        }
    }

    log_debug("[m] Storage closed\n");
    return;
}