You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
285 lines
6.7 KiB
285 lines
6.7 KiB
/*
|
|
* Copyright (C) 2012,2013,2015 by Jonathan Naylor G4KLX
|
|
* Copyright (c) 2021 by Geoffrey Merck F4FXL / KC3FRA
|
|
*
|
|
* 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.
|
|
*/
|
|
#include <assert.h>
|
|
#include <cstring>
|
|
#include <boost/algorithm/string.hpp>
|
|
|
|
#include "Thread.h"
|
|
#include "DPlusAuthenticator.h"
|
|
#include "UDPReaderWriter.h"
|
|
#include "DStarDefines.h"
|
|
#include "Utils.h"
|
|
#include "Defs.h"
|
|
#include "Log.h"
|
|
|
|
const std::string OPENDSTAR_HOSTNAME = "auth.dstargateway.org";
|
|
const unsigned int OPENDSTAR_PORT = 20001U;
|
|
|
|
const unsigned int TCP_TIMEOUT = 10U;
|
|
|
|
CDPlusAuthenticator::CDPlusAuthenticator(const std::string& loginCallsign, const std::string& gatewayCallsign, const std::string& address, CCacheManager* cache) :
|
|
m_loginCallsign(loginCallsign),
|
|
m_gatewayCallsign(gatewayCallsign),
|
|
m_address(address),
|
|
m_cache(cache),
|
|
m_timer(1U, 6U * 3600U), // 6 hours
|
|
m_killed(false)
|
|
{
|
|
assert(!loginCallsign.empty());
|
|
assert(!gatewayCallsign.empty());
|
|
assert(cache != NULL);
|
|
|
|
m_gatewayCallsign = m_gatewayCallsign.substr(LONG_CALLSIGN_LENGTH - 1U);
|
|
|
|
boost::trim(m_loginCallsign);
|
|
boost::trim(m_gatewayCallsign);
|
|
|
|
if (m_loginCallsign.empty())
|
|
m_loginCallsign = m_gatewayCallsign;
|
|
}
|
|
|
|
CDPlusAuthenticator::~CDPlusAuthenticator()
|
|
{
|
|
}
|
|
|
|
void CDPlusAuthenticator::start()
|
|
{
|
|
Create();
|
|
Run();
|
|
}
|
|
|
|
void* CDPlusAuthenticator::Entry()
|
|
{
|
|
CLog::logInfo("Starting the D-Plus Authenticator thread");
|
|
|
|
authenticate(m_loginCallsign, OPENDSTAR_HOSTNAME, OPENDSTAR_PORT, '2', true);
|
|
|
|
m_timer.start();
|
|
|
|
#ifndef DEBUG_DSTARGW
|
|
try {
|
|
#endif
|
|
while (!m_killed) {
|
|
if (m_timer.hasExpired()) {
|
|
authenticate(m_loginCallsign, OPENDSTAR_HOSTNAME, OPENDSTAR_PORT, '2', true);
|
|
m_timer.start();
|
|
}
|
|
|
|
Sleep(1000UL);
|
|
|
|
m_timer.clock();
|
|
}
|
|
#ifndef DEBUG_DSTARGW
|
|
}
|
|
catch (std::exception& e) {
|
|
std::string message(e.what());
|
|
CLog::logError("Exception raised in the D-Plus Authenticator thread - \"%s\"", message.c_str());
|
|
throw;
|
|
}
|
|
catch (...) {
|
|
CLog::logError("Unknown exception raised in the D-Plus Authenticator thread");
|
|
throw;
|
|
}
|
|
#endif
|
|
|
|
CLog::logInfo("Stopping the D-Plus Authenticator thread");
|
|
|
|
return NULL;
|
|
}
|
|
|
|
void CDPlusAuthenticator::stop()
|
|
{
|
|
m_killed = true;
|
|
|
|
Wait();
|
|
}
|
|
|
|
bool CDPlusAuthenticator::authenticate(const std::string& callsign, const std::string& hostname, unsigned int port, unsigned char id, bool writeToCache)
|
|
{
|
|
CTCPReaderWriterClient socket(hostname, port, m_address);
|
|
|
|
bool ret = socket.open();
|
|
if (!ret)
|
|
return false;
|
|
|
|
unsigned char* buffer = new unsigned char[4096U];
|
|
::memset(buffer, ' ', 56U);
|
|
|
|
buffer[0U] = 0x38U;
|
|
buffer[1U] = 0xC0U;
|
|
buffer[2U] = 0x01U;
|
|
buffer[3U] = 0x00U;
|
|
|
|
for (unsigned int i = 0U; i < callsign.length(); i++)
|
|
buffer[i + 4U] = callsign[i];
|
|
|
|
buffer[12U] = 'D';
|
|
buffer[13U] = 'V';
|
|
buffer[14U] = '0';
|
|
buffer[15U] = '1';
|
|
buffer[16U] = '9';
|
|
buffer[17U] = '9';
|
|
buffer[18U] = '9';
|
|
buffer[19U] = '9';
|
|
|
|
buffer[28U] = 'W';
|
|
buffer[29U] = '7';
|
|
buffer[30U] = 'I';
|
|
buffer[31U] = 'B';
|
|
buffer[32U] = id;
|
|
|
|
buffer[40U] = 'D';
|
|
buffer[41U] = 'H';
|
|
buffer[42U] = 'S';
|
|
buffer[43U] = '0';
|
|
buffer[44U] = '2';
|
|
buffer[45U] = '5';
|
|
buffer[46U] = '7';
|
|
|
|
ret = socket.write(buffer, 56U);
|
|
if (!ret) {
|
|
socket.close();
|
|
delete[] buffer;
|
|
return false;
|
|
}
|
|
|
|
ret = read(socket, buffer + 0U, 2U);
|
|
|
|
while (ret) {
|
|
unsigned int len = (buffer[1U] & 0x0FU) * 256U + buffer[0U];
|
|
|
|
// Ensure that we get exactly len - 2U bytes from the TCP stream
|
|
ret = read(socket, buffer + 2U, len - 2U);
|
|
if (!ret) {
|
|
CLog::logInfo("Short read from %s:%u", hostname.c_str(), port);
|
|
break;
|
|
}
|
|
|
|
if ((buffer[1U] & 0xC0U) != 0xC0U || buffer[2U] != 0x01U) {
|
|
CLog::logInfo("Invalid packet received from %s:%u", hostname.c_str(), port);
|
|
CUtils::dump("Details:", buffer, len);
|
|
break;
|
|
}
|
|
|
|
for (unsigned int i = 8U; (i + 25U) < len; i += 26U) {
|
|
std::string address = std::string((char*)(buffer + i + 0U), 16U);
|
|
std::string name = std::string((char*)(buffer + i + 16U), LONG_CALLSIGN_LENGTH);
|
|
|
|
boost::trim(address);
|
|
boost::trim(name);
|
|
|
|
// Get the active flag
|
|
bool active = (buffer[i + 25U] & 0x80U) == 0x80U;
|
|
|
|
// An empty name or IP address or an inactive gateway/reflector is not written out
|
|
if (address.length() > 0U && name.length() > 0U && name.substr(0, 3) != "XRF" && active && writeToCache){
|
|
if (name.substr(0, 3) == "REF")
|
|
CLog::logInfo("D-Plus: %s\t%s", name.c_str(), address.c_str());
|
|
|
|
name += " ";
|
|
name = name.substr(LONG_CALLSIGN_LENGTH - 1U);
|
|
name += "G";
|
|
m_cache->updateGateway(name, address, DP_DPLUS, false, true);
|
|
}
|
|
}
|
|
|
|
ret = read(socket, buffer + 0U, 2U);
|
|
}
|
|
|
|
CLog::logInfo("Registered with %s using callsign %s", hostname.c_str(), callsign.c_str());
|
|
|
|
socket.close();
|
|
|
|
delete[] buffer;
|
|
|
|
return true;
|
|
}
|
|
|
|
bool CDPlusAuthenticator::poll(const std::string& callsign, const std::string& hostname, unsigned int port, unsigned char id)
|
|
{
|
|
CUDPReaderWriter socket(m_address, 0U);
|
|
bool ret = socket.open();
|
|
if (!ret)
|
|
return false;
|
|
|
|
unsigned char buffer[56U];
|
|
::memset(buffer, ' ', 56U);
|
|
|
|
buffer[0U] = 0x38U;
|
|
buffer[1U] = 0x20U;
|
|
buffer[2U] = 0x01U;
|
|
buffer[3U] = 0x01U;
|
|
|
|
for (unsigned int i = 0U; i < callsign.length(); i++)
|
|
buffer[i + 4U] = callsign[i];
|
|
|
|
buffer[12U] = 'D';
|
|
buffer[13U] = 'V';
|
|
buffer[14U] = '0';
|
|
buffer[15U] = '1';
|
|
buffer[16U] = '9';
|
|
buffer[17U] = '9';
|
|
buffer[18U] = '9';
|
|
buffer[19U] = '9';
|
|
|
|
for (unsigned int i = 0U; i < callsign.length(); i++)
|
|
buffer[i + 20U] = callsign[i];
|
|
|
|
buffer[28U] = 'W';
|
|
buffer[29U] = '7';
|
|
buffer[30U] = 'I';
|
|
buffer[31U] = 'B';
|
|
buffer[32U] = id;
|
|
|
|
buffer[40U] = 'D';
|
|
buffer[41U] = 'H';
|
|
buffer[42U] = 'S';
|
|
buffer[43U] = '0';
|
|
buffer[44U] = '2';
|
|
buffer[45U] = '5';
|
|
buffer[46U] = '7';
|
|
|
|
in_addr address = socket.lookup(hostname);
|
|
if (address.s_addr == INADDR_NONE) {
|
|
socket.close();
|
|
return false;
|
|
}
|
|
|
|
ret = socket.write(buffer, 56U, address, port);
|
|
|
|
socket.close();
|
|
|
|
return ret;
|
|
}
|
|
|
|
bool CDPlusAuthenticator::read(CTCPReaderWriterClient &socket, unsigned char *buffer, unsigned int len) const
|
|
{
|
|
unsigned int offset = 0U;
|
|
|
|
do {
|
|
int n = socket.read(buffer + offset, len - offset, TCP_TIMEOUT);
|
|
if (n < 0)
|
|
return false;
|
|
|
|
offset += n;
|
|
} while ((len - offset) > 0U);
|
|
|
|
return true;
|
|
}
|