|
@@ -0,0 +1,329 @@
|
|
|
+/*
|
|
|
+ * Copyright (c) 2023 Lain Bailey <[email protected]>
|
|
|
+ *
|
|
|
+ * Permission to use, copy, modify, and distribute this software for any
|
|
|
+ * purpose with or without fee is hereby granted, provided that the above
|
|
|
+ * copyright notice and this permission notice appear in all copies.
|
|
|
+ *
|
|
|
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
|
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
|
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
|
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
|
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
|
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
|
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
|
+ */
|
|
|
+
|
|
|
+#pragma once
|
|
|
+
|
|
|
+#include "c99defs.h"
|
|
|
+#include <string.h>
|
|
|
+#include <stdlib.h>
|
|
|
+#include <assert.h>
|
|
|
+
|
|
|
+#include "bmem.h"
|
|
|
+
|
|
|
+#ifdef __cplusplus
|
|
|
+extern "C" {
|
|
|
+#endif
|
|
|
+
|
|
|
+/* Double-ended Queue */
|
|
|
+
|
|
|
+struct deque {
|
|
|
+ void *data;
|
|
|
+ size_t size;
|
|
|
+
|
|
|
+ size_t start_pos;
|
|
|
+ size_t end_pos;
|
|
|
+ size_t capacity;
|
|
|
+};
|
|
|
+
|
|
|
+static inline void deque_init(struct deque *dq)
|
|
|
+{
|
|
|
+ memset(dq, 0, sizeof(struct deque));
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_free(struct deque *dq)
|
|
|
+{
|
|
|
+ bfree(dq->data);
|
|
|
+ memset(dq, 0, sizeof(struct deque));
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_reorder_data(struct deque *dq, size_t new_capacity)
|
|
|
+{
|
|
|
+ size_t difference;
|
|
|
+ uint8_t *data;
|
|
|
+
|
|
|
+ if (!dq->size || !dq->start_pos || dq->end_pos > dq->start_pos)
|
|
|
+ return;
|
|
|
+
|
|
|
+ difference = new_capacity - dq->capacity;
|
|
|
+ data = (uint8_t *)dq->data + dq->start_pos;
|
|
|
+ memmove(data + difference, data, dq->capacity - dq->start_pos);
|
|
|
+ dq->start_pos += difference;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_ensure_capacity(struct deque *dq)
|
|
|
+{
|
|
|
+ size_t new_capacity;
|
|
|
+ if (dq->size <= dq->capacity)
|
|
|
+ return;
|
|
|
+
|
|
|
+ new_capacity = dq->capacity * 2;
|
|
|
+ if (dq->size > new_capacity)
|
|
|
+ new_capacity = dq->size;
|
|
|
+
|
|
|
+ dq->data = brealloc(dq->data, new_capacity);
|
|
|
+ deque_reorder_data(dq, new_capacity);
|
|
|
+ dq->capacity = new_capacity;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_reserve(struct deque *dq, size_t capacity)
|
|
|
+{
|
|
|
+ if (capacity <= dq->capacity)
|
|
|
+ return;
|
|
|
+
|
|
|
+ dq->data = brealloc(dq->data, capacity);
|
|
|
+ deque_reorder_data(dq, capacity);
|
|
|
+ dq->capacity = capacity;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_upsize(struct deque *dq, size_t size)
|
|
|
+{
|
|
|
+ size_t add_size = size - dq->size;
|
|
|
+ size_t new_end_pos = dq->end_pos + add_size;
|
|
|
+
|
|
|
+ if (size <= dq->size)
|
|
|
+ return;
|
|
|
+
|
|
|
+ dq->size = size;
|
|
|
+ deque_ensure_capacity(dq);
|
|
|
+
|
|
|
+ if (new_end_pos > dq->capacity) {
|
|
|
+ size_t back_size = dq->capacity - dq->end_pos;
|
|
|
+ size_t loop_size = add_size - back_size;
|
|
|
+
|
|
|
+ if (back_size)
|
|
|
+ memset((uint8_t *)dq->data + dq->end_pos, 0, back_size);
|
|
|
+
|
|
|
+ memset(dq->data, 0, loop_size);
|
|
|
+ new_end_pos -= dq->capacity;
|
|
|
+ } else {
|
|
|
+ memset((uint8_t *)dq->data + dq->end_pos, 0, add_size);
|
|
|
+ }
|
|
|
+
|
|
|
+ dq->end_pos = new_end_pos;
|
|
|
+}
|
|
|
+
|
|
|
+/** Overwrites data at a specific point in the buffer (relative). */
|
|
|
+static inline void deque_place(struct deque *dq, size_t position,
|
|
|
+ const void *data, size_t size)
|
|
|
+{
|
|
|
+ size_t end_point = position + size;
|
|
|
+ size_t data_end_pos;
|
|
|
+
|
|
|
+ if (end_point > dq->size)
|
|
|
+ deque_upsize(dq, end_point);
|
|
|
+
|
|
|
+ position += dq->start_pos;
|
|
|
+ if (position >= dq->capacity)
|
|
|
+ position -= dq->capacity;
|
|
|
+
|
|
|
+ data_end_pos = position + size;
|
|
|
+ if (data_end_pos > dq->capacity) {
|
|
|
+ size_t back_size = data_end_pos - dq->capacity;
|
|
|
+ size_t loop_size = size - back_size;
|
|
|
+
|
|
|
+ memcpy((uint8_t *)dq->data + position, data, loop_size);
|
|
|
+ memcpy(dq->data, (uint8_t *)data + loop_size, back_size);
|
|
|
+ } else {
|
|
|
+ memcpy((uint8_t *)dq->data + position, data, size);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_push_back(struct deque *dq, const void *data,
|
|
|
+ size_t size)
|
|
|
+{
|
|
|
+ size_t new_end_pos = dq->end_pos + size;
|
|
|
+
|
|
|
+ dq->size += size;
|
|
|
+ deque_ensure_capacity(dq);
|
|
|
+
|
|
|
+ if (new_end_pos > dq->capacity) {
|
|
|
+ size_t back_size = dq->capacity - dq->end_pos;
|
|
|
+ size_t loop_size = size - back_size;
|
|
|
+
|
|
|
+ if (back_size)
|
|
|
+ memcpy((uint8_t *)dq->data + dq->end_pos, data,
|
|
|
+ back_size);
|
|
|
+ memcpy(dq->data, (uint8_t *)data + back_size, loop_size);
|
|
|
+
|
|
|
+ new_end_pos -= dq->capacity;
|
|
|
+ } else {
|
|
|
+ memcpy((uint8_t *)dq->data + dq->end_pos, data, size);
|
|
|
+ }
|
|
|
+
|
|
|
+ dq->end_pos = new_end_pos;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_push_front(struct deque *dq, const void *data,
|
|
|
+ size_t size)
|
|
|
+{
|
|
|
+ dq->size += size;
|
|
|
+ deque_ensure_capacity(dq);
|
|
|
+
|
|
|
+ if (dq->size == size) {
|
|
|
+ dq->start_pos = 0;
|
|
|
+ dq->end_pos = size;
|
|
|
+ memcpy((uint8_t *)dq->data, data, size);
|
|
|
+
|
|
|
+ } else if (dq->start_pos < size) {
|
|
|
+ size_t back_size = size - dq->start_pos;
|
|
|
+
|
|
|
+ if (dq->start_pos)
|
|
|
+ memcpy(dq->data, (uint8_t *)data + back_size,
|
|
|
+ dq->start_pos);
|
|
|
+
|
|
|
+ dq->start_pos = dq->capacity - back_size;
|
|
|
+ memcpy((uint8_t *)dq->data + dq->start_pos, data, back_size);
|
|
|
+ } else {
|
|
|
+ dq->start_pos -= size;
|
|
|
+ memcpy((uint8_t *)dq->data + dq->start_pos, data, size);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_push_back_zero(struct deque *dq, size_t size)
|
|
|
+{
|
|
|
+ size_t new_end_pos = dq->end_pos + size;
|
|
|
+
|
|
|
+ dq->size += size;
|
|
|
+ deque_ensure_capacity(dq);
|
|
|
+
|
|
|
+ if (new_end_pos > dq->capacity) {
|
|
|
+ size_t back_size = dq->capacity - dq->end_pos;
|
|
|
+ size_t loop_size = size - back_size;
|
|
|
+
|
|
|
+ if (back_size)
|
|
|
+ memset((uint8_t *)dq->data + dq->end_pos, 0, back_size);
|
|
|
+ memset(dq->data, 0, loop_size);
|
|
|
+
|
|
|
+ new_end_pos -= dq->capacity;
|
|
|
+ } else {
|
|
|
+ memset((uint8_t *)dq->data + dq->end_pos, 0, size);
|
|
|
+ }
|
|
|
+
|
|
|
+ dq->end_pos = new_end_pos;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_push_front_zero(struct deque *dq, size_t size)
|
|
|
+{
|
|
|
+ dq->size += size;
|
|
|
+ deque_ensure_capacity(dq);
|
|
|
+
|
|
|
+ if (dq->size == size) {
|
|
|
+ dq->start_pos = 0;
|
|
|
+ dq->end_pos = size;
|
|
|
+ memset((uint8_t *)dq->data, 0, size);
|
|
|
+
|
|
|
+ } else if (dq->start_pos < size) {
|
|
|
+ size_t back_size = size - dq->start_pos;
|
|
|
+
|
|
|
+ if (dq->start_pos)
|
|
|
+ memset(dq->data, 0, dq->start_pos);
|
|
|
+
|
|
|
+ dq->start_pos = dq->capacity - back_size;
|
|
|
+ memset((uint8_t *)dq->data + dq->start_pos, 0, back_size);
|
|
|
+ } else {
|
|
|
+ dq->start_pos -= size;
|
|
|
+ memset((uint8_t *)dq->data + dq->start_pos, 0, size);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_peek_front(struct deque *dq, void *data, size_t size)
|
|
|
+{
|
|
|
+ assert(size <= dq->size);
|
|
|
+
|
|
|
+ if (data) {
|
|
|
+ size_t start_size = dq->capacity - dq->start_pos;
|
|
|
+
|
|
|
+ if (start_size < size) {
|
|
|
+ memcpy(data, (uint8_t *)dq->data + dq->start_pos,
|
|
|
+ start_size);
|
|
|
+ memcpy((uint8_t *)data + start_size, dq->data,
|
|
|
+ size - start_size);
|
|
|
+ } else {
|
|
|
+ memcpy(data, (uint8_t *)dq->data + dq->start_pos, size);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_peek_back(struct deque *dq, void *data, size_t size)
|
|
|
+{
|
|
|
+ assert(size <= dq->size);
|
|
|
+
|
|
|
+ if (data) {
|
|
|
+ size_t back_size = (dq->end_pos ? dq->end_pos : dq->capacity);
|
|
|
+
|
|
|
+ if (back_size < size) {
|
|
|
+ size_t front_size = size - back_size;
|
|
|
+ size_t new_end_pos = dq->capacity - front_size;
|
|
|
+
|
|
|
+ memcpy((uint8_t *)data + (size - back_size), dq->data,
|
|
|
+ back_size);
|
|
|
+ memcpy(data, (uint8_t *)dq->data + new_end_pos,
|
|
|
+ front_size);
|
|
|
+ } else {
|
|
|
+ memcpy(data, (uint8_t *)dq->data + dq->end_pos - size,
|
|
|
+ size);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_pop_front(struct deque *dq, void *data, size_t size)
|
|
|
+{
|
|
|
+ deque_peek_front(dq, data, size);
|
|
|
+
|
|
|
+ dq->size -= size;
|
|
|
+ if (!dq->size) {
|
|
|
+ dq->start_pos = dq->end_pos = 0;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ dq->start_pos += size;
|
|
|
+ if (dq->start_pos >= dq->capacity)
|
|
|
+ dq->start_pos -= dq->capacity;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void deque_pop_back(struct deque *dq, void *data, size_t size)
|
|
|
+{
|
|
|
+ deque_peek_back(dq, data, size);
|
|
|
+
|
|
|
+ dq->size -= size;
|
|
|
+ if (!dq->size) {
|
|
|
+ dq->start_pos = dq->end_pos = 0;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (dq->end_pos <= size)
|
|
|
+ dq->end_pos = dq->capacity - (size - dq->end_pos);
|
|
|
+ else
|
|
|
+ dq->end_pos -= size;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void *deque_data(struct deque *dq, size_t idx)
|
|
|
+{
|
|
|
+ uint8_t *ptr = (uint8_t *)dq->data;
|
|
|
+ size_t offset = dq->start_pos + idx;
|
|
|
+
|
|
|
+ if (idx >= dq->size)
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ if (offset >= dq->capacity)
|
|
|
+ offset -= dq->capacity;
|
|
|
+
|
|
|
+ return ptr + offset;
|
|
|
+}
|
|
|
+
|
|
|
+#ifdef __cplusplus
|
|
|
+}
|
|
|
+#endif
|