#include "press.h"

static uint32_t next_send(press_t *s) {
  return s->timestamp + (1 << s->send_count) - 1;
}

bool next_send_less_than(void *user_data, pheap_node_id_t a,
                         pheap_node_id_t b) {
  press_t *presses = (press_t *)user_data;
  return next_send(&presses[a]) < next_send(&presses[b]);
}

void create_press(press_t *presses, pheap_t *sleeps_heap, uint32_t timestamp,
                  u16_t seq) {
  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. */
    return;
  }
  presses[i].timestamp = timestamp;
  presses[i].seq = seq;
  presses[i].send_count = 0;
  ph_insert_node(sleeps_heap, i);
}

int32_t next_scheduled_send(press_t *presses, pheap_t *sleeps_heap) {
  pheap_node_id_t i = ph_peek_head(sleeps_heap);
  if (i == 0)
    return -1;
  return next_send(&presses[i]);
}