+static void time_to_send(uint _) {
+ /* This runs in interrupt context; don't linger. */
+ event_t e;
+ e.type = RESEND_TIME;
+ queue_try_add_ignoring_errors(&queue, &e);
+}
+
+void set_resend_alarm(int alarm, uint32_t now, uint32_t next_act_time) {
+ uint32_t sleep_duration = next_act_time - now;
+ if (hardware_alarm_set_target(alarm,
+ make_timeout_time_ms(sleep_duration * 1000)))
+ signal_error_by_blinking();
+}
+
+void service_sleeps(int alarm, press_pile_t *pp) {
+ hardware_alarm_cancel(alarm);
+
+ while (1) {
+ uint32_t now = time_s();
+ int32_t act_time = next_scheduled_send(pp);
+ if (act_time == -1)
+ return;
+ if (act_time > now) {
+ set_resend_alarm(alarm, now, act_time);
+ return;
+ }
+ press_t press;
+ if (!get_press_due_for_resend(pp, now, &press))
+ signal_error_by_blinking();
+ u32_t ago = now - press.timestamp;
+ send_report_packet(press.seq, ago);
+ press.send_count++;
+ if (press.send_count < config_resend_count) {
+ add_press(pp, &press);
+ }
+ }
+}
+