|
|
@ -192,8 +192,8 @@ void BMI088_Accelerometer::RunImpl() |
|
|
|
break; |
|
|
|
break; |
|
|
|
|
|
|
|
|
|
|
|
case STATE::FIFO_READ: { |
|
|
|
case STATE::FIFO_READ: { |
|
|
|
//FIFOReadTest(now);
|
|
|
|
FIFOReadTest(now); |
|
|
|
NormalRead(now); |
|
|
|
//NormalRead(now);
|
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
@ -875,7 +875,7 @@ bool BMI088_Accelerometer::FIFOReadTest(const hrt_abstime ×tamp_sample){ |
|
|
|
// empty
|
|
|
|
// empty
|
|
|
|
return false; |
|
|
|
return false; |
|
|
|
} |
|
|
|
} |
|
|
|
int n_frames_to_read = 5; |
|
|
|
int n_frames_to_read = 6; |
|
|
|
// don't read more than 8 frames at a time
|
|
|
|
// don't read more than 8 frames at a time
|
|
|
|
if (fifo_fill_level > n_frames_to_read*7) { |
|
|
|
if (fifo_fill_level > n_frames_to_read*7) { |
|
|
|
fifo_fill_level = n_frames_to_read*7; |
|
|
|
fifo_fill_level = n_frames_to_read*7; |
|
|
|