@@ -91,7 +91,7 @@ void IMU_Init(void) {
|
||||
IMU_WriteReg(0x07, 0x00);
|
||||
|
||||
IMU_SetBank(2);
|
||||
IMU_WriteReg(0x01, 0x01); // Bypass (отключаем встроенный фильтр для анализа)
|
||||
IMU_WriteReg(0x01, 0x01); // Bypass (отключили встроенный фильтр для анализа)
|
||||
IMU_SetBank(0);
|
||||
|
||||
// Начальная инициализация ( на 0 Гц dsp_manager сам их включит)
|
||||
@@ -117,8 +117,7 @@ void IMU_ReadRawData(void) {
|
||||
raw_gx = (int16_t)(buf[6] << 8 | buf[7]);
|
||||
float x = (float)raw_gx - gyro_bias_x;
|
||||
|
||||
// Последовательно применяем 3 режекторных фильтра
|
||||
// dsp_manager будет менять их коэффициенты в фоновом режиме
|
||||
// Последовательно применяем 3 режекторных фильтра dsp_manager будет менять их коэффициенты в фоновом режиме
|
||||
x = biquad_apply(¬ch1, x);
|
||||
x = biquad_apply(¬ch2, x);
|
||||
x = biquad_apply(¬ch3, x);
|
||||
|
||||
Reference in New Issue
Block a user