HendiControlFirmware/Control/firmware/uart_echo/fifo.c

/*
 * fifo.c
 *
 * Created: 20.02.2019 20:33:06
 *  Author: jens
 */ 

#include <stdint.h>
#include "fifo.h"

void fifo_init(Fifo *pObj, size_t capacity, size_t itemSize, const char *pName)
{
	pObj->wi = 0;
	pObj->ri = 0;
	pObj->fill = 0;
	pObj->capacity = capacity;
	pObj->itemSize = itemSize;
	pObj->ppData = (void**)malloc(capacity);
	
	for (int i=0; i < capacity; i++)
	{
		pObj->ppData[i] = (void*)malloc(itemSize);
	}
	pObj->pName = pName;
}

void fifo_free(Fifo *pObj)
{
	for (int i=0; i < pObj->capacity; i++)
	{
		free(pObj->ppData[i]);
	}
	free (pObj->ppData);
	pObj->itemSize = 0;
	pObj->capacity = 0;
}

int fifo_push(Fifo *pObj, void *pItem)
{
	if (pObj->fill >= pObj->capacity)
	{
		return 0;
	}
	for (size_t i=0; i < pObj->itemSize; i++)
	{
		((uint8_t*)pObj->ppData[pObj->wi])[i] = ((uint8_t*)pItem)[i];
	}
	pObj->wi++;
	pObj->fill++;
	if (pObj->wi == pObj->capacity)
	{
		pObj->wi = 0;
	}
	return 1;
}

int fifo_pop(Fifo *pObj, void *pItem)
{
	if (!pObj->fill)
	{
		return 0;
	}
	for (size_t i=0; i < pObj->itemSize; i++)
	{
		((uint8_t*)pItem)[i] = ((uint8_t*)pObj->ppData[pObj->ri])[i];
	}
	pObj->ri++;
	pObj->fill--;
	if (pObj->ri == pObj->capacity)
	{
		pObj->ri = 0;
	}
	return 1;
}

int fifo_isEmpty(Fifo *pObj)
{
	return pObj->fill == 0;
}