/* gpio_sim.c  D.J.Whale  04/04/2016
 * 
 * A very simple interface to a simulated GPIO port with minimal platform dependencies.
 */

/***** INCLUDES *****/

#include "system.h"
#include "gpio.h"
#include "trace.h"


/***** CONFIGURATION *****/

#define GPIO_MAX      20
#define GPIO_DEBUG
//#define GPIO_LOOPBACK




/***** VARIABLES *****/

static uint8_t gpio_out[GPIO_MAX] = {0};
static uint8_t gpio_in[GPIO_MAX]  = {0};


void gpio_init()
{
  // Nothing to do
}


void gpio_setin(uint8_t g)
{
#if defined(GPIO_DEBUG)
    //printf("gpio:in:%d\n", g);
    TRACE_OUTS("gpio:in:");
    TRACE_OUTN(g);
    TRACE_NL();
#endif
}


void gpio_setout(uint8_t g)
{
#if defined(GPIO_DEBUG)
    //printf("gpio:out:%d\n", g);
    TRACE_OUTS("gpio:out:");
    TRACE_OUTN(g);
    TRACE_NL();
#endif
}


void gpio_high(uint8_t g)
{
#if defined(GPIO_DEBUG)
    //printf("gpio:high:%d\n", g);
    TRACE_OUTS("gpio:high:");
    TRACE_OUTN(g);
    TRACE_NL();
#endif

    gpio_out[g] = 1;

#if defined(GPIO_LOOPBACK)
    gpio_in[g] = 1;
#endif
}


void gpio_low(uint8_t g)
{
#if defined(GPIO_DEBUG)
    //printf("gpio:low:%d\n", g);
    TRACE_OUTS("gpio:low:");
    TRACE_OUTN(g);
    TRACE_NL();
#endif

    gpio_out[g] = 0;

#if defined(GPIO_LOOPBACK)
    gpio_in[g] = 0;
#endif
}


void gpio_write(uint8_t g, uint8_t v)
{
#if defined(GPIO_DEBUG)
    //printf("gpio:write:%d=%d\n", g, v);
    TRACE_OUTS("gpio:write:");
    TRACE_OUTN(g);
    TRACE_OUTC('=');
    TRACE_OUTN(v);
    TRACE_NL();
#endif

    gpio_out[g] = v;

#if defined(GPIO_LOOPBACK)
    gpio_in[g] = v;
#endif
}


uint8_t gpio_read(uint8_t g)
{
#if defined(GPIO_DEBUG)
    //printf("gpio:read:%d=%d\n")
    TRACE_OUTS("gpio:read:");
    TRACE_OUTN(g);
    TRACE_OUTC('=');
    TRACE_OUTN(gpio_in[g]);
    TRACE_NL();
#endif
    return gpio_in[g];
}


void gpio_finished(void)
{
    // Nothing to do
}


void gpio_mock_set_in(uint8_t g, uint8_t v)
{
    gpio_in[g] = v;
}


uint8_t gpio_mock_get_out(uint8_t g)
{
    return gpio_out[g];
}


/***** END OF FILE *****/