-static void wait_forever() {
- /* pico-examples/gpio/hello_gpio_irq/hello_gpio_irq.c implements wait-forever
- * as "while (1);", but
- * https://www.raspberrypi.com/documentation/pico-sdk/high_level.html#gaf469c6d691230e9d1008
- * says sleeping uses less power, so we sleep. */
+void service_sleeps(int alarm, send_t *sleeping_sends, pheap_t *sleeps_heap) {
+ hardware_alarm_cancel(alarm);
+
+ while (1) {
+ uint32_t now = time_s();
+ int32_t act_time = next_scheduled_send(sleeping_sends, sleeps_heap);
+ if (act_time == -1)
+ return;
+ if (act_time > now) {
+ set_send_alarm(alarm, now, act_time);
+ return;
+ }
+ 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_packet(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);
+ }
+}
+
+void service_queue() {
+ int alarm = hardware_alarm_claim_unused(true);
+ if (alarm == -1)
+ signal_error_by_blinking();
+ hardware_alarm_set_callback(alarm, time_to_send);
+
+ send_t sleeping_sends[PICO_PHEAP_MAX_ENTRIES];
+ pheap_t *sleeps_heap =
+ ph_create(PICO_PHEAP_MAX_ENTRIES, next_send_less_than, sleeping_sends);
+ u16_t seq = 0;