Hopefully fixed the reflector.
This commit is contained in:
parent
1927af2fcf
commit
fcbd984c02
7 changed files with 30 additions and 257 deletions
|
@ -24,17 +24,12 @@
|
|||
#include <cassert>
|
||||
#include <cstring>
|
||||
|
||||
const unsigned int BUFFER_LENGTH = 200U;
|
||||
|
||||
CNetwork::CNetwork(unsigned int port, const std::string& name, const std::string& description, bool debug) :
|
||||
m_socket(port),
|
||||
m_name(name),
|
||||
m_description(description),
|
||||
m_address(),
|
||||
m_port(0U),
|
||||
m_callsign(),
|
||||
m_debug(debug),
|
||||
m_buffer(1000U, "YSF Network"),
|
||||
m_status(NULL)
|
||||
{
|
||||
m_name.resize(16U, ' ');
|
||||
|
@ -91,68 +86,27 @@ bool CNetwork::writePoll(const in_addr& address, unsigned int port)
|
|||
return m_socket.write(buffer, 14U, address, port);
|
||||
}
|
||||
|
||||
void CNetwork::clock(unsigned int ms)
|
||||
unsigned int CNetwork::readData(unsigned char* data, unsigned int length, in_addr& address, unsigned int& port)
|
||||
{
|
||||
unsigned char buffer[BUFFER_LENGTH];
|
||||
assert(data != NULL);
|
||||
assert(length > 0U);
|
||||
|
||||
in_addr address;
|
||||
unsigned int port;
|
||||
int length = m_socket.read(buffer, BUFFER_LENGTH, address, port);
|
||||
if (length <= 0)
|
||||
return;
|
||||
|
||||
// Handle incoming polls
|
||||
if (::memcmp(buffer, "YSFP", 4U) == 0) {
|
||||
m_callsign = std::string((char*)(buffer + 4U), YSF_CALLSIGN_LENGTH);
|
||||
m_address = address;
|
||||
m_port = port;
|
||||
return;
|
||||
}
|
||||
int len = m_socket.read(data, length, address, port);
|
||||
if (len <= 0)
|
||||
return 0U;
|
||||
|
||||
// Handle incoming status requests
|
||||
if (::memcmp(buffer, "YSFS", 4U) == 0) {
|
||||
if (::memcmp(data, "YSFS", 4U) == 0) {
|
||||
m_socket.write(m_status, 42U, address, port);
|
||||
return;
|
||||
return 0U;
|
||||
}
|
||||
|
||||
if (m_debug)
|
||||
CUtils::dump(1U, "YSF Network Data Received", buffer, length);
|
||||
|
||||
unsigned char len = length;
|
||||
m_buffer.addData(&len, 1U);
|
||||
|
||||
m_buffer.addData(buffer, length);
|
||||
}
|
||||
|
||||
unsigned int CNetwork::readData(unsigned char* data)
|
||||
{
|
||||
assert(data != NULL);
|
||||
|
||||
if (m_buffer.isEmpty())
|
||||
return 0U;
|
||||
|
||||
unsigned char len = 0U;
|
||||
m_buffer.getData(&len, 1U);
|
||||
|
||||
m_buffer.getData(data, len);
|
||||
CUtils::dump(1U, "YSF Network Data Received", data, len);
|
||||
|
||||
return len;
|
||||
}
|
||||
|
||||
bool CNetwork::readPoll(std::string& callsign, in_addr& address, unsigned int& port)
|
||||
{
|
||||
if (m_port == 0U)
|
||||
return false;
|
||||
|
||||
callsign = m_callsign;
|
||||
address = m_address;
|
||||
port = m_port;
|
||||
|
||||
m_port = 0U;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
void CNetwork::setCount(unsigned int count)
|
||||
{
|
||||
if (count > 999U)
|
||||
|
|
|
@ -20,7 +20,6 @@
|
|||
#define Network_H
|
||||
|
||||
#include "YSFDefines.h"
|
||||
#include "RingBuffer.h"
|
||||
#include "UDPSocket.h"
|
||||
#include "Timer.h"
|
||||
|
||||
|
@ -37,24 +36,18 @@ public:
|
|||
bool writeData(const unsigned char* data, const in_addr& address, unsigned int port);
|
||||
bool writePoll(const in_addr& address, unsigned int port);
|
||||
|
||||
unsigned int readData(unsigned char* data);
|
||||
bool readPoll(std::string& callsign, in_addr& address, unsigned int& port);
|
||||
unsigned int readData(unsigned char* data, unsigned int length, in_addr& address, unsigned int& port);
|
||||
|
||||
void close();
|
||||
|
||||
void clock(unsigned int ms);
|
||||
|
||||
void setCount(unsigned int count);
|
||||
|
||||
private:
|
||||
CUDPSocket m_socket;
|
||||
std::string m_name;
|
||||
std::string m_description;
|
||||
in_addr m_address;
|
||||
unsigned int m_port;
|
||||
std::string m_callsign;
|
||||
bool m_debug;
|
||||
CRingBuffer<unsigned char> m_buffer;
|
||||
unsigned char* m_status;
|
||||
};
|
||||
|
||||
|
|
|
@ -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
|
|
@ -186,38 +186,28 @@ void CYSFReflector::run()
|
|||
|
||||
for (;;) {
|
||||
unsigned char buffer[200U];
|
||||
|
||||
// Refresh/add repeaters based on their polls
|
||||
in_addr address;
|
||||
unsigned int port;
|
||||
std::string callsign;
|
||||
bool ret = network.readPoll(callsign, address, port);
|
||||
if (ret) {
|
||||
CYSFRepeater* rpt = findRepeater(callsign, address, port);
|
||||
if (rpt == NULL) {
|
||||
LogMessage("Adding %s", callsign.c_str());
|
||||
rpt = new CYSFRepeater;
|
||||
rpt->m_timer.start();
|
||||
rpt->m_callsign = callsign;
|
||||
rpt->m_address = address;
|
||||
rpt->m_port = port;
|
||||
m_repeaters.push_back(rpt);
|
||||
network.setCount(m_repeaters.size());
|
||||
} else {
|
||||
rpt->m_timer.start();
|
||||
rpt->m_callsign = callsign;
|
||||
rpt->m_address = address;
|
||||
rpt->m_port = port;
|
||||
}
|
||||
}
|
||||
|
||||
unsigned int len = network.readData(buffer);
|
||||
unsigned int len = network.readData(buffer, 200U, address, port);
|
||||
if (len > 0U) {
|
||||
if (::memcmp(buffer + 0U, "YSFU", 4U) == 0) {
|
||||
if (::memcmp(buffer, "YSFP", 4U) == 0) {
|
||||
CYSFRepeater* rpt = findRepeater(address, port);
|
||||
if (rpt == NULL) {
|
||||
rpt = new CYSFRepeater;
|
||||
rpt->m_callsign = std::string((char*)(buffer + 4U), 10U);
|
||||
rpt->m_address = address;
|
||||
rpt->m_port = port;
|
||||
m_repeaters.push_back(rpt);
|
||||
network.setCount(m_repeaters.size());
|
||||
LogMessage("Adding %s", rpt->m_callsign.c_str());
|
||||
}
|
||||
rpt->m_timer.start();
|
||||
} else if (::memcmp(buffer + 0U, "YSFU", 4U) == 0) {
|
||||
std::string callsign = std::string((char*)(buffer + 4U), 10U);
|
||||
CYSFRepeater* rpt = findRepeater(callsign);
|
||||
CYSFRepeater* rpt = findRepeater(address, port);
|
||||
if (rpt != NULL) {
|
||||
LogMessage("Removing %s (unlinked)", callsign.c_str());
|
||||
LogMessage("Removing %s (unlinked)", rpt->m_callsign.c_str());
|
||||
std::vector<CYSFRepeater*>::iterator it = std::find(m_repeaters.begin(), m_repeaters.end(), rpt);
|
||||
if (it != m_repeaters.end())
|
||||
m_repeaters.erase(it);
|
||||
|
@ -262,7 +252,7 @@ void CYSFReflector::run()
|
|||
watchdogTimer.start();
|
||||
|
||||
for (std::vector<CYSFRepeater*>::const_iterator it = m_repeaters.begin(); it != m_repeaters.end(); ++it) {
|
||||
if ((*it)->m_callsign != callsign)
|
||||
if ((*it)->m_address.s_addr != address.s_addr && (*it)->m_port != port)
|
||||
network.writeData(buffer, (*it)->m_address, (*it)->m_port);
|
||||
}
|
||||
|
||||
|
@ -277,8 +267,6 @@ void CYSFReflector::run()
|
|||
unsigned int ms = stopWatch.elapsed();
|
||||
stopWatch.start();
|
||||
|
||||
network.clock(ms);
|
||||
|
||||
pollTimer.clock(ms);
|
||||
if (pollTimer.hasExpired()) {
|
||||
for (std::vector<CYSFRepeater*>::const_iterator it = m_repeaters.begin(); it != m_repeaters.end(); ++it)
|
||||
|
@ -325,20 +313,10 @@ void CYSFReflector::run()
|
|||
::LogFinalise();
|
||||
}
|
||||
|
||||
CYSFRepeater* CYSFReflector::findRepeater(const std::string& callsign, const in_addr& address, unsigned int port) const
|
||||
CYSFRepeater* CYSFReflector::findRepeater(const in_addr& address, unsigned int port) const
|
||||
{
|
||||
for (std::vector<CYSFRepeater*>::const_iterator it = m_repeaters.begin(); it != m_repeaters.end(); ++it) {
|
||||
if ((*it)->m_callsign == callsign || (address.s_addr == (*it)->m_address.s_addr && (*it)->m_port == port))
|
||||
return *it;
|
||||
}
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
CYSFRepeater* CYSFReflector::findRepeater(const std::string& callsign) const
|
||||
{
|
||||
for (std::vector<CYSFRepeater*>::const_iterator it = m_repeaters.begin(); it != m_repeaters.end(); ++it) {
|
||||
if ((*it)->m_callsign == callsign)
|
||||
if (address.s_addr == (*it)->m_address.s_addr && (*it)->m_port == port)
|
||||
return *it;
|
||||
}
|
||||
|
||||
|
|
|
@ -66,8 +66,7 @@ private:
|
|||
CConf m_conf;
|
||||
std::vector<CYSFRepeater*> m_repeaters;
|
||||
|
||||
CYSFRepeater* findRepeater(const std::string& callsign, const in_addr& address, unsigned int port) const;
|
||||
CYSFRepeater* findRepeater(const std::string& callsign) const;
|
||||
CYSFRepeater* findRepeater(const in_addr& address, unsigned int port) const;
|
||||
void dumpRepeaters() const;
|
||||
};
|
||||
|
||||
|
|
|
@ -149,7 +149,6 @@
|
|||
<ClInclude Include="Conf.h" />
|
||||
<ClInclude Include="Log.h" />
|
||||
<ClInclude Include="Network.h" />
|
||||
<ClInclude Include="RingBuffer.h" />
|
||||
<ClInclude Include="StopWatch.h" />
|
||||
<ClInclude Include="Timer.h" />
|
||||
<ClInclude Include="UDPSocket.h" />
|
||||
|
|
|
@ -29,9 +29,6 @@
|
|||
<ClInclude Include="YSFReflector.h">
|
||||
<Filter>Header Files</Filter>
|
||||
</ClInclude>
|
||||
<ClInclude Include="RingBuffer.h">
|
||||
<Filter>Header Files</Filter>
|
||||
</ClInclude>
|
||||
<ClInclude Include="StopWatch.h">
|
||||
<Filter>Header Files</Filter>
|
||||
</ClInclude>
|
||||
|
|
Loading…
Reference in a new issue