#include <stdlib.h>
#include <stdint.h>

#include "encoding.h"
#include "platform.h"

#include "eos.h"
#include "msgq.h"
#include "event.h"

#include "board.h"

#include "soc/interrupt.h"
#include "soc/spi.h"
#include "soc/spi_priv.h"

#include "net.h"
#include "egpio.h"

#include "spi.h"
#include "spi_cfg.h"

#ifdef EOS_DEBUG
#include <stdio.h>
#endif

static unsigned char spi_dstack[EOS_SPI_MAX_DSTACK];
static unsigned char spi_dstack_len;
static uint16_t spi_div[EOS_SPI_MAX_DEV];

static uint8_t spi_dev(void) {
    return spi_dstack_len ? spi_dstack[spi_dstack_len - 1] : EOS_SPI_DEV_NET;
}

static void spi_stop(unsigned char dev) {
    if (dev == EOS_SPI_DEV_NET) {
        eos_net_stop();
    } else if (spi_cfg[dev].flags & SPI_DEV_FLAG_9BIT) {
        eos_spi_enable();
    } else {
        eos_spi_stop();
    }
}

static void spi_start(unsigned char dev) {
    if (dev == EOS_SPI_DEV_NET) {
        eos_net_start();
    } else if (spi_cfg[dev].flags & SPI_DEV_FLAG_9BIT) {
        eos_spi_configure(spi_div[dev], spi_cfg[dev].csid, spi_cfg[dev].cspin, spi_cfg[dev].evt);
        eos_spi_disable();
    } else {
        eos_spi_start(spi_div[dev], spi_cfg[dev].csid, spi_cfg[dev].cspin, spi_cfg[dev].evt);
    }
}

int eos_spi_dev_init(void) {
    int i;

    for (i=0; i<EOS_SPI_MAX_DEV; i++) {
        spi_div[i] = spi_cfg[i].div;
    }

    for (i=0; i<EOS_SPI_MAX_DSTACK; i++) {
        spi_dstack[i] = 0xff;
    }

    return EOS_OK;
}

int eos_spi_select(unsigned char dev) {
    int rv;
    int dsel;

    if (eos_spi_cs_get()) rv = EOS_ERR_BUSY;
    if (!rv && (spi_dstack_len == EOS_SPI_MAX_DSTACK)) rv = EOS_ERR_FULL;

    if (rv) {
#ifdef EOS_DEBUG
        printf("SPI SELECT DEV:%d ERR:%d\n", dev, rv);
#endif
        return rv;
    }

    dsel = 1;
    if (spi_dev() == dev) {
        dev |= EOS_SPI_DEV_FLAG_NDSEL;
        dsel = 0;
    }

    if (dsel) spi_stop(spi_dev());

    spi_dstack[spi_dstack_len] = dev;
    spi_dstack_len++;

    if (dsel) spi_start(dev);

    return EOS_OK;
}

void eos_spi_deselect(void) {
    int rv;
    int dsel;

    if (eos_spi_cs_get()) rv = EOS_ERR_BUSY;
    if (!rv && (spi_dstack_len == 0)) rv = EOS_ERR_EMPTY;

    if (rv) {
#ifdef EOS_DEBUG
        printf("SPI DESELECT ERR:%d\n", rv);
#endif
        return;
    }

    dsel = !(spi_dev() & EOS_SPI_DEV_FLAG_NDSEL);
    if (dsel) spi_stop(spi_dev());

    spi_dstack_len--;
    spi_dstack[spi_dstack_len] = 0xff;

    if (dsel) spi_start(spi_dev());
}

void eos_spi_dev_configure(unsigned char dev) {
    eos_spi_configure(spi_div[dev], spi_cfg[dev].csid, spi_cfg[dev].cspin, spi_cfg[dev].evt);
}

uint8_t eos_spi_dev(void) {
    return spi_dev();
}

uint16_t eos_spi_div(unsigned char dev) {
    return spi_div[dev];
}

uint8_t eos_spi_csid(unsigned char dev) {
    return spi_cfg[dev].csid;
}

uint8_t eos_spi_cspin(unsigned char dev) {
    return spi_cfg[dev].cspin;
}

void eos_spi_set_div(unsigned char dev, uint16_t div) {
    spi_div[dev] = div;
}