UHSDR/UHSDR-active-devel/mchf-eclipse/drivers/audio/rb.c
2022-11-08 16:13:55 +01:00

73 lines
2.2 KiB
C

#include "rb.h"
void RingBuffer_ClearGetTail(RingBuffer_data_t* buf)
{
do
{
buf->buffer_tail = buf->buffer_head;
} while (buf->buffer_tail != buf->buffer_head);
}
void RingBuffer_ClearPutHead(RingBuffer_data_t* buf)
{
do
{
buf->buffer_head = buf->buffer_tail;
} while (buf->buffer_tail != buf->buffer_head);
}
int32_t RingBuffer_GetRoom(RingBuffer_data_t* buf)
{
int32_t retval = ((buf->buffer_tail + buf->conf.size) - buf->buffer_head) % buf->conf.size;
return retval == 0 ? buf->conf.size : retval;
}
int32_t RingBuffer_GetData(RingBuffer_data_t* buf)
{
int32_t retval = ((buf->buffer_head + buf->conf.size) - buf->buffer_tail) % buf->conf.size;
return retval;
}
bool RingBuffer_PutSamples(RingBuffer_data_t* buf, void* samples, int32_t len)
{
bool retval = false;
if (len < RingBuffer_GetRoom(buf))
{
int32_t maxupper = buf->conf.size - buf->buffer_head;
int32_t copylower = len - maxupper;
int32_t copyupper = copylower > 0 ? maxupper : len;
memcpy((char*)buf->conf.buffer + (buf->buffer_head * buf->conf.sizeofItem),(char*)samples,copyupper * buf->conf.sizeofItem);
if (copylower > 0)
{
memcpy((char*)buf->conf.buffer,(char*)samples + (maxupper * buf->conf.sizeofItem),copylower * buf->conf.sizeofItem);
}
buf->buffer_head = (buf->buffer_head + len) % buf->conf.size;
retval = true;
}
return retval;
}
bool RingBuffer_GetSamples(RingBuffer_data_t* buf, void* samples, int32_t len)
{
bool retval = false;
if (len <= RingBuffer_GetData(buf))
{
int32_t maxupper = buf->conf.size - buf->buffer_tail;
int32_t copylower = len - maxupper;
int32_t copyupper = copylower > 0 ? maxupper : len;
memcpy((char*)samples,(char*)buf->conf.buffer + (buf->buffer_tail * buf->conf.sizeofItem),copyupper * buf->conf.sizeofItem);
if (copylower > 0)
{
memcpy(((char*)samples) + (maxupper * buf->conf.sizeofItem), (char*)buf->conf.buffer,copylower * buf->conf.sizeofItem);
}
buf->buffer_tail = (buf->buffer_tail + len) % buf->conf.size;
retval = true;
}
return retval;
}