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


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

uint8_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, uint8_t value){
	return param;
}