|
| 1 | +#include "poll_priv.h" |
| 2 | +#include "queue.h" |
| 3 | + |
| 4 | +#define QUEUE_PARAM_ASSERT(cond) MOD_RET_ASSERT(cond, QUEUE_WRONG_PARAM); |
| 5 | + |
| 6 | +typedef struct _elem { |
| 7 | + void *userptr; |
| 8 | + struct _elem *prev; |
| 9 | +} queue_elem; |
| 10 | + |
| 11 | +struct _queue { |
| 12 | + size_t len; |
| 13 | + queue_dtor dtor; |
| 14 | + queue_elem *head; |
| 15 | + queue_elem *tail; |
| 16 | +}; |
| 17 | + |
| 18 | +struct _queue_itr { |
| 19 | + queue_elem *elem; |
| 20 | +}; |
| 21 | + |
| 22 | +/** Public API **/ |
| 23 | + |
| 24 | +queue_t *queue_new(const queue_dtor fn) { |
| 25 | + queue_t *q = memhook._calloc(1, sizeof(queue_t)); |
| 26 | + if (q) { |
| 27 | + q->dtor = fn; |
| 28 | + } |
| 29 | + return q; |
| 30 | +} |
| 31 | + |
| 32 | +queue_itr_t *queue_itr_new(const queue_t *q) { |
| 33 | + MOD_RET_ASSERT(queue_length(q) > 0, NULL); |
| 34 | + |
| 35 | + queue_itr_t *itr = memhook._malloc(sizeof(queue_itr_t)); |
| 36 | + if (itr) { |
| 37 | + itr->elem = q->head; |
| 38 | + } |
| 39 | + return itr; |
| 40 | +} |
| 41 | + |
| 42 | +queue_itr_t *queue_itr_next(queue_itr_t *itr) { |
| 43 | + MOD_RET_ASSERT(itr, NULL); |
| 44 | + |
| 45 | + itr->elem = itr->elem->prev; |
| 46 | + if (!itr->elem) { |
| 47 | + memhook._free(itr); |
| 48 | + itr = NULL; |
| 49 | + } |
| 50 | + return itr; |
| 51 | +} |
| 52 | + |
| 53 | +void *queue_itr_get_data(const queue_itr_t *itr) { |
| 54 | + MOD_RET_ASSERT(itr, NULL); |
| 55 | + |
| 56 | + return itr->elem->userptr; |
| 57 | +} |
| 58 | + |
| 59 | +queue_ret_code queue_itr_set_data(const queue_itr_t *itr, void *value) { |
| 60 | + QUEUE_PARAM_ASSERT(itr); |
| 61 | + QUEUE_PARAM_ASSERT(value); |
| 62 | + |
| 63 | + itr->elem->userptr = value; |
| 64 | + return QUEUE_OK; |
| 65 | +} |
| 66 | + |
| 67 | +queue_ret_code queue_iterate(const queue_t *q, const queue_cb fn, void *userptr) { |
| 68 | + QUEUE_PARAM_ASSERT(fn); |
| 69 | + MOD_RET_ASSERT(queue_length(q) > 0, QUEUE_MISSING); |
| 70 | + |
| 71 | + queue_elem *elem = q->head; |
| 72 | + while (elem) { |
| 73 | + queue_ret_code rc = fn(userptr, elem->userptr); |
| 74 | + if (rc < QUEUE_OK) { |
| 75 | + /* Stop right now with error */ |
| 76 | + return rc; |
| 77 | + } |
| 78 | + if (rc > QUEUE_OK) { |
| 79 | + /* Stop right now with MAP_OK */ |
| 80 | + return QUEUE_OK; |
| 81 | + } |
| 82 | + elem = elem->prev; |
| 83 | + } |
| 84 | + return QUEUE_OK; |
| 85 | +} |
| 86 | + |
| 87 | +queue_ret_code queue_enqueue(queue_t *q, void *data) { |
| 88 | + QUEUE_PARAM_ASSERT(q); |
| 89 | + QUEUE_PARAM_ASSERT(data); |
| 90 | + |
| 91 | + queue_elem *elem = memhook._calloc(1, sizeof(queue_elem)); |
| 92 | + if (elem) { |
| 93 | + q->len++; |
| 94 | + elem->userptr = data; |
| 95 | + if (q->tail) { |
| 96 | + q->tail->prev = elem; |
| 97 | + } |
| 98 | + q->tail = elem; |
| 99 | + if (!q->head) { |
| 100 | + q->head = q->tail; |
| 101 | + } |
| 102 | + return QUEUE_OK; |
| 103 | + } |
| 104 | + return QUEUE_OMEM; |
| 105 | +} |
| 106 | + |
| 107 | +void *queue_dequeue(queue_t *q) { |
| 108 | + MOD_RET_ASSERT(queue_length(q) > 0, NULL); |
| 109 | + |
| 110 | + queue_elem *elem = q->head; |
| 111 | + if (q->tail == q->head) { |
| 112 | + q->tail = NULL; |
| 113 | + } |
| 114 | + q->head = q->head->prev; |
| 115 | + |
| 116 | + void *data = elem->userptr; |
| 117 | + memhook._free(elem); |
| 118 | + q->len--; |
| 119 | + return data; |
| 120 | +} |
| 121 | + |
| 122 | +void *queue_peek(const queue_t *q) { |
| 123 | + MOD_RET_ASSERT(queue_length(q) > 0, NULL); |
| 124 | + |
| 125 | + return q->head->userptr; |
| 126 | +} |
| 127 | + |
| 128 | +queue_ret_code queue_clear(queue_t *q) { |
| 129 | + QUEUE_PARAM_ASSERT(q); |
| 130 | + |
| 131 | + queue_elem *elem = NULL; |
| 132 | + while ((elem = q->head) && q->len > 0) { |
| 133 | + void *data = queue_dequeue(q); |
| 134 | + if (q->dtor) { |
| 135 | + q->dtor(data); |
| 136 | + } |
| 137 | + } |
| 138 | + return QUEUE_OK; |
| 139 | +} |
| 140 | + |
| 141 | +queue_ret_code queue_free(queue_t *q) { |
| 142 | + queue_ret_code ret = queue_clear(q); |
| 143 | + if (ret == QUEUE_OK) { |
| 144 | + memhook._free(q); |
| 145 | + } |
| 146 | + return ret; |
| 147 | +} |
| 148 | + |
| 149 | +ssize_t queue_length(const queue_t *q) { |
| 150 | + QUEUE_PARAM_ASSERT(q); |
| 151 | + |
| 152 | + return q->len; |
| 153 | +} |
| 154 | + |
0 commit comments