/** * @file kernel/misc/ringbuffer.c * @brief Generic ringbuffer with blocking reads and writes. * * Provides a buffer interface for devices such as at PTYs with * blocking reads and writes. * * @copyright * This file is part of ToaruOS and is released under the terms * of the NCSA / University of Illinois License - see LICENSE.md * Copyright (C) 2013-2021 K. Lange */ #include #include #include #include #include #include #include #include #include #include #include size_t ring_buffer_unread(ring_buffer_t * ring_buffer) { if (ring_buffer->read_ptr == ring_buffer->write_ptr) { return 0; } if (ring_buffer->read_ptr > ring_buffer->write_ptr) { return (ring_buffer->size - ring_buffer->read_ptr) + ring_buffer->write_ptr; } else { return (ring_buffer->write_ptr - ring_buffer->read_ptr); } } size_t ring_buffer_size(fs_node_t * node) { ring_buffer_t * ring_buffer = (ring_buffer_t *)node->device; return ring_buffer_unread(ring_buffer); } size_t ring_buffer_available(ring_buffer_t * ring_buffer) { if (ring_buffer->read_ptr == ring_buffer->write_ptr) { return ring_buffer->size - 1; } if (ring_buffer->read_ptr > ring_buffer->write_ptr) { return ring_buffer->read_ptr - ring_buffer->write_ptr - 1; } else { return (ring_buffer->size - ring_buffer->write_ptr) + ring_buffer->read_ptr - 1; } } static inline void ring_buffer_increment_read(ring_buffer_t * ring_buffer) { ring_buffer->read_ptr++; if (ring_buffer->read_ptr == ring_buffer->size) { ring_buffer->read_ptr = 0; } } static inline void ring_buffer_increment_write(ring_buffer_t * ring_buffer) { ring_buffer->write_ptr++; if (ring_buffer->write_ptr == ring_buffer->size) { ring_buffer->write_ptr = 0; } } void ring_buffer_alert_waiters(ring_buffer_t * ring_buffer) { if (ring_buffer->alert_waiters) { while (ring_buffer->alert_waiters->head) { node_t * node = list_dequeue(ring_buffer->alert_waiters); process_t * p = node->value; process_alert_node(p, ring_buffer); free(node); } } } void ring_buffer_select_wait(ring_buffer_t * ring_buffer, void * process) { if (!ring_buffer->alert_waiters) { ring_buffer->alert_waiters = list_create("ringbuffer alerts", ring_buffer); } if (!list_find(ring_buffer->alert_waiters, process)) { list_insert(ring_buffer->alert_waiters, process); } list_insert(((process_t *)process)->node_waits, ring_buffer); } size_t ring_buffer_read(ring_buffer_t * ring_buffer, size_t size, uint8_t * buffer) { size_t collected = 0; while (collected == 0) { spin_lock(ring_buffer->lock); while (ring_buffer_unread(ring_buffer) > 0 && collected < size) { buffer[collected] = ring_buffer->buffer[ring_buffer->read_ptr]; ring_buffer_increment_read(ring_buffer); collected++; } wakeup_queue(ring_buffer->wait_queue_writers); if (collected == 0) { if (ring_buffer->internal_stop || ring_buffer->soft_stop) { ring_buffer->soft_stop = 0; spin_unlock(ring_buffer->lock); return 0; } if (sleep_on_unlocking(ring_buffer->wait_queue_readers, &ring_buffer->lock)) { return -ERESTARTSYS; } } else { spin_unlock(ring_buffer->lock); } } wakeup_queue(ring_buffer->wait_queue_writers); return collected; } size_t ring_buffer_write(ring_buffer_t * ring_buffer, size_t size, uint8_t * buffer) { size_t written = 0; while (written < size) { spin_lock(ring_buffer->lock); while (ring_buffer_available(ring_buffer) > 0 && written < size) { ring_buffer->buffer[ring_buffer->write_ptr] = buffer[written]; ring_buffer_increment_write(ring_buffer); written++; } wakeup_queue(ring_buffer->wait_queue_readers); ring_buffer_alert_waiters(ring_buffer); if (written < size) { if (ring_buffer->discard) { spin_unlock(ring_buffer->lock); break; } if (sleep_on_unlocking(ring_buffer->wait_queue_writers, &ring_buffer->lock)) { if (!written) return -ERESTARTSYS; break; } if (ring_buffer->internal_stop) { break; } } else { spin_unlock(ring_buffer->lock); } } wakeup_queue(ring_buffer->wait_queue_readers); ring_buffer_alert_waiters(ring_buffer); return written; } ring_buffer_t * ring_buffer_create(size_t size) { ring_buffer_t * out = malloc(sizeof(ring_buffer_t)); if (size == 4096) { out->buffer = mmu_map_from_physical(mmu_allocate_a_frame() << 12); } else { out->buffer = malloc(size); } out->write_ptr = 0; out->read_ptr = 0; out->size = size; out->alert_waiters = NULL; spin_init(out->lock); out->internal_stop = 0; out->discard = 0; out->soft_stop = 0; out->wait_queue_readers = list_create("ringbuffer readers",out); out->wait_queue_writers = list_create("ringbuffer writers",out); return out; } void ring_buffer_destroy(ring_buffer_t * ring_buffer) { if (ring_buffer->size == 4096) { mmu_frame_release((uintptr_t)ring_buffer->buffer & 0xFFFFFFFFF); } else { free(ring_buffer->buffer); } wakeup_queue(ring_buffer->wait_queue_writers); wakeup_queue(ring_buffer->wait_queue_readers); ring_buffer_alert_waiters(ring_buffer); list_free(ring_buffer->wait_queue_writers); list_free(ring_buffer->wait_queue_readers); free(ring_buffer->wait_queue_writers); free(ring_buffer->wait_queue_readers); if (ring_buffer->alert_waiters) { list_free(ring_buffer->alert_waiters); free(ring_buffer->alert_waiters); } } void ring_buffer_interrupt(ring_buffer_t * ring_buffer) { ring_buffer->internal_stop = 1; wakeup_queue(ring_buffer->wait_queue_readers); wakeup_queue(ring_buffer->wait_queue_writers); } void ring_buffer_eof(ring_buffer_t * ring_buffer) { ring_buffer->soft_stop = 1; wakeup_queue(ring_buffer->wait_queue_readers); wakeup_queue(ring_buffer->wait_queue_writers); }