Simpify the networking code.
This commit is contained in:
parent
09ae709c02
commit
e9b9443d31
|
@ -80,7 +80,7 @@ void CNXDNParrot::run()
|
||||||
for (;;) {
|
for (;;) {
|
||||||
unsigned char buffer[200U];
|
unsigned char buffer[200U];
|
||||||
|
|
||||||
unsigned int len = network.read(buffer);
|
unsigned int len = network.read(buffer, 200U);
|
||||||
if (len > 0U) {
|
if (len > 0U) {
|
||||||
parrot.write(buffer, len);
|
parrot.write(buffer, len);
|
||||||
watchdogTimer.start();
|
watchdogTimer.start();
|
||||||
|
@ -120,7 +120,6 @@ void CNXDNParrot::run()
|
||||||
unsigned int ms = stopWatch.elapsed();
|
unsigned int ms = stopWatch.elapsed();
|
||||||
stopWatch.start();
|
stopWatch.start();
|
||||||
|
|
||||||
network.clock(ms);
|
|
||||||
watchdogTimer.clock(ms);
|
watchdogTimer.clock(ms);
|
||||||
turnaroundTimer.clock(ms);
|
turnaroundTimer.clock(ms);
|
||||||
|
|
||||||
|
|
|
@ -149,7 +149,6 @@
|
||||||
<ClInclude Include="Network.h" />
|
<ClInclude Include="Network.h" />
|
||||||
<ClInclude Include="NXDNParrot.h" />
|
<ClInclude Include="NXDNParrot.h" />
|
||||||
<ClInclude Include="Parrot.h" />
|
<ClInclude Include="Parrot.h" />
|
||||||
<ClInclude Include="RingBuffer.h" />
|
|
||||||
<ClInclude Include="StopWatch.h" />
|
<ClInclude Include="StopWatch.h" />
|
||||||
<ClInclude Include="Thread.h" />
|
<ClInclude Include="Thread.h" />
|
||||||
<ClInclude Include="Timer.h" />
|
<ClInclude Include="Timer.h" />
|
||||||
|
|
|
@ -20,9 +20,6 @@
|
||||||
<ClInclude Include="Parrot.h">
|
<ClInclude Include="Parrot.h">
|
||||||
<Filter>Header Files</Filter>
|
<Filter>Header Files</Filter>
|
||||||
</ClInclude>
|
</ClInclude>
|
||||||
<ClInclude Include="RingBuffer.h">
|
|
||||||
<Filter>Header Files</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="StopWatch.h">
|
<ClInclude Include="StopWatch.h">
|
||||||
<Filter>Header Files</Filter>
|
<Filter>Header Files</Filter>
|
||||||
</ClInclude>
|
</ClInclude>
|
||||||
|
|
|
@ -22,13 +22,10 @@
|
||||||
#include <cassert>
|
#include <cassert>
|
||||||
#include <cstring>
|
#include <cstring>
|
||||||
|
|
||||||
const unsigned int BUFFER_LENGTH = 200U;
|
|
||||||
|
|
||||||
CNetwork::CNetwork(unsigned int port) :
|
CNetwork::CNetwork(unsigned int port) :
|
||||||
m_socket(port),
|
m_socket(port),
|
||||||
m_address(),
|
m_address(),
|
||||||
m_port(0U),
|
m_port(0U)
|
||||||
m_buffer(1000U, "NXDN Network")
|
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -53,41 +50,25 @@ bool CNetwork::write(const unsigned char* data, unsigned int length)
|
||||||
return m_socket.write(data, length, m_address, m_port);
|
return m_socket.write(data, length, m_address, m_port);
|
||||||
}
|
}
|
||||||
|
|
||||||
void CNetwork::clock(unsigned int ms)
|
unsigned int CNetwork::read(unsigned char* data, unsigned int len)
|
||||||
{
|
{
|
||||||
unsigned char buffer[BUFFER_LENGTH];
|
|
||||||
|
|
||||||
in_addr address;
|
in_addr address;
|
||||||
unsigned int port;
|
unsigned int port;
|
||||||
int length = m_socket.read(buffer, BUFFER_LENGTH, address, port);
|
int length = m_socket.read(data, len, address, port);
|
||||||
if (length <= 0)
|
if (length <= 0)
|
||||||
return;
|
return 0U;
|
||||||
|
|
||||||
m_address.s_addr = address.s_addr;
|
m_address.s_addr = address.s_addr;
|
||||||
m_port = port;
|
m_port = port;
|
||||||
|
|
||||||
if (::memcmp(buffer, "NXDNP", 5U) == 0 && length == 15) { // A poll
|
if (::memcmp(data, "NXDNP", 5U) == 0 && length == 15) { // A poll
|
||||||
write(buffer, length);
|
write(data, length);
|
||||||
} else if (::memcmp(buffer, "NXDND", 5U) == 0 && length == 43) {
|
|
||||||
unsigned char l = length;
|
|
||||||
m_buffer.addData(&l, 1U);
|
|
||||||
m_buffer.addData(buffer, length);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
unsigned int CNetwork::read(unsigned char* data)
|
|
||||||
{
|
|
||||||
assert(data != NULL);
|
|
||||||
|
|
||||||
if (m_buffer.isEmpty())
|
|
||||||
return 0U;
|
return 0U;
|
||||||
|
} else if (::memcmp(data, "NXDND", 5U) == 0 && length == 43) {
|
||||||
unsigned char len = 0U;
|
return 43U;
|
||||||
m_buffer.getData(&len, 1U);
|
} else {
|
||||||
|
return 0U;
|
||||||
m_buffer.getData(data, len);
|
}
|
||||||
|
|
||||||
return len;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void CNetwork::end()
|
void CNetwork::end()
|
||||||
|
|
|
@ -1,5 +1,5 @@
|
||||||
/*
|
/*
|
||||||
* Copyright (C) 2009-2014,2016 by Jonathan Naylor G4KLX
|
* Copyright (C) 2009-2014,2016,2018 by Jonathan Naylor G4KLX
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
* 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
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
@ -19,7 +19,6 @@
|
||||||
#ifndef Network_H
|
#ifndef Network_H
|
||||||
#define Network_H
|
#define Network_H
|
||||||
|
|
||||||
#include "RingBuffer.h"
|
|
||||||
#include "UDPSocket.h"
|
#include "UDPSocket.h"
|
||||||
|
|
||||||
#include <cstdint>
|
#include <cstdint>
|
||||||
|
@ -34,19 +33,16 @@ public:
|
||||||
|
|
||||||
bool write(const unsigned char* data, unsigned int length);
|
bool write(const unsigned char* data, unsigned int length);
|
||||||
|
|
||||||
unsigned int read(unsigned char* data);
|
unsigned int read(unsigned char* data, unsigned int length);
|
||||||
|
|
||||||
void end();
|
void end();
|
||||||
|
|
||||||
void close();
|
void close();
|
||||||
|
|
||||||
void clock(unsigned int ms);
|
|
||||||
|
|
||||||
private:
|
private:
|
||||||
CUDPSocket m_socket;
|
CUDPSocket m_socket;
|
||||||
in_addr m_address;
|
in_addr m_address;
|
||||||
unsigned int m_port;
|
unsigned int m_port;
|
||||||
CRingBuffer<unsigned char> m_buffer;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -1,147 +0,0 @@
|
||||||
/*
|
|
||||||
* Copyright (C) 2006-2009,2012,2013,2015,2016,2018 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 <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()) {
|
|
||||||
::fprintf(stderr, "**** Overflow in %s ring buffer, %u >= %u\n", m_name, nSamples, freeSpace());
|
|
||||||
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) {
|
|
||||||
::fprintf(stderr, "**** Underflow in %s ring buffer, %u < %u\n", 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) {
|
|
||||||
::fprintf(stderr, "**** Underflow peek in %s ring buffer, %u < %u\n", 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
|
|
||||||
{
|
|
||||||
if (m_oPtr == m_iPtr)
|
|
||||||
return m_length;
|
|
||||||
|
|
||||||
if (m_oPtr > m_iPtr)
|
|
||||||
return m_oPtr - m_iPtr;
|
|
||||||
|
|
||||||
return (m_length + m_oPtr) - m_iPtr;
|
|
||||||
}
|
|
||||||
|
|
||||||
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
|
|
|
@ -31,8 +31,7 @@ const unsigned int NXCORE_PORT = 41300U;
|
||||||
CNXCoreNetwork::CNXCoreNetwork(const std::string& address, bool debug) :
|
CNXCoreNetwork::CNXCoreNetwork(const std::string& address, bool debug) :
|
||||||
m_socket(NXCORE_PORT),
|
m_socket(NXCORE_PORT),
|
||||||
m_address(),
|
m_address(),
|
||||||
m_debug(debug),
|
m_debug(debug)
|
||||||
m_buffer(1000U, "NXCore Network")
|
|
||||||
{
|
{
|
||||||
assert(!address.empty());
|
assert(!address.empty());
|
||||||
|
|
||||||
|
@ -81,45 +80,35 @@ bool CNXCoreNetwork::write(const unsigned char* data, unsigned int len)
|
||||||
return m_socket.write(buffer, 102U, m_address, NXCORE_PORT);
|
return m_socket.write(buffer, 102U, m_address, NXCORE_PORT);
|
||||||
}
|
}
|
||||||
|
|
||||||
void CNXCoreNetwork::clock(unsigned int ms)
|
unsigned int CNXCoreNetwork::read(unsigned char* data, unsigned int len)
|
||||||
{
|
{
|
||||||
unsigned char buffer[BUFFER_LENGTH];
|
unsigned char buffer[BUFFER_LENGTH];
|
||||||
|
|
||||||
in_addr address;
|
in_addr address;
|
||||||
unsigned int port;
|
unsigned int port;
|
||||||
int length = m_socket.read(buffer, BUFFER_LENGTH, address, port);
|
int length = m_socket.read(data, BUFFER_LENGTH, address, port);
|
||||||
if (length <= 0)
|
if (length <= 0)
|
||||||
return;
|
return 0U;
|
||||||
|
|
||||||
// Check if the data is for us
|
// Check if the data is for us
|
||||||
if (m_address.s_addr != address.s_addr || port != NXCORE_PORT) {
|
if (m_address.s_addr != address.s_addr || port != NXCORE_PORT) {
|
||||||
LogMessage("NXCore packet received from an invalid source, %08X != %08X and/or %u != %u", m_address.s_addr, address.s_addr, NXCORE_PORT, port);
|
LogMessage("NXCore packet received from an invalid source, %08X != %08X and/or %u != %u", m_address.s_addr, address.s_addr, NXCORE_PORT, port);
|
||||||
return;
|
return 0U;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Invalid packet type?
|
// Invalid packet type?
|
||||||
if (::memcmp(buffer, "ICOM", 4U) != 0)
|
if (::memcmp(buffer, "ICOM", 4U) != 0)
|
||||||
return;
|
return 0U;
|
||||||
|
|
||||||
if (length != 102)
|
if (length != 102)
|
||||||
return;
|
return 0U;
|
||||||
|
|
||||||
if (m_debug)
|
if (m_debug)
|
||||||
CUtils::dump(1U, "NXCore Network Data Received", buffer, length);
|
CUtils::dump(1U, "NXCore Network Data Received", buffer, length);
|
||||||
|
|
||||||
m_buffer.addData(buffer + 40U, 33U);
|
::memcpy(data, buffer + 40U, 33U);
|
||||||
}
|
|
||||||
|
|
||||||
bool CNXCoreNetwork::read(unsigned char* data, unsigned int len)
|
return 33U;
|
||||||
{
|
|
||||||
assert(data != NULL);
|
|
||||||
|
|
||||||
if (m_buffer.isEmpty())
|
|
||||||
return false;
|
|
||||||
|
|
||||||
m_buffer.getData(data, 33U);
|
|
||||||
|
|
||||||
return true;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void CNXCoreNetwork::close()
|
void CNXCoreNetwork::close()
|
||||||
|
|
|
@ -19,7 +19,6 @@
|
||||||
#ifndef NXCoreNetwork_H
|
#ifndef NXCoreNetwork_H
|
||||||
#define NXCoreNetwork_H
|
#define NXCoreNetwork_H
|
||||||
|
|
||||||
#include "RingBuffer.h"
|
|
||||||
#include "UDPSocket.h"
|
#include "UDPSocket.h"
|
||||||
#include "Timer.h"
|
#include "Timer.h"
|
||||||
|
|
||||||
|
@ -35,17 +34,14 @@ public:
|
||||||
|
|
||||||
bool write(const unsigned char* data, unsigned int len);
|
bool write(const unsigned char* data, unsigned int len);
|
||||||
|
|
||||||
bool read(unsigned char* data, unsigned int len);
|
unsigned int read(unsigned char* data, unsigned int len);
|
||||||
|
|
||||||
void close();
|
void close();
|
||||||
|
|
||||||
void clock(unsigned int ms);
|
|
||||||
|
|
||||||
private:
|
private:
|
||||||
CUDPSocket m_socket;
|
CUDPSocket m_socket;
|
||||||
in_addr m_address;
|
in_addr m_address;
|
||||||
bool m_debug;
|
bool m_debug;
|
||||||
CRingBuffer<unsigned char> m_buffer;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -98,6 +98,13 @@ unsigned int CNXDNNetwork::read(unsigned char* data, unsigned int length, in_add
|
||||||
if (len <= 0)
|
if (len <= 0)
|
||||||
return 0U;
|
return 0U;
|
||||||
|
|
||||||
|
// Invalid packet type?
|
||||||
|
if (::memcmp(data, "NXDN", 4U) != 0)
|
||||||
|
return 0U;
|
||||||
|
|
||||||
|
if (length != 15 && length != 43)
|
||||||
|
return 0U;
|
||||||
|
|
||||||
if (m_debug)
|
if (m_debug)
|
||||||
CUtils::dump(1U, "NXDN Network Data Received", data, len);
|
CUtils::dump(1U, "NXDN Network Data Received", data, len);
|
||||||
|
|
||||||
|
|
|
@ -370,9 +370,6 @@ void CNXDNReflector::run()
|
||||||
dumpTimer.start();
|
dumpTimer.start();
|
||||||
}
|
}
|
||||||
|
|
||||||
if (m_nxCoreNetwork != NULL)
|
|
||||||
m_nxCoreNetwork->clock(ms);
|
|
||||||
|
|
||||||
if (ms < 5U)
|
if (ms < 5U)
|
||||||
CThread::sleep(5U);
|
CThread::sleep(5U);
|
||||||
}
|
}
|
||||||
|
|
|
@ -26,7 +26,6 @@
|
||||||
<ClInclude Include="Mutex.h" />
|
<ClInclude Include="Mutex.h" />
|
||||||
<ClInclude Include="NXDNNetwork.h" />
|
<ClInclude Include="NXDNNetwork.h" />
|
||||||
<ClInclude Include="NXDNReflector.h" />
|
<ClInclude Include="NXDNReflector.h" />
|
||||||
<ClInclude Include="RingBuffer.h" />
|
|
||||||
<ClInclude Include="StopWatch.h" />
|
<ClInclude Include="StopWatch.h" />
|
||||||
<ClInclude Include="Thread.h" />
|
<ClInclude Include="Thread.h" />
|
||||||
<ClInclude Include="Timer.h" />
|
<ClInclude Include="Timer.h" />
|
||||||
|
|
|
@ -26,9 +26,6 @@
|
||||||
<ClInclude Include="NXDNReflector.h">
|
<ClInclude Include="NXDNReflector.h">
|
||||||
<Filter>Header Files</Filter>
|
<Filter>Header Files</Filter>
|
||||||
</ClInclude>
|
</ClInclude>
|
||||||
<ClInclude Include="RingBuffer.h">
|
|
||||||
<Filter>Header Files</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="StopWatch.h">
|
<ClInclude Include="StopWatch.h">
|
||||||
<Filter>Header Files</Filter>
|
<Filter>Header Files</Filter>
|
||||||
</ClInclude>
|
</ClInclude>
|
||||||
|
|
|
@ -1,147 +0,0 @@
|
||||||
/*
|
|
||||||
* 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 <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()) {
|
|
||||||
::fprintf(stderr, "**** Overflow in %s ring buffer, %u >= %u\n", m_name, nSamples, freeSpace());
|
|
||||||
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) {
|
|
||||||
::fprintf(stderr, "**** Underflow in %s ring buffer, %u < %u\n", 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) {
|
|
||||||
::fprintf(stderr, "**** Underflow peek in %s ring buffer, %u < %u\n", 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
|
|
||||||
{
|
|
||||||
if (m_oPtr == m_iPtr)
|
|
||||||
return m_length;
|
|
||||||
|
|
||||||
if (m_oPtr > m_iPtr)
|
|
||||||
return m_oPtr - m_iPtr;
|
|
||||||
|
|
||||||
return (m_length + m_oPtr) - m_iPtr;
|
|
||||||
}
|
|
||||||
|
|
||||||
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
|
|
Loading…
Reference in New Issue