+ while (1) {
+ uint32_t now = time_s();
+ pheap_node_id_t i = ph_peek_head(sleeps_heap);
+ if (i == 0)
+ return;
+ send_t *send = &sleeping_sends[i];
+ if (next_send(send) > now) {
+ uint32_t sleep_duration = next_send(send) - 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();
+ uint32_t ago = now - send->timestamp;
+ send_report(send->seq, ago);
+ send->send_count++;
+ if (send->send_count < config_resend_count)
+ ph_insert_node(sleeps_heap, i);
+ else
+ ph_free_node(sleeps_heap, i);
+ }
+}