-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;
+static void *xcalloc(size_t nmemb, size_t size) {
+ void *p = calloc(nmemb, size);
+ if (p == NULL)
+ signal_error_by_blinking();
+ return p;
+}
+
+press_pile_t *create_press_pile() {
+ press_pile_t *pp = (press_pile_t *)xcalloc(1, sizeof(press_pile_t));
+ pp->presses = (queue_t *)xcalloc(config_resend_count, sizeof(queue_t));
+ pp->sleeps = (queue_t **)xcalloc(config_resend_count, sizeof(queue_t *));
+ for (uint i = 0; i < config_resend_count; i++) {
+ const uint paranoid_safety_fudge = 10;
+ uint element_count = paranoid_safety_fudge + (1 << i);
+ element_count = MAX(element_count, config_minimum_queue_size);
+ element_count = MIN(element_count, config_maximum_queue_size);
+ queue_init(&pp->presses[i], sizeof(press_t), element_count);