Made the timeout for lis2dw_read_fifo a variable
This commit is contained in:
committed by
Alessandro Genova
parent
c6c97556ac
commit
19f789e428
@@ -448,13 +448,13 @@ static void start_reading(accelerometer_data_acquisition_state_t *state) {
|
|||||||
|
|
||||||
state->records[state->pos++] = record;
|
state->records[state->pos++] = record;
|
||||||
lis2dw_fifo_t fifo;
|
lis2dw_fifo_t fifo;
|
||||||
lis2dw_read_fifo(&fifo); // dump the fifo, this starts a fresh round of data in continue_reading
|
lis2dw_read_fifo(&fifo, 100); // dump the fifo, this starts a fresh round of data in continue_reading
|
||||||
}
|
}
|
||||||
|
|
||||||
static void continue_reading(accelerometer_data_acquisition_state_t *state) {
|
static void continue_reading(accelerometer_data_acquisition_state_t *state) {
|
||||||
printf("Continue reading\n");
|
printf("Continue reading\n");
|
||||||
lis2dw_fifo_t fifo;
|
lis2dw_fifo_t fifo;
|
||||||
lis2dw_read_fifo(&fifo);
|
lis2dw_read_fifo(&fifo, 100);
|
||||||
|
|
||||||
fifo.count = min(fifo.count, 25); // hacky, but we need a consistent data rate; if we got a 26th data point, chuck it.
|
fifo.count = min(fifo.count, 25); // hacky, but we need a consistent data rate; if we got a 26th data point, chuck it.
|
||||||
uint8_t offset = 4 * (25 - fifo.count); // also hacky: we're sometimes short at the start. align to beginning of next second.
|
uint8_t offset = 4 * (25 - fifo.count); // also hacky: we're sometimes short at the start. align to beginning of next second.
|
||||||
|
|||||||
@@ -420,7 +420,7 @@ static void _monitor_update(lis2dw_monitor_state_t *state)
|
|||||||
lis2dw_fifo_t fifo;
|
lis2dw_fifo_t fifo;
|
||||||
float x = 0, y = 0, z = 0;
|
float x = 0, y = 0, z = 0;
|
||||||
|
|
||||||
lis2dw_read_fifo(&fifo);
|
lis2dw_read_fifo(&fifo, 25);
|
||||||
if (fifo.count == 0) {
|
if (fifo.count == 0) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -277,15 +277,15 @@ inline void lis2dw_disable_fifo(void) {
|
|||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
#define FIFO_TIMEOUT 102 // This is timeout seconds * 128[RTC_CNT_HZ]. So 800ms is 102
|
bool lis2dw_read_fifo(lis2dw_fifo_t *fifo_data, uint32_t timeout) {
|
||||||
bool lis2dw_read_fifo(lis2dw_fifo_t *fifo_data) {
|
// timeout is in terms of 1/RTC_CNT_HZ seconds (likely 128 timeouts is one second)
|
||||||
#ifdef I2C_SERCOM
|
#ifdef I2C_SERCOM
|
||||||
uint8_t temp = watch_i2c_read8(LIS2DW_ADDRESS, LIS2DW_REG_FIFO_SAMPLE);
|
uint8_t temp = watch_i2c_read8(LIS2DW_ADDRESS, LIS2DW_REG_FIFO_SAMPLE);
|
||||||
bool overrun = !!(temp & LIS2DW_FIFO_SAMPLE_OVERRUN);
|
bool overrun = !!(temp & LIS2DW_FIFO_SAMPLE_OVERRUN);
|
||||||
|
|
||||||
fifo_data->count = temp & LIS2DW_FIFO_SAMPLE_COUNT;
|
fifo_data->count = temp & LIS2DW_FIFO_SAMPLE_COUNT;
|
||||||
|
|
||||||
rtc_counter_t timeout_counter = watch_rtc_get_counter() + FIFO_TIMEOUT;
|
rtc_counter_t timeout_counter = watch_rtc_get_counter() + timeout;
|
||||||
for(int i = 0; i < fifo_data->count; i++) {
|
for(int i = 0; i < fifo_data->count; i++) {
|
||||||
if (watch_rtc_get_counter() > timeout_counter) {
|
if (watch_rtc_get_counter() > timeout_counter) {
|
||||||
break;
|
break;
|
||||||
@@ -296,6 +296,7 @@ bool lis2dw_read_fifo(lis2dw_fifo_t *fifo_data) {
|
|||||||
return overrun;
|
return overrun;
|
||||||
#else
|
#else
|
||||||
(void) fifo_data;
|
(void) fifo_data;
|
||||||
|
(void) timeout;
|
||||||
return false;
|
return false;
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -345,7 +345,7 @@ void lis2dw_enable_fifo(void);
|
|||||||
|
|
||||||
void lis2dw_disable_fifo(void);
|
void lis2dw_disable_fifo(void);
|
||||||
|
|
||||||
bool lis2dw_read_fifo(lis2dw_fifo_t *fifo_data);
|
bool lis2dw_read_fifo(lis2dw_fifo_t *fifo_data, uint32_t timeout);
|
||||||
|
|
||||||
void lis2dw_clear_fifo(void);
|
void lis2dw_clear_fifo(void);
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user