USB4VC/firmware/ibmpc/Src/helpers.c

#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include "helpers.h"
#include "shared.h"

void kb_buf_reset(kb_buf *lb)
{
  lb->head = 0;
  lb->tail = 0;
  memset(lb->keycode_buf, 0, KEYBOARD_EVENT_BUFFER_SIZE);
  memset(lb->keyvalue_buf, 0, KEYBOARD_EVENT_BUFFER_SIZE);
}

uint8_t kb_buf_is_full(kb_buf *lb)
{
	return lb->tail == (lb->head + 1) % KEYBOARD_EVENT_BUFFER_SIZE;
}

uint8_t kb_buf_is_empty(kb_buf *lb)
{
	return lb->tail == lb->head;
}

// ring buffer magic!
// I completely forgot how it works
uint8_t kb_buf_add(kb_buf *lb, uint8_t code, uint8_t value)
{
	if(kb_buf_is_full(lb))
		return 1;
	lb->keycode_buf[lb->head] = code;
	lb->keyvalue_buf[lb->head] = value;
	lb->head = (lb->head + 1) % KEYBOARD_EVENT_BUFFER_SIZE;
	return 0;
}

uint8_t kb_buf_peek(kb_buf *lb, uint8_t* code, uint8_t* value)
{
	if(kb_buf_is_empty(lb))
		return 1;
	*code = lb->keycode_buf[lb->tail];
	*value = lb->keyvalue_buf[lb->tail];
	return 0;
}

void kb_buf_pop(kb_buf *lb)
{
	if(!kb_buf_is_empty(lb))
		lb->tail = (lb->tail + 1) % KEYBOARD_EVENT_BUFFER_SIZE;
}

void kb_buf_init(kb_buf *lb)
{
  lb->keycode_buf = malloc(KEYBOARD_EVENT_BUFFER_SIZE);
  lb->keyvalue_buf = malloc(KEYBOARD_EVENT_BUFFER_SIZE);
  kb_buf_reset(lb);
}

// ----------------------------

uint8_t mouse_buf_is_full(mouse_buf *lb)
{
	return lb->tail == (lb->head + 1) % MOUSE_EVENT_BUFFER_SIZE;
}

uint8_t mouse_buf_is_empty(mouse_buf *lb)
{
	return lb->tail == lb->head;
}

uint8_t mouse_buf_add(mouse_buf *lb, mouse_event* event)
{
	if(mouse_buf_is_full(lb))
		return 1;
	memcpy(&lb->mouse_events[lb->head], event, sizeof(mouse_event));
	lb->head = (lb->head + 1) % MOUSE_EVENT_BUFFER_SIZE;
	return 0;
}

mouse_event* mouse_buf_peek(mouse_buf *lb)
{
	if(mouse_buf_is_empty(lb))
		return NULL;
	return &lb->mouse_events[lb->tail];
}

void mouse_buf_pop(mouse_buf *lb)
{
	if(!mouse_buf_is_empty(lb))
		lb->tail = (lb->tail + 1) % MOUSE_EVENT_BUFFER_SIZE;
}

void mouse_buf_reset(mouse_buf *lb)
{
  lb->head = 0;
  lb->tail = 0;
  memset(lb->mouse_events, 0, MOUSE_EVENT_BUFFER_SIZE * sizeof(mouse_event));
}

void mouse_buf_init(mouse_buf *lb)
{
  lb->mouse_events = malloc(MOUSE_EVENT_BUFFER_SIZE * sizeof(mouse_event));
  mouse_buf_reset(lb);
}

// --------------

uint8_t gamepad_buf_is_full(gamepad_buf *lb)
{
	return lb->tail == (lb->head + 1) % GAMEPAD_EVENT_BUFFER_SIZE;
}

uint8_t gamepad_buf_is_empty(gamepad_buf *lb)
{
	return lb->tail == lb->head;
}

uint8_t gamepad_buf_add(gamepad_buf *lb, gamepad_event* event)
{
	if(gamepad_buf_is_full(lb))
		return 1;
	memcpy(&lb->gamepad_events[lb->head], event, sizeof(gamepad_event));
	lb->head = (lb->head + 1) % GAMEPAD_EVENT_BUFFER_SIZE;
	return 0;
}

gamepad_event* gamepad_buf_peek(gamepad_buf *lb)
{
	if(gamepad_buf_is_empty(lb))
		return NULL;
	return &lb->gamepad_events[lb->tail];
}

void gamepad_buf_pop(gamepad_buf *lb)
{
	if(!gamepad_buf_is_empty(lb))
		lb->tail = (lb->tail + 1) % GAMEPAD_EVENT_BUFFER_SIZE;
}

void gamepad_buf_reset(gamepad_buf *lb)
{
  lb->head = 0;
  lb->tail = 0;
  memset(lb->gamepad_events, 0, GAMEPAD_EVENT_BUFFER_SIZE * sizeof(gamepad_event));
}

void gamepad_buf_init(gamepad_buf *lb)
{
  lb->gamepad_events = malloc(GAMEPAD_EVENT_BUFFER_SIZE * sizeof(gamepad_event));
  gamepad_buf_reset(lb);
}