🐛 Fix imu and magnotometer

2025-11-27 20:51:54 +01:00
parent d43e98d06b
commit f78a0f50bd
3 changed files with 58 additions and 38 deletions
@@ -132,12 +132,6 @@ void IRAM_ATTR SpotControlLoopEntry(void *) {
 #if FT_ENABLED(USE_WS2812)
        ledService.loop();
 #endif
-        EXECUTE_EVERY_N_MS(250, {
-            JsonDocument doc;
-            JsonVariant results = doc.to<JsonVariant>();
-            peripherals.getIMUResult(results);
-            socket.emit(EVENT_IMU, results);
-        });
        vTaskDelayUntil(&xLastWakeTime, xFrequency);
    }
 }
@@ -164,6 +158,12 @@ void IRAM_ATTR serviceLoopEntry(void *) {
        wifiService.loop();
        apService.loop();
        EXECUTE_EVERY_N_MS(2000, system_service::emitMetrics(socket));
+        EXECUTE_EVERY_N_MS(500, {
+            JsonDocument doc;
+            JsonVariant results = doc.to<JsonVariant>();
+            peripherals.getIMUResult(results);
+            socket.emit(EVENT_IMU, results);
+        });

        vTaskDelay(100 / portTICK_PERIOD_MS);
    }