]>
Commit | Line | Data |
---|---|---|
1 | #include "press.h" | |
2 | #include "blink.h" | |
3 | ||
4 | static uint32_t next_send(press_t *s) { | |
5 | return s->timestamp + (1 << s->send_count) - 1; | |
6 | } | |
7 | ||
8 | static bool next_send_less_than(void *user_data, pheap_node_id_t a, | |
9 | pheap_node_id_t b) { | |
10 | press_t *presses = (press_t *)user_data; | |
11 | return next_send(&presses[a]) < next_send(&presses[b]); | |
12 | } | |
13 | ||
14 | press_pile_t *create_press_pile() { | |
15 | press_pile_t *pp = (press_pile_t *)malloc(sizeof(press_pile_t)); | |
16 | if (pp == NULL) | |
17 | signal_error_by_blinking(); | |
18 | pp->presses = calloc(PICO_PHEAP_MAX_ENTRIES, sizeof(press_t)); | |
19 | if (pp->presses == NULL) | |
20 | signal_error_by_blinking(); | |
21 | pp->sleeps_heap = | |
22 | ph_create(PICO_PHEAP_MAX_ENTRIES, next_send_less_than, pp->presses); | |
23 | if (pp->sleeps_heap == NULL) | |
24 | signal_error_by_blinking(); | |
25 | return pp; | |
26 | } | |
27 | ||
28 | void create_press(press_pile_t *pp, uint32_t timestamp, u16_t seq) { | |
29 | pheap_node_id_t i = ph_new_node(pp->sleeps_heap); | |
30 | if (i == 0) { | |
31 | /* TODO: Don't drop new presses just because sleeps_heap is full of old | |
32 | * presses. */ | |
33 | return; | |
34 | } | |
35 | pp->presses[i].timestamp = timestamp; | |
36 | pp->presses[i].seq = seq; | |
37 | pp->presses[i].send_count = 0; | |
38 | ph_insert_node(pp->sleeps_heap, i); | |
39 | } | |
40 | ||
41 | int32_t next_scheduled_send(press_pile_t *pp) { | |
42 | pheap_node_id_t i = ph_peek_head(pp->sleeps_heap); | |
43 | if (i == 0) | |
44 | return -1; | |
45 | return next_send(&pp->presses[i]); | |
46 | } |