X-Git-Url: http://git.scottworley.com/tattlekey/blobdiff_plain/2dcbb2a0df003ac8a644c9111c3b7b7f2db42aaa..17461dece177a2ca6e34a0cc7412b2352a1e8053:/client/tattlekey.c

diff --git a/client/tattlekey.c b/client/tattlekey.c
index 48db1b7..14eb7b9 100644
--- a/client/tattlekey.c
+++ b/client/tattlekey.c
@@ -9,7 +9,7 @@
 #include "net.h"
 #include "sends.h"
 
-enum event_type { BUTTONPRESS, SEND };
+enum event_type { NEW_BUTTON_PRESS, RESEND_TIME };
 typedef struct {
   enum event_type type;
   union {
@@ -42,7 +42,7 @@ static void button_pressed() {
   if (time_since_last_press >= config_minimum_seconds_between_button_presses) {
     last_button_press_time = now;
     event_t e;
-    e.type = BUTTONPRESS;
+    e.type = NEW_BUTTON_PRESS;
     e.buttonpress.timestamp = now;
     queue_try_add_ignoring_errors(&queue, &e);
   }
@@ -51,32 +51,36 @@ static void button_pressed() {
 static void time_to_send(uint _) {
   /* This runs in interrupt context; don't linger.  */
   event_t e;
-  e.type = SEND;
+  e.type = RESEND_TIME;
   queue_try_add_ignoring_errors(&queue, &e);
 }
 
-void service_sleeps(int alarm, send_t *sleeping_sends, pheap_t *sleeps_heap) {
+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();
+  return;
+}
+
+void service_sleeps(int alarm, press_t *presses, 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(presses, 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_resend_alarm(alarm, now, act_time);
       return;
     }
-    if (ph_remove_head(sleeps_heap, false) != i)
-      signal_error_by_blinking();
-    uint32_t ago = now - send->timestamp;
-    send_report(send->seq, ago);
-    send->send_count++;
-    if (send->send_count < config_resend_count)
+    pheap_node_id_t i = ph_remove_head(sleeps_heap, false);
+    press_t *press = &presses[i];
+    uint32_t ago = now - press->timestamp;
+    send_report_packet(press->seq, ago);
+    press->send_count++;
+    if (press->send_count < config_resend_count)
       ph_insert_node(sleeps_heap, i);
     else
       ph_free_node(sleeps_heap, i);
@@ -89,29 +93,20 @@ void service_queue() {
     signal_error_by_blinking();
   hardware_alarm_set_callback(alarm, time_to_send);
 
-  send_t sleeping_sends[PICO_PHEAP_MAX_ENTRIES];
+  press_t presses[PICO_PHEAP_MAX_ENTRIES];
   pheap_t *sleeps_heap =
-      ph_create(PICO_PHEAP_MAX_ENTRIES, next_send_less_than, sleeping_sends);
+      ph_create(PICO_PHEAP_MAX_ENTRIES, next_send_less_than, presses);
   u16_t seq = 0;
   while (1) {
-    service_sleeps(alarm, sleeping_sends, sleeps_heap);
+    service_sleeps(alarm, presses, sleeps_heap);
 
     event_t e;
     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);
+    case NEW_BUTTON_PRESS: {
+      create_press(presses, sleeps_heap, e.buttonpress.timestamp, seq++);
     } break;
-    case SEND: {
+    case RESEND_TIME: {
       /* OK, we're awake. Cool. Thanks! (We actually do the sends in the
        * service_sleeps() call at the top of the loop.)  */
     } break;