mirror of
https://github.com/ShaYmez/MMDVM_CM.git
synced 2024-08-21 05:26:35 -04:00
155 lines
3.0 KiB
C
155 lines
3.0 KiB
C
|
/*
|
||
|
* Copyright (C) 2006-2009,2012,2013,2015,2016 by Jonathan Naylor G4KLX
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License as published by
|
||
|
* the Free Software Foundation; either version 2 of the License, or
|
||
|
* (at your option) any later version.
|
||
|
*
|
||
|
* This program is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
* GNU General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License
|
||
|
* along with this program; if not, write to the Free Software
|
||
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||
|
*/
|
||
|
|
||
|
#ifndef RingBuffer_H
|
||
|
#define RingBuffer_H
|
||
|
|
||
|
#include "Log.h"
|
||
|
|
||
|
#include <cstdio>
|
||
|
#include <cassert>
|
||
|
#include <cstring>
|
||
|
|
||
|
template<class T> class CRingBuffer {
|
||
|
public:
|
||
|
CRingBuffer(unsigned int length, const char* name) :
|
||
|
m_length(length),
|
||
|
m_name(name),
|
||
|
m_buffer(NULL),
|
||
|
m_iPtr(0U),
|
||
|
m_oPtr(0U)
|
||
|
{
|
||
|
assert(length > 0U);
|
||
|
assert(name != NULL);
|
||
|
|
||
|
m_buffer = new T[length];
|
||
|
|
||
|
::memset(m_buffer, 0x00, m_length * sizeof(T));
|
||
|
}
|
||
|
|
||
|
~CRingBuffer()
|
||
|
{
|
||
|
delete[] m_buffer;
|
||
|
}
|
||
|
|
||
|
bool addData(const T* buffer, unsigned int nSamples)
|
||
|
{
|
||
|
if (nSamples >= freeSpace()) {
|
||
|
LogError("%s buffer overflow, clearing the buffer. (%u >= %u)", m_name, nSamples, freeSpace());
|
||
|
clear();
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
for (unsigned int i = 0U; i < nSamples; i++) {
|
||
|
m_buffer[m_iPtr++] = buffer[i];
|
||
|
|
||
|
if (m_iPtr == m_length)
|
||
|
m_iPtr = 0U;
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
bool getData(T* buffer, unsigned int nSamples)
|
||
|
{
|
||
|
if (dataSize() < nSamples) {
|
||
|
LogError("**** Underflow in %s ring buffer, %u < %u", m_name, dataSize(), nSamples);
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
for (unsigned int i = 0U; i < nSamples; i++) {
|
||
|
buffer[i] = m_buffer[m_oPtr++];
|
||
|
|
||
|
if (m_oPtr == m_length)
|
||
|
m_oPtr = 0U;
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
bool peek(T* buffer, unsigned int nSamples)
|
||
|
{
|
||
|
if (dataSize() < nSamples) {
|
||
|
LogError("**** Underflow peek in %s ring buffer, %u < %u", m_name, dataSize(), nSamples);
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
unsigned int ptr = m_oPtr;
|
||
|
for (unsigned int i = 0U; i < nSamples; i++) {
|
||
|
buffer[i] = m_buffer[ptr++];
|
||
|
|
||
|
if (ptr == m_length)
|
||
|
ptr = 0U;
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
void clear()
|
||
|
{
|
||
|
m_iPtr = 0U;
|
||
|
m_oPtr = 0U;
|
||
|
|
||
|
::memset(m_buffer, 0x00, m_length * sizeof(T));
|
||
|
}
|
||
|
|
||
|
unsigned int freeSpace() const
|
||
|
{
|
||
|
unsigned int len = m_length;
|
||
|
|
||
|
if (m_oPtr > m_iPtr)
|
||
|
len = m_oPtr - m_iPtr;
|
||
|
else if (m_iPtr > m_oPtr)
|
||
|
len = m_length - (m_iPtr - m_oPtr);
|
||
|
|
||
|
if (len > m_length)
|
||
|
len = 0U;
|
||
|
|
||
|
return len;
|
||
|
}
|
||
|
|
||
|
unsigned int dataSize() const
|
||
|
{
|
||
|
return m_length - freeSpace();
|
||
|
}
|
||
|
|
||
|
bool hasSpace(unsigned int length) const
|
||
|
{
|
||
|
return freeSpace() > length;
|
||
|
}
|
||
|
|
||
|
bool hasData() const
|
||
|
{
|
||
|
return m_oPtr != m_iPtr;
|
||
|
}
|
||
|
|
||
|
bool isEmpty() const
|
||
|
{
|
||
|
return m_oPtr == m_iPtr;
|
||
|
}
|
||
|
|
||
|
private:
|
||
|
unsigned int m_length;
|
||
|
const char* m_name;
|
||
|
T* m_buffer;
|
||
|
unsigned int m_iPtr;
|
||
|
unsigned int m_oPtr;
|
||
|
};
|
||
|
|
||
|
#endif
|