Demo fro training
Dependencies: X_NUCLEO_IKS01A1 d7a_1x mbed-rtos mbed wizzi-utils
files.cpp
- Committer:
- mikl_andre
- Date:
- 2016-11-21
- Revision:
- 0:429446fe396d
File content as of revision 0:429446fe396d:
#include "files.h"
#include "dbg.h"
#include "sensors.h"
GENERIC_FILE_INIT(dev_rev,
.rev.manufacturer_id = 0x01BC50C7,
/// Device ID: Arbitrary number, at user/customer choice
.rev.device_id = 0x00000010,
/// Hardware Board ID:
.rev.hw_version = 0x00000152,
/// Firmware Version: made of
/// - major,minor and patch indexes
/// - fw_id : "build-flavour"
/// FW_ID | MAJOR | MINOR | PATCH | HASH |
// 1B | 1B | 1B | 2B | 4B |
#if _SENSORS_SIMU_
.rev.fw_version.id = 1,
#else
.rev.fw_version.id = 0,
#endif
.rev.fw_version.major = 1,
.rev.fw_version.minor = 0,
.rev.fw_version.patch = 0,
.rev.fw_version.hash = 0x00000000,
/// "file-system" signature
.rev.fs_crc = 0x00000000,
);
GENERIC_FILE_INIT(simul,
.divider = 500, // Boot value
);
GENERIC_FILE_INIT(mag_cfg,
.cfg.report_type = REPORT_ON_DIFFERENCE,
.cfg.period = 1000,
.cfg.max_period = 300,
.cfg.max_diff = 100,
.cfg.threshold_high = 1000,
.cfg.threshold_low = -1000,
);
GENERIC_FILE_INIT(acc_cfg,
.cfg.report_type = REPORT_ON_DIFFERENCE,
.cfg.period = 1000,
.cfg.max_period = 300,
.cfg.max_diff = 100,
.cfg.threshold_high = 500,
.cfg.threshold_low = -500,
);
GENERIC_FILE_INIT(gyr_cfg,
.cfg.report_type = REPORT_ON_DIFFERENCE,
.cfg.period = 1000,
.cfg.max_period = 300,
.cfg.max_diff = 1000,
.cfg.threshold_high = 10000,
.cfg.threshold_low = -10000,
);
GENERIC_FILE_INIT(pre_cfg,
.cfg.report_type = REPORT_ON_DIFFERENCE,
.cfg.period = 1000,
.cfg.max_period = 60,
.cfg.max_diff = 100,
.cfg.threshold_high = 120000,
.cfg.threshold_low = 90000,
);
GENERIC_FILE_INIT(hum_cfg,
.cfg.report_type = REPORT_ON_DIFFERENCE,
.cfg.period = 1000,
.cfg.max_period = 60,
.cfg.max_diff = 100,
.cfg.threshold_high = 7000,
.cfg.threshold_low = 3000,
);
GENERIC_FILE_INIT(tem1_cfg,
.cfg.report_type = REPORT_ON_DIFFERENCE,
.cfg.period = 1000,
.cfg.max_period = 60,
.cfg.max_diff = 100,
.cfg.threshold_high = 3500,
.cfg.threshold_low = 2000,
);
GENERIC_FILE_INIT(tem2_cfg,
.cfg.report_type = REPORT_ON_DIFFERENCE,
.cfg.period = 1000,
.cfg.max_period = 60,
.cfg.max_diff = 100,
.cfg.threshold_high = 9000,
.cfg.threshold_low = 7000,
);
#define FILE_QTY 8
static const void* file_map[FILE_QTY][2] = {
GENERIC_FILE_MAP(MAG_CFG_FILE_ID, mag_cfg),
GENERIC_FILE_MAP(ACC_CFG_FILE_ID, acc_cfg),
GENERIC_FILE_MAP(GYR_CFG_FILE_ID, gyr_cfg),
GENERIC_FILE_MAP(PRE_CFG_FILE_ID, pre_cfg),
GENERIC_FILE_MAP(HUM_CFG_FILE_ID, hum_cfg),
GENERIC_FILE_MAP(TEM1_CFG_FILE_ID, tem1_cfg),
GENERIC_FILE_MAP(TEM2_CFG_FILE_ID, tem2_cfg),
GENERIC_FILE_MAP(SIMUL_FILE_ID, simul),
};
void* file_get( uint8_t file_id )
{
for (uint8_t i=0 ; i<FILE_QTY ; i++)
{
if ((uint8_t)file_map[i][0] == file_id)
{
return (void*)file_map[i][1];
}
}
ASSERT(false, "File %d does not exist\r\n");
return NULL;
}
uint32_t fs_write_file(const uint8_t file_id,
const uint16_t offset,
const uint16_t size,
const uint8_t* const content)
{
uint32_t file = 0;
DPRINT("WF %d\r\n", file_id);
// Retrieve pointer to file
file = (uint32_t)file_get(file_id);
if (!file)
{
return 0;
}
// Write the new data
memcpy((void*)(file+offset), (void*)content, size);
return size;
}
uint32_t fs_read_file( const uint8_t file_id,
const uint16_t offset,
const uint16_t size,
uint8_t* buf)
{
uint32_t file = 0;
DPRINT("RF %d\r\n", file_id);
// Retrieve pointer to file
file = (uint32_t)file_get(file_id);
if (!file)
{
return 0;
}
// Read data
memcpy((void*)buf, (void*)(file+offset), size);
return size;
}