M include/mgba-util/circle-buffer.h → include/mgba-util/circle-buffer.h

@@ -29,6 +29,7 @@ int CircleBufferWrite32(struct CircleBuffer* buffer, int32_t value);
 int CircleBufferRead8(struct CircleBuffer* buffer, int8_t* value);
 int CircleBufferRead16(struct CircleBuffer* buffer, int16_t* value);
 int CircleBufferRead32(struct CircleBuffer* buffer, int32_t* value);
+size_t CircleBufferWrite(struct CircleBuffer* buffer, const void* input, size_t length);
 size_t CircleBufferRead(struct CircleBuffer* buffer, void* output, size_t length);
 size_t CircleBufferDump(const struct CircleBuffer* buffer, void* output, size_t length);
 

M src/util/circle-buffer.c → src/util/circle-buffer.c

@@ -205,6 +205,34 @@ #endif
 	return 4;
 }
 
+size_t CircleBufferWrite(struct CircleBuffer* buffer, const void* input, size_t length) {
+	int8_t* data = buffer->writePtr;
+	if (buffer->size + length > buffer->capacity) {
+		return 0;
+	}
+	size_t remaining = buffer->capacity - ((int8_t*) data - (int8_t*) buffer->data);
+	if (length <= remaining) {
+		memcpy(data, input, length);
+		if (length == remaining) {
+			buffer->writePtr = buffer->data;
+		} else {
+			buffer->writePtr = (int8_t*) data + length;
+		}
+	} else {
+		memcpy(data, input, remaining);
+		memcpy(buffer->data, (int8_t*) input + remaining, length - remaining);
+		buffer->writePtr = (int8_t*) buffer->data + length - remaining;
+	}
+
+	buffer->size += length;
+#ifndef NDEBUG
+	if (!_checkIntegrity(buffer)) {
+		abort();
+	}
+#endif
+	return length;
+}
+
 size_t CircleBufferRead(struct CircleBuffer* buffer, void* output, size_t length) {
 	int8_t* data = buffer->readPtr;
 	if (buffer->size == 0) {