Co-authored-by: Copilot <copilot@github.com>
This commit is contained in:
vadyschka01
2026-05-27 16:10:40 +03:00
parent 29749c6212
commit babc5a24e3
12 changed files with 1436 additions and 230 deletions
+2 -3
View File
@@ -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(&notch1, x);
x = biquad_apply(&notch2, x);
x = biquad_apply(&notch3, x);