nbus/Src/app_dummy.c

#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 0xAB;
}

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; }