#include "sends.h"
-uint32_t next_send(send_t *s) {
+static uint32_t next_send(send_t *s) {
return s->timestamp + (1 << s->send_count) - 1;
}
sleeping_sends[i].send_count = 0;
ph_insert_node(sleeps_heap, i);
}
+
+int32_t next_scheduled_send(send_t *sleeping_sends, pheap_t *sleeps_heap) {
+ pheap_node_id_t i = ph_peek_head(sleeps_heap);
+ if (i == 0)
+ return -1;
+ return next_send(&sleeping_sends[i]);
+}
u8_t send_count;
} send_t;
-uint32_t next_send(send_t *s);
-
bool next_send_less_than(void *user_data, pheap_node_id_t a, pheap_node_id_t b);
void create_send(send_t *sleeping_sends, pheap_t *sleeps_heap,
uint32_t timestamp, u16_t seq);
+/* When do we next need to send something (in seconds since boot)?
+ * Returns -1 if there's nothing pending. */
+int32_t next_scheduled_send(send_t *sleeping_sends, pheap_t *sleeps_heap);
+
#endif
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 (act_time > now) {
+ uint32_t sleep_duration = act_time - now;
if (hardware_alarm_set_target(
alarm, make_timeout_time_ms(sleep_duration * 1000)))
signal_error_by_blinking();
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->send_count++;