#include "dispatch.h" static unsigned position(const Queue *queue, unsigned ordinal) { return (queue->head + ordinal) % QUEUE_CAPACITY; } void queue_init(Queue *queue) { queue->head = 0; queue->count = 0; } int queue_push(Queue *queue, Message message) { unsigned tail; if (queue->count == QUEUE_CAPACITY) { return -2; } tail = position(queue, queue->count); queue->slots[tail] = message; queue->count += 1; return 0; } const Message *queue_front(const Queue *queue) { if (queue->count == 0) { return NULL; } return &queue->slots[queue->head]; } const Message *queue_at(const Queue *queue, unsigned ordinal) { if (ordinal >= queue->count) { return NULL; } return &queue->slots[position(queue, ordinal)]; } int queue_pop(Queue *queue) { if (queue->count == 0) { return -2; } queue->head = position(queue, 1); queue->count -= 1; return 0; } unsigned queue_age(Queue *queue) { unsigned original = queue->count; unsigned removed = 0; unsigned read_index; unsigned write_index = 0; for (read_index = 0; read_index < original; ++read_index) { Message message = queue->slots[position(queue, read_index)]; message.lease -= 1; if (message.lease == 0) { removed += 1; } else { queue->slots[position(queue, write_index)] = message; write_index += 1; } } queue->count = write_index; return removed; } unsigned queue_clear(Queue *queue) { unsigned removed = queue->count; queue_init(queue); return removed; } unsigned queue_remove_id(Queue *queue, int id) { unsigned original = queue->count; unsigned read_index; unsigned write_index = 0; unsigned removed = 0; for (read_index = 0; read_index < original; ++read_index) { Message message = queue->slots[position(queue, read_index)]; if (message.id == id) { removed += 1; } else { queue->slots[position(queue, write_index)] = message; write_index += 1; } } queue->count = write_index; return removed; } int queue_transfer(Queue *source, Queue *target, unsigned count) { unsigned index; unsigned target_count; if (source == target || count > source->count) { return -4; } if (target->count + count > QUEUE_CAPACITY) { return -2; } target_count = target->count; for (index = 0; index < count; ++index) { unsigned from = position(source, index); unsigned to = position(target, target_count + index); target->slots[to] = source->slots[from]; } target->count += count; source->head = position(source, count); source->count -= count; return 0; }