diff --git a/esp32/src/main.cpp b/esp32/src/main.cpp index b8a9ba8..65740c7 100644 --- a/esp32/src/main.cpp +++ b/esp32/src/main.cpp @@ -4,12 +4,13 @@ DRAM_ATTR Spot spot; void IRAM_ATTR SpotControlLoopEntry(void*) { TickType_t xLastWakeTime = xTaskGetTickCount(); + const TickType_t xFrequency = 10 / portTICK_PERIOD_MS; for (;;) { spot.readSensors(); spot.planMotion(); spot.updateActuators(); spot.emitTelemetry(); - vTaskDelayUntil(&xLastWakeTime, 10 / portTICK_PERIOD_MS); + vTaskDelayUntil(&xLastWakeTime, xFrequency); } }