- char zero = '\0';
- /* We don't check for failure (full queue) here because there's not much to
- * be done about it. */
- queue_try_add(&queue, &zero);
+ event_t e;
+ e.type = BUTTONPRESS;
+ e.buttonpress.timestamp = now;
+ queue_try_add_ignoring_errors(&queue, &e);
+ }
+}
+
+void service_queue() {
+ u16_t seq = 0;
+ while (1) {
+ event_t e;
+ queue_remove_blocking(&queue, &e);
+ switch (e.type) {
+ case BUTTONPRESS: {
+ event_t send_e;
+ send_e.type = SEND;
+ send_e.send.timestamp = e.buttonpress.timestamp;
+ send_e.send.seq = seq++;
+ send_e.send.send_count = 0;
+ queue_try_add_ignoring_errors(&queue, &send_e);
+ } break;
+ case SEND: {
+ uint32_t now = time_s();
+ uint32_t ago = now - e.send.timestamp;
+ send_report(e.send.seq, ago);
+ e.send.send_count++;
+ if (e.send.send_count < config_resend_count)
+ queue_try_add_ignoring_errors(&queue, &e);
+ /* TODO: Sleep elsewhere. */
+ signal(e.send.send_count == 1 ? 2 : 1, 100);
+ sleep_ms(config_resend_interval_ms);
+ } break;
+ default:
+ signal_error_by_blinking();
+ }