queue_try_add_ignoring_errors(&queue, &e);
}
+void set_send_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();
+ return;
+}
+
void service_sleeps(int alarm, send_t *sleeping_sends, pheap_t *sleeps_heap) {
hardware_alarm_cancel(alarm);
while (1) {
uint32_t now = time_s();
- pheap_node_id_t i = ph_peek_head(sleeps_heap);
- if (i == 0)
+ int32_t act_time = next_scheduled_send(sleeping_sends, sleeps_heap);
+ if (act_time == -1)
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();
+ if (act_time > now) {
+ set_send_alarm(alarm, now, act_time);
return;
}
- if (ph_remove_head(sleeps_heap, false) != i)
- signal_error_by_blinking();
+ 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(send->seq, ago);
+ send_report_packet(send->seq, ago);
send->send_count++;
if (send->send_count < config_resend_count)
ph_insert_node(sleeps_heap, i);
queue_remove_blocking(&queue, &e);
switch (e.type) {
case BUTTONPRESS: {
- pheap_node_id_t i = ph_new_node(sleeps_heap);
- if (i == 0) {
- /* TODO: Don't drop new presses just because sleeps_heap is full of old
- * presses. */
- break;
- }
- sleeping_sends[i].timestamp = e.buttonpress.timestamp;
- sleeping_sends[i].seq = seq++;
- sleeping_sends[i].send_count = 0;
- ph_insert_node(sleeps_heap, i);
+ create_send(sleeping_sends, sleeps_heap, e.buttonpress.timestamp, seq++);
} break;
case SEND: {
/* OK, we're awake. Cool. Thanks! (We actually do the sends in the