#include "app_dummy.h"
#include <stdint.h>

nBusAppInterface_t dummy_driver = {
    dummy_init,     dummy_reset,    dummy_getType, dummy_getSensorCount, dummy_getData, dummy_setData, dummy_hasParam,
    dummy_getParam, dummy_setParam, dummy_start,   dummy_stop,           dummy_read,    dummy_store,
};

nBusAppInterface_t *getDummyDriver()
{
    return &dummy_driver;
}

void dummy_init(void *hw_interface, void *hw_config)
{
}

void dummy_reset()
{
}

nBus_sensorType_t dummy_getType(uint8_t sensor_index)
{

    if (sensor_index > dummy_getSensorCount())
        return TYPE_UNKNOWN;

    switch (sensor_index)
    {
    case 1:
        return TYPE_ACCELEROMETER;
    case 2:
        return TYPE_GYROSCOPE;
    case 3:
        return TYPE_MAGNETOMETER;
    case 4:
        return TYPE_HEART_RATE;
    case 5:
        return TYPE_PRESSURE;
    }
    return TYPE_UNKNOWN;
}

uint8_t dummy_getSensorCount()
{
    return 4;
}

uint32_t dummy_data[4] = {0x12345678, 0x9ABCDEF0, 0x87654321, 0x0FEDCBA9};

uint8_t dummy_getData(uint8_t sensor_index, uint8_t *data)
{
    for (uint8_t i = 0; i < 4; ++i)
    {
        data[i] = ((uint8_t *)&dummy_data)[i + (sensor_index - 1) * 8];
        data[4 + i] = ((uint8_t *)&dummy_data)[4 + i + (sensor_index - 1) * 8];
    }

    return 8;
}

uint8_t dummy_setData(uint8_t *data)
{
    return 1;
}

int32_t dummy_getParam(uint8_t sensor_index, nBus_param_t param)
{
    return 0xABCD4567;
}

uint8_t dummy_hasParam(uint8_t sensor_index, nBus_param_t param)
{
    if (sensor_index < dummy_getSensorCount())
        return 1;
    return 0;
}

nBus_param_t dummy_setParam(uint8_t sensor_index, nBus_param_t param, int32_t value)
{
    return param;
}

void dummy_start(void)
{
    return;
}

void dummy_stop(void)
{
    return;
}

void dummy_read(void)
{
    return;
}

uint8_t dummy_store(void)
{
    return 0;
}