diff --git a/firmware/firmware.ino b/firmware/firmware.ino index 4faf8be..2bdbfd5 100644 --- a/firmware/firmware.ino +++ b/firmware/firmware.ino @@ -334,6 +334,7 @@ void _loop() // Disable expensive tasks sensors[SENSOR_WINDSPEED] = 0; //debug("read of wind sensor because of low battery disabled"); + } else { sensors[SENSOR_WINDSPEED] = &wind_speed; //debug("read of wind sensor because of high battery enabled"); @@ -364,12 +365,16 @@ void _loop() { sensor_cnt++; fsm_state = FSM_STATE_US; // jump to same state again, more sensors to read + } else { + update_sensor_cnt = millis(); sensor_cnt = 0; fsm_state = FSM_STATE_SC; // next state } + } else { + debug("skip read sensor data"); fsm_state = FSM_STATE_WU; // no new data, reset FSM }