diff --git a/esp32/src/ActuatorStateService.h b/esp32/src/ActuatorStateService.h index 48bf84e..39ad5c9 100644 --- a/esp32/src/ActuatorStateService.h +++ b/esp32/src/ActuatorStateService.h @@ -110,9 +110,12 @@ class ActuatorStateService : public StatefulService { { TickType_t xLastWakeTime; xLastWakeTime = xTaskGetTickCount(); + int dir = 2; while (1) { - _state.angles[1] = (_state.angles[1] + 5) % 90; + _state.angles[1] += dir; + if (_state.angles[1] >= 90) dir = -1; + if (_state.angles[1] <= 0) dir = 1; StaticJsonDocument doc; String message; JsonArray array = doc.createNestedArray("angles");