- char _;
- queue_remove_blocking(&queue, &_);
- seq++;
- for (int i = 0; i < resend_count; i++) {
- send_report(seq, i);
- signal(i == 0 ? 2 : 1, 100);
- sleep_ms(resend_interval_ms);
+ 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();