while (1) {
uint32_t now = time_s();
- pheap_node_id_t i = ph_peek_head(sleeps_heap);
- if (i == 0)
+ int32_t act_time = next_scheduled_send(sleeping_sends, sleeps_heap);
+ if (act_time == -1)
return;
- send_t *send = &sleeping_sends[i];
- if (next_send(send) > now) {
- uint32_t sleep_duration = next_send(send) - now;
+ if (act_time > now) {
+ uint32_t sleep_duration = act_time - now;
if (hardware_alarm_set_target(
alarm, make_timeout_time_ms(sleep_duration * 1000)))
signal_error_by_blinking();
return;
}
- if (ph_remove_head(sleeps_heap, false) != i)
- signal_error_by_blinking();
+ pheap_node_id_t i = ph_remove_head(sleeps_heap, false);
+ send_t *send = &sleeping_sends[i];
uint32_t ago = now - send->timestamp;
send_report(send->seq, ago);
send->send_count++;