protocol.cpp

//
//  mrefd
//
//  Created by Jean-Luc Deltombe (LX3JL) on 01/11/2015.
//  Copyright © 2015 Jean-Luc Deltombe (LX3JL). All rights reserved.
//  Copyright © 2022-2025 Thomas A. Early, N7TAE
//
// ----------------------------------------------------------------------------
//    This file is part of mrefd.
//
//    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 3 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 Foobar.  If not, see <http://www.gnu.org/licenses/>.
// ----------------------------------------------------------------------------

#include "defines.h"
#include "protocol.h"
#include "clients.h"
#include "reflector.h"
#include "gatekeeper.h"
#include "configure.h"
#include "interlinks.h"
#include "frametype.h"
#include "position.h"

extern CConfigure g_CFG;
extern CGateKeeper g_GateKeeper;
extern CReflector g_Reflector;
extern CInterlinks g_Interlinks;

////////////////////////////////////////////////////////////////////////////////////////
// constructor

CProtocol::CProtocol() : keep_running(true), publish(true)
{
	peerRegEx = std::regex("^M17-[A-Z0-9]{3,3}( [A-Z])?$", std::regex::extended);
	clientRegEx = std::regex("^([0-9]?[A-Z]{1,2}[0-9]{0,2}/)?[0-9]?[A-Z]{1,2}[0-9]{1,2}[A-Z]{1,4}([ -/\\.][A-Z0-9 -/\\.]*)?$", std::regex::extended);
	lstnRegEx = std::regex("^[0-9]?[A-Z][A-Z0-9]{2,8}$", std::regex::extended);
}

////////////////////////////////////////////////////////////////////////////////////////
// destructor

CProtocol::~CProtocol()
{
	Close();
}

////////////////////////////////////////////////////////////////////////////////////////
// initialization

// returns true on error
bool CProtocol::Initialize(const uint16_t port, const std::string &strIPv4, const std::string &strIPv6)
{
	// init reflector apparent callsign
	m_ReflectorCallsign = g_CFG.GetCallsign();

	// reset stop flag
	keep_running = true;

	// create our sockets
	if (not strIPv4.empty())
	{
		CIp ip4(AF_INET, port, strIPv4.c_str());
		if (ip4.IsSet())
		{
			if (m_Socket4.Open(ip4))
				return true;
		}
		std::cout << "Listening on " << ip4 << std::endl;
	}

	if (not strIPv6.empty())
	{
		CIp ip6(AF_INET6, port, strIPv6.c_str());
		if (ip6.IsSet())
		{
			if (m_Socket6.Open(ip6))
			{
				m_Socket4.Close();
				return true;
			}
			std::cout << "Listening on " << ip6 << std::endl;
		}
	}

	// set up the Receive function pointer
	if (strIPv4.empty())
	{
		Receive = &CProtocol::Receive6;
	}
	else
	{
		if (strIPv6.empty())
		{
			Receive = &CProtocol::Receive4;
		}
		else
		{
			Receive = &CProtocol::ReceiveDS;
		}
	}

	for (const auto &mod : g_CFG.GetRefMods().GetModules())
	{
		m_streamMap[mod] = std::make_unique<CPacketStream>();
	}

	try
	{
		m_Future = std::async(std::launch::async, &CProtocol::Thread, this);
	}
	catch (const std::exception &e)
	{
		std::cerr << "Could not start protocol on port " << port << ": " << e.what() << std::endl;
		m_Socket4.Close();
		m_Socket6.Close();
		return true;
	}

	// update time
	m_LastKeepaliveTime.Start();
	m_LastPeersLinkTime.Start();

	// done
	return false;
}

void CProtocol::Thread()
{
	while (keep_running)
	{
		Task();
	}
}
////////////////////////////////////////////////////////////////////////////////////////
// task

void CProtocol::Task(void)
{
	CIp ip;
	char mod = 0;
	char mods[27];
	CCallsign cs;
	CPacket pack;

	// any incoming packet ?
	auto len = (*this.*Receive)(pack.GetData(), ip, 20);

	switch (len)
	{
		case 0:
			break;
		case 10:
			if (IsValidKeepAlive(pack.GetCData(), cs))
			{
				auto client = g_Reflector.GetClients()->FindClient(ip);
				g_Reflector.ReleaseClients();
				if (client)
				{
					const auto ct = client->GetClientType();
					if (EClientType::simple == ct or EClientType::listenonly == ct) {
						client->Alive();
					} else {
						auto peer = g_Reflector.GetPeers().FindPeer(ip);
						if (peer)
							peer->Alive();
					}
				}
			}
			else if (IsValidDisconnect(pack.GetCData(), cs))
			{
				auto client = g_Reflector.GetClients()->FindClient(ip);
				g_Reflector.ReleaseClients();
				if (client)
				{
					const auto ct = client->GetClientType();
					if (EClientType::simple == ct or EClientType::listenonly == ct)
					{
						std::cout << "Disconnect packet from " << cs << " at " << ip << std::endl;
						uint8_t disc[4];
						EncodeDisconnectedPacket(disc);
						Send(disc, 4, ip);
						g_Reflector.GetClients()->RemoveClient(client);
						g_Reflector.ReleaseClients();
					}
					else
					{
						auto peer = g_Reflector.GetPeers().FindPeer(ip);
						if (peer)
						{
							g_Reflector.GetPeers().RemovePeer(peer);
						}
					}
				}
			}
			else if (IsValidNAcknowledge(pack.GetCData(), cs))
			{
				std::cout << "NACK packet received from " << cs << " at " << ip << std::endl;
			}
			break;
		case 11:
			if (IsValidConnect(pack.GetCData(), ip, cs, mod))
			{
				bool isLstn = (0 == memcmp(pack.GetCData(), "LSTN", 4));

				std::cout << "Connect packet for module " << mod << " from " << cs << " at " << ip << (isLstn ? " as listen-only" : "") << std::endl;

				// callsign authorized?
				if (g_GateKeeper.ClientMayLink(cs, ip))
				{
					// valid module ?
					if (g_CFG.IsValidModule(mod))
					{
						// create the client and append
						if (isLstn)
						{
							if (AF_INET6 == ip.GetFamily())
								g_Reflector.GetClients()->AddClient(std::make_shared<CClient>(cs, ip, EClientType::listenonly, mod, m_Socket6));
							else
								g_Reflector.GetClients()->AddClient(std::make_shared<CClient>(cs, ip, EClientType::listenonly, mod, m_Socket4));
							g_Reflector.ReleaseClients();
						}
						else
						{
							if (AF_INET6 == ip.GetFamily())
								g_Reflector.GetClients()->AddClient(std::make_shared<CClient>(cs, ip, EClientType::simple, mod, m_Socket6));
							else
								g_Reflector.GetClients()->AddClient(std::make_shared<CClient>(cs, ip, EClientType::simple, mod, m_Socket4));
							g_Reflector.ReleaseClients();
						}
						// acknowledge a normal request from a repeater/hot-spot/mvoice
						EncodeConnectAckPacket(pack.GetData());
						Send(pack.GetCData(), 4, ip);
					}
					else
					{
						std::cout << "Node " << cs << " connect attempt on non-existing module '" << mod << "'" << std::endl;

						// deny the request
						EncodeConnectNackPacket(pack.GetData());
						Send(pack.GetCData(), 4, ip);
					}
				}
				else
				{
					// deny the request
					EncodeConnectNackPacket(pack.GetData());
					Send(pack.GetCData(), 4, ip);
				}
			}
			break;
		case sizeof(SInterlinkPacket):
			switch (GetInterlinkPacket(pack.GetCData(), ip, cs, mods)) {
				case EInterlinkPacketType::conn:
					std::cout << "CONN packet from " << cs << " at " << ip << " to module(s) " << mods << std::endl;

					// callsign authorized?
					if (g_GateKeeper.PeerMayLink(cs))
					{
						SInterlinkPacket ackn;
						// acknowledge the request
						EncodeInterlinkAckPacket(ackn, mods);
						Send(ackn.magic, sizeof(SInterlinkPacket), ip);
					}
					else
					{
						// deny the request
						EncodeInterlinkNackPacket(pack.GetData());
						Send(pack.GetCData(), 10, ip);
					}
					break;
				case EInterlinkPacketType::ackn:
					std::cout << "ACQN packet from " << cs << " at " << ip << " on module(s) " << mods << std::endl;

					// callsign authorized?
					if (g_GateKeeper.PeerMayLink(cs))
					{
						// already connected ?
						if (nullptr == g_Reflector.GetPeers().FindPeer(cs))
						{
							auto item = g_Interlinks.Find(cs.c_str());
							if (item)
							{
								auto type = item->IsNotLegacy() ? EClientType::reflector : EClientType::legacy;
								// create the new peer
								// this also create one client per module
								if (AF_INET6 == ip.GetFamily())
									g_Reflector.GetPeers().AddPeer(std::make_shared<CPeer>(cs, ip, type, mods, m_Socket6));
								else
									g_Reflector.GetPeers().AddPeer(std::make_shared<CPeer>(cs, ip, type, mods, m_Socket4));
								publish = true;
							}
							else
							{
								std::cerr << "ERROR: got an ACKN packet from " << cs.GetCS() << " but could not find the interlink item!" << std::endl;
							}
						}
					}
					break;
				default:
					break;
			}
			break;
		default:
			if (len > sizeof(SInterlinkPacket))
			{
				CCallsign dst, src;
				auto client = GetClient(ip, len, pack, dst, src);
				if (client)
				{
					// std::cout << "Data:" << (pack.IsStreamData()?"Stream":"Packet") << " Module:" << mod << " Client:" << client->GetCallsign() << " SRC:" << src << " IP:" << ip << std::endl;
					//  make sure the SRC callsign is not blacklisted
					if (g_GateKeeper.MayTransmit(src, ip))
					{
						// might open a new stream if it's the first packet
						// if there is a problem, return false
						if (OnPacketIn(pack, client))
						{
							if (0 == ((0x7fffu & pack.GetFrameNumber()) % 6))
								UpdateDashData(src, dst, client, pack);
							SendToClients(pack, client, dst);
							if (pack.IsStreamData() and pack.IsLastPacket())
							{
								CloseStream(client->GetReflectorModule()); // so this only closes streams
							}
						}
					}
					else if (pack.IsStreamData())
					{
						// this voicestream is blocked, so
						if (pack.GetFrameNumber() & 0x8000u)
						{
							// when the stream closes, log it.
							std::cout << "Blocked voice stream from " << src << " at " << ip << std::endl;
						}
					}
					else
					{
						// here is a blocked PM packet
						std::cout << "Blocked Packet from " << src << " at " << ip << std::endl;
					}
				}
			}
			break;
	}

	// Now we do all the other maintenance

	// handle end of streaming timeout
	CheckStreamsTimeout();

	// keep alive
	if (m_LastKeepaliveTime.Time() > M17_KEEPALIVE_PERIOD)
	{
		// handle keep alives
		HandleKeepalives();

		// update time
		m_LastKeepaliveTime.Start();
	}

	// peer connections
	if (m_LastPeersLinkTime.Time() > M17_RECONNECT_PERIOD)
	{
		// handle remote peers connections
		HandlePeerLinks();

		// update time
		m_LastPeersLinkTime.Start();
	}
}

void CProtocol::Close(void)
{
	keep_running = false;
	if (m_Future.valid())
	{
		m_Future.get();
	}
	m_streamMap.clear();
	m_Socket4.Close();
	m_Socket6.Close();
}

////////////////////////////////////////////////////////////////////////////////////////
// dashboard data handler

void CProtocol::UpdateDashData(const CCallsign &src, const CCallsign &dst, SPClient client, const CPacket &pack)
{
	const CFrameType t(pack.GetFrameType());
	auto users = g_Reflector.GetUsers();
	users->Hearing(src, dst, client->GetCallsign(), client->GetReflectorModule(), (pack.IsStreamData() ? EMode::sm : EMode::pm));
	if (EMetaDatType::gnss == t.GetMetaDataType())
	{
			CPosition p(pack.GetCMetaData());
			std::string lat, lon;
			const std::string maid(p.GetPosition(lat, lon));
			if (not maid.empty())
					users->Location(src, maid, lat, lon);
	}
	g_Reflector.ReleaseUsers();
	client->Heard();
}

////////////////////////////////////////////////////////////////////////////////////////
// stream handle helpers

CPacketStream *CProtocol::GetStream(CPacket &packet, const SPClient client)
{
	// this is only for stream mode packet
	if (packet.IsPacketData())
		return nullptr;
	// get the stream based on the DST module
	const auto mod = client->GetReflectorModule();
	const auto pit = m_streamMap.find(mod);
	// does the dst module exist?
	if (m_streamMap.end() == pit)
	{
	#ifdef DEBUG
		const CCallsign dst(packet.GetCDstAddress());
		const CCallsign src(packet.GetCSrcAddress());
		std::cout << "Bad incoming packet on module '" << mod << "' to " << dst.GetCS() << " from " << src.GetCS() << std::endl;
	#endif
		return nullptr;
	}
	if (pit->second->IsOpen())
	{
		// the stream is opened. do the SIDs match?
		if (pit->second->GetPacketStreamId() == packet.GetStreamId())
		{
			return pit->second.get();
		}
	}
	// done
	return nullptr;
}

void CProtocol::CheckStreamsTimeout(void)
{
	// check the packetstreams for each module
	for (auto &it : m_streamMap)
	{
		// time out ?
		if (it.second->IsExpired())
			CloseStream(it.first);
	}

	// check each item in the parrot map
	for (auto pit = parrotMap.begin(); pit != parrotMap.end();)
	{
		switch (pit->second->GetState())
		{
		case EParrotState::record:
			if (pit->second->IsExpired())
			{
				std::cout << "Parrot stream from " << pit->second->GetSRC() << " timed out! Playing..." << std::endl;
				pit->second->Play();
			}
			pit++;
			break;
		case EParrotState::done:
			if (pit->second->IsStream())
			{
				auto psp = static_cast<CStreamParrot *>(pit->second.get());
				std::cout << psp->GetSize() << " packet parrot stream from " << psp->GetSRC() << " played back to " << pit->first->GetCallsign() << " at " << pit->first->GetIp() << std::endl;
			}
			else
			{
				std::cout << "Parrot packet from " << pit->second->GetSRC() << " played back to " << pit->first->GetCallsign() << " at " << pit->first->GetIp() << std::endl;
			}
			pit->second->Quit();		// get() the future
			pit->second.reset();		// destroy the parrot object
			pit = parrotMap.erase(pit); // remove the map std::pair, incrementing the pointer
			break;
		default:
			break;
		}
	}
}

////////////////////////////////////////////////////////////////////////////////////////
// syntax helper

bool CProtocol::IsNumber(char c) const
{
	return ((c >= '0') && (c <= '9'));
}

bool CProtocol::IsLetter(char c) const
{
	return ((c >= 'A') && (c <= 'Z'));
}

bool CProtocol::IsSpace(char c) const
{
	return (c == ' ');
}

////////////////////////////////////////////////////////////////////////////////////////
// Receivers

unsigned CProtocol::Receive6(uint8_t *buf, CIp &ip, int time_ms)
{
	return m_Socket6.Receive(buf, ip, time_ms);
}

unsigned CProtocol::Receive4(uint8_t *buf, CIp &ip, int time_ms)
{
	return m_Socket4.Receive(buf, ip, time_ms);
}

unsigned CProtocol::ReceiveDS(uint8_t *buf, CIp &ip, int time_ms)
{
	auto fd4 = m_Socket4.GetSocket();
	auto fd6 = m_Socket6.GetSocket();

	if (fd4 < 0)
	{
		if (fd6 < 0)
			return false;
		return m_Socket6.Receive(buf, ip, time_ms);
	}
	else if (fd6 < 0)
		return m_Socket4.Receive(buf, ip, time_ms);

	fd_set fset;
	FD_ZERO(&fset);
	FD_SET(fd4, &fset);
	FD_SET(fd6, &fset);
	int max = (fd4 > fd6) ? fd4 : fd6;
	struct timeval tv;
	tv.tv_sec = time_ms / 1000;
	tv.tv_usec = (time_ms % 1000) * 1000;

	auto rval = select(max + 1, &fset, 0, 0, &tv);
	if (rval <= 0)
	{
		if (rval < 0)
			std::cerr << "ReceiveDS select error: " << strerror(errno) << std::endl;
		return 0;
	}

	if (FD_ISSET(fd4, &fset))
		return m_Socket4.ReceiveFrom(buf, ip);
	else
		return m_Socket6.ReceiveFrom(buf, ip);
}

////////////////////////////////////////////////////////////////////////////////////////
// dual stack sender

void CProtocol::Send(const uint8_t *buf, size_t size, const CIp &Ip) const
{
	switch (Ip.GetFamily())
	{
	case AF_INET:
		m_Socket4.Send(buf, size, Ip);
		break;
	case AF_INET6:
		m_Socket6.Send(buf, size, Ip);
		break;
	default:
		std::cerr << "ERROR: wrong family: " << Ip.GetFamily() << std::endl;
		break;
	}
}

////////////////////////////////////////////////////////////////////////////////////////
// queue helper

void CProtocol::SendToClients(CPacket &packet, const SPClient &txclient, const CCallsign &dst)
{
	// std::cout << "SendToAll DST=" << CCallsign(packet.GetCDstAddress()) << " SRC=" << CCallsign(packet.GetCSrcAddress()) << std::endl;
	// Dump(packet.GetCData(), packet.GetSize());
	//  push it to all our clients linked to the module
	SPClient client = nullptr;
	auto clients = g_Reflector.GetClients();
	auto it = clients->begin();
	const auto mod = txclient->GetReflectorModule();
	while (nullptr != (client = clients->FindNextClient(mod, it)))
	{
		if (txclient == client)
			continue; // don't send data back to the originator
		if (packet.IsStreamData())
		{
			// the client is not parroting
			if (parrotMap.end() != parrotMap.find(client))
				continue;

			const auto fromtype = packet.GetFromType();
			switch (client->GetClientType())
			{
			case EClientType::legacy:
				// reflectors will only get streaming data from simple clients
				if (EClientType::simple == fromtype)
				{
					// legacy reflectors have to be properly addressed
					// set the address and calculate the CRC
					client->GetCallsign().CodeOut(packet.GetDstAddress());
					packet.CalcCRC();
					packet.SetSize(55u);

					// one last thing, set the 55th bit to true
					const bool b = true;
					packet.GetData()[54] = uint8_t(b);

					// send this data
					client->SendPacket(packet);

					// restore the DST address and CRC
					dst.CodeOut(packet.GetDstAddress());
					packet.CalcCRC();
				}
				break;
			case EClientType::reflector:
				// reflectors will only get data from streaming client
				if (EClientType::simple == fromtype)
				{
					packet.SetSize(55u);
					packet.GetData()[54] = uint8_t(mod);
					client->SendPacket(packet);
				}
				break;
			default:
				// all local clients, simple and listen-only, get data from anywhere
				// bogus listen-only input is blocked in OnPacketIn
				packet.SetSize(54u);
				client->SendPacket(packet);
				break;
			}
		}
		else // this is packet data
		{
			const auto ct = client->GetClientType();
			switch (packet.GetFromType())
			{
			case EClientType::reflector:
				if (EClientType::simple == ct or EClientType::listenonly == ct)
				{
					// the packet has already been trimmed in GetClient()
					client->SendPacket(packet);
				}
				break;
			case EClientType::simple:
				if (EClientType::legacy == ct)
					break; // legacy reflectors don't get packet data
				if (EClientType::reflector == ct)
				{
					const auto size = packet.GetSize();
					packet.SetSize(size + 1);
					packet.GetData()[size] = uint8_t(mod);
					client->SendPacket(packet);
					packet.SetSize(size);
				}
				else
					client->SendPacket(packet);
				break;
			default:
				break;
			}
		}
	}
	g_Reflector.ReleaseClients();
}

////////////////////////////////////////////////////////////////////////////////////////
// keepalive helpers

void CProtocol::HandleKeepalives(void)
{
	uint8_t keepalive[10];
	EncodeKeepAlivePacket(keepalive);

	// iterate on clients
	auto clients = g_Reflector.GetClients();
	auto it = clients->begin();
	SPClient client;
	while (nullptr != (client = clients->FindNextClient(it)))
	{
		// don't ping reflector modules, we'll do each interlinked refectors after this while loop
		if (0 == client->GetCallsign().GetCS(4).compare("M17-"))
			continue;

		// send keepalive
		Send(keepalive, 10, client->GetIp());

		// client busy ?
		if (client->IsTransmitting())
		{
			// yes, just tickle it
			client->Alive();
		}
		// otherwise check if still with us
		else if (not client->IsAlive())
		{
			const auto type = client->GetClientType();
			if (EClientType::simple == type or EClientType::listenonly == type)
			{
				// no, disconnect
				uint8_t disconnect[10];
				EncodeDisconnectPacket(disconnect, client->GetReflectorModule());
				Send(disconnect, 10, client->GetIp());

				// remove it
				std::cout << "Client " << client->GetCallsign() << " keepalive timeout" << std::endl;
				clients->RemoveClient(client);
			}
		}
	}
	g_Reflector.ReleaseClients();

	// iterate on peers
	auto pit = g_Reflector.GetPeers().Begin();
	SPPeer peer;
	while ((peer = g_Reflector.GetPeers().FindNextPeer(pit)))
	{
		// send keepalive
		Send(keepalive, 10, peer->GetIp());

		// client busy ?
		if (peer->IsTransmitting())
		{
			// yes, just tickle it
			peer->Alive();
		}
		// otherwise check if still with us
		else if (not peer->IsAlive())
		{
			// no, disconnect
			uint8_t disconnect[10];
			EncodeDisconnectPacket(disconnect, 0);
			Send(disconnect, 10, peer->GetIp());

			// remove it
			std::cout << "Peer " << peer->GetCallsign() << " keepalive timeout" << std::endl;
			g_Reflector.GetPeers().RemovePeer(peer);
		}
	}
}

////////////////////////////////////////////////////////////////////////////////////////
// Peers helpers

void CProtocol::HandlePeerLinks(void)
{
	// check if all our connected peers are still listed in mrefd.interlink
	// if not, disconnect
	auto pit = g_Reflector.GetPeers().Begin();
	SPPeer peer = nullptr;
	while ((peer = g_Reflector.GetPeers().FindNextPeer(pit)))
	{
		const auto cs = peer->GetCallsign().GetCS();
		if (nullptr == g_Interlinks.Find(cs))
		{
			uint8_t buf[10];
			// send disconnect packet
			EncodeDisconnectPacket(buf, 0);
			Send(buf, 10, peer->GetIp());
			std::cout << "Sent disconnect packet to M17 peer " << cs << " at " << peer->GetIp() << std::endl;
			// remove client
			g_Reflector.GetPeers().RemovePeer(peer);
			publish = true;
		}
	}

	// check if all ours peers listed in mrefd.interlink are connected
	// if not, connect or reconnect
	for (auto it = g_Interlinks.begin(); it != g_Interlinks.end(); it++)
	{
		auto &item = it->second;
		const auto cs = item->GetCallsign().GetCS();
		if (item->GetIp().IsSet())
		{
			if (nullptr == g_Reflector.GetPeers().FindPeer(item->GetCallsign()))
			{
				// send connect packet to re-initiate peer link
				SInterlinkPacket connect;
				const auto mods = item->GetReqMods();
				EncodeInterlinkConnectPacket(connect, mods);
				Send(connect.magic, sizeof(SInterlinkPacket), item->GetIp());
				std::cout << "Sent connect packet to M17 peer " << item->GetCallsign() << " @ " << item->GetIp() << " for module(s) " << mods << std::endl;
			}
		}
		else
		{
#ifdef NO_DHT
			std::cerr << "ERROR: " << cs << " doesn't have a vaild IP address!" << std::endl;
#else
			if (item->IsUsingDHT())
				g_Reflector.GetDHTConfig(cs);
			else
				std::cerr << "ERROR: IP adress for " << item->GetCallsign() << " has not been initialized!" << std::endl;
#endif
		}
	}

#ifndef NO_DHT
	if (publish)
	{
		g_Reflector.PutDHTPeers();
		publish = false;
	}
#endif
}

////////////////////////////////////////////////////////////////////////////////////////
// streams helpers

// returns true if the packet is ready for distribution
bool CProtocol::OnPacketIn(CPacket &packet, const SPClient client)
{
	// if the packet dst looks like an M17 reflector, change the dst to @ALL
	CCallsign dst(packet.GetCDstAddress());
	const auto cs = dst.GetCS();
	if (0 == cs.compare(0, 4, "M17-"))
	{
		dst.CSIn("@ALL");
		dst.CodeOut(packet.GetDstAddress());
		packet.CalcCRC();
	}
	else if (std::string::npos != cs.find("PARROT"))
	{
		auto item = parrotMap.find(client);
		if (parrotMap.end() == item)
		{
			CFrameType t(packet.GetFrameType());
			if (packet.IsStreamData())
			{
				if (not packet.IsLastPacket())
				{
					const CCallsign src(packet.GetCSrcAddress());
					if (EEncryptType::none == t.GetEncryptType())
					{
						// it is not the last packet and it is a stream packet and it is not enrypted
						std::cout << "Parrot stream from " << src << " on " << client->GetCallsign() << " with SID 0x" << std::hex << packet.GetStreamId() << std::dec << " at " << client->GetIp() << std::endl;
						parrotMap[client] = std::make_unique<CStreamParrot>(packet.GetCSrcAddress(), client, packet.GetFrameType());
						parrotMap[client]->Add(packet);
					}
					else
					{
						std::cout << "Parrot stream from " << src << " on " << client->GetCallsign() << " was rejected because it was entrypted" << std::endl;
					}
				}
			}
			else
			{
				const CCallsign src(packet.GetCSrcAddress());
				std::cout << "Parrot Packet from " << src << " on " << client->GetCallsign() << " at " << client->GetIp() << std::endl;
				parrotMap[client] = std::make_unique<CPacketParrot>(packet.GetCSrcAddress(), client, packet.GetFrameType());
				parrotMap[client]->Add(packet);
				parrotMap[client]->Play();
			}
		}
		else
		{
			if (EParrotState::record == item->second->GetState())
			{
				item->second->Add(packet);
				if (packet.IsLastPacket())
				{
					std::cout << "Parrot stream 0x" << std::hex << packet.GetStreamId() << std::dec << " closed, playing..." << std::endl;
					item->second->Play();
				}
			}
		}
		return false;
	}

	// Blocking LO transmissions is now handled in the GetClient sub, but we'll leave this here for safety's sake.
	if (client->IsListenOnly())
	{
		if (packet.IsLastPacket())
			std::cerr << "Listen-only client " << client->GetCallsign() << " is sending data!" << std::endl;
		return false;
	}

	if (packet.IsStreamData())
	{
		auto stream = GetStream(packet, client);
		if (stream)
		{
			// stream already open
			// skip packet, but tickle the stream
			stream->Tickle();
		}
		else
		{
			// try to open the stream
			stream = OpenStream(packet, client);
			if (nullptr == stream)
			{
				return false;
			}
		}
	}
	return true;
}

////////////////////////////////////////////////////////////////////////////////////////
// packet decoding helpers

bool CProtocol::IsValidConnect(const uint8_t *buf, const CIp &ip, CCallsign &cs, char &mod)
{
	if (0 == memcmp(buf, "CONN", 4))
	{
		cs.CodeIn(buf + 4);
		if (std::regex_match(cs.GetCS(), clientRegEx))
		{
			mod = buf[10];
			if (IsLetter(mod))
			{
				return true;
			}
			std::cout << "Bad CONN from '" << cs.GetCS() << "'. at " << ip << std::endl;
			Dump("The requested module is not a letter:", buf, 11);
		}
		else
		{
			if (cs.GetCS(4).compare("WPSD"))
				std::cout << "CONN packet from " << ip << " rejected because '" << cs.GetCS() << "' didn't pass the regex!" << std::endl;
		}
	}
	else if (0 == memcmp(buf, "LSTN", 4))
	{
		cs.CodeIn(buf + 4);
		if (std::regex_match(cs.GetCS(), lstnRegEx))
		{
			mod = buf[10];
			if (IsLetter(mod))
			{
				return true;
			}
			std::cout << "Bad LSTN from '" << cs.GetCS() << "'. at " << ip << std::endl;
			Dump("The requested module is not a letter:", buf, 11);
		}
		else
		{
			std::cout << "LSTN packet from " << ip << " rejected because '" << cs.GetCS() << "' didn't pass the regex!" << std::endl;
		}
	}
	return false;
}

bool CProtocol::IsValidDisconnect(const uint8_t *buf, CCallsign &cs)
{
	if (0 == memcmp(buf, "DISC", 4))
	{
		cs.CodeIn(buf + 4);
		auto call = cs.GetCS();
		if (std::regex_match(call, clientRegEx) || std::regex_match(call, peerRegEx) || std::regex_match(call, lstnRegEx))
		{
			return true;
		}
	}
	return false;
}

bool CProtocol::IsValidKeepAlive(const uint8_t *buf, CCallsign &cs)
{
	if ('P' == buf[0] && ('I' == buf[1] || 'O' == buf[1]) && 'N' == buf[2] && 'G' == buf[3])
	{
		cs.CodeIn(buf + 4);
		auto call = cs.GetCS();
		if (std::regex_match(call, clientRegEx) || std::regex_match(call, peerRegEx) || std::regex_match(call, lstnRegEx))
		{
			return true;
		}
	}
	return false;
}

SPClient CProtocol::GetClient(const CIp &ip, const unsigned size, CPacket &packet, CCallsign &dst, CCallsign &src)
{
	auto buf = packet.GetCData();
	// could this be stream or packet data?
	if (memcmp(buf, "M17", 3))
		return nullptr;
	// is there a client with this address?
	auto client = g_Reflector.GetClients()->FindClient(ip);
	g_Reflector.ReleaseClients();
	if (not client)
		return nullptr;
	// is it from a client, so is this a viable packet?
	if ((' ' == char(buf[3])) and (0x1u == (0x1u & buf[19])) and ((54u == size) or (55u == size)))
	{
		packet.Initialize(size, true);
	}
	else if (('P' == char(buf[3])) and ((sizeof(SInterlinkPacket) < size) and (size <= MAX_PACKET_SIZE)) and (0x0u == (0x1u & buf[17])))
	{
		packet.Initialize(size, false);
	}
	else
	{
		return nullptr;
	}
	// get the packet callsigns
	dst.CodeIn(packet.GetCDstAddress());
	src.CodeIn(packet.GetCSrcAddress());
	// we need to make sure we have the correct client
	const auto ct = client->GetClientType();
	packet.SetFromType(ct);
	if (EClientType::listenonly == ct)
	{
		if (0 == packet.GetFrameNumber())
			std::cout << "ALERT: Listen-only client " << src.c_str() << " @ " << ip.GetAddress() << " is trying to transmit!" << std::endl;
		return nullptr;
	}
	if (EClientType::simple != ct) // if this a simple client, then we are good
	{ // this client is a reflector. we need the peer
		auto peer = g_Reflector.GetPeers().FindPeer(ip);
		if (not peer)
		{
			if (0 == packet.GetFrameNumber())
				std::cerr << "GetClient ERROR: Could not find peer at " << ip.GetAddress() << std::endl;
			return nullptr;
		}
		if (peer->GetNbClients() > 1)
		{ // this peer has more than one interlinked module
			// we have to get the right one
			char mod;
			if (EClientType::reflector == ct)
			{
				// for this kind of a reflector, the module is in the last byte, buf[size-1]
				mod = char(buf[size-1]);
			}
			else
			{
				// for a legacy reflector, the module is the module of the DST
				mod = dst.GetModule();
			}
			// because is came from a reflector, we don't need the last byte anymore
			client = peer->GetClient(mod);
			if (not client)
			{
				if (0 == packet.GetFrameNumber())
					std::cerr << "GetClient ERRPR: Band module '" << mod << "' fouund for reflector at " << ip.GetAddress() << std::endl;
				return nullptr;
			}
		}
		packet.SetSize(size - 1);
	}
	// check validity of packet
	if (std::regex_match(src.GetCS(), clientRegEx))
	{ // looks like a valid source
		const CFrameType t(packet.GetFrameType());
		if (packet.IsStreamData() and (EEncryptType::none != t.GetEncryptType()))
		{ // looks like this packet is encrypted
			const auto mod = client->GetReflectorModule();
			if (not g_CFG.IsEncyrptionAllowed(mod))
			{
				if (0 == packet.GetFrameNumber()) // we only log this once
					std::cout << "Blocking " << src.c_str() << " on module " << mod << " because it is encrypted!" << std::endl;
				return nullptr;
			}
		}
	}
	else
	{
		if (packet.IsLastPacket())
			std::cout << src.GetCS() << " Source C/S FAILED RegEx test" << std::endl;
		return nullptr;
	}
	return client;
}

EInterlinkPacketType CProtocol::GetInterlinkPacket(const uint8_t *buf, const CIp &ip, CCallsign &cs, char *mods)
{
	EInterlinkPacketType rtv;
	const SInterlinkPacket *p = (SInterlinkPacket *)buf;
	if (0 == memcmp(p->magic, "CONN", 4))
		rtv = EInterlinkPacketType::conn;
	else if (0 == memcmp(p->magic, "ACKN", 4))
		rtv = EInterlinkPacketType::ackn;
	else
		return EInterlinkPacketType::bad;

	const std::string magic((EInterlinkPacketType::conn == rtv) ? "CONN" : "ACKN");
	auto pmods = (const char *)p->mods;
	if (strnlen(pmods, 27) < 27) {
		cs.CodeIn(p->fromcs);
		auto pInterlinkItem = g_Interlinks.Find(cs.c_str());
		if (pInterlinkItem) {
			if (pInterlinkItem->GetIp().IsSet() and ip == pInterlinkItem->GetIp()) {
				const std::string rmods(CReflMods(pmods, "").GetModules());
				const std::string imods(pInterlinkItem->GetReqMods());
				if (0 == imods.compare(rmods)) {
					strcpy(mods, imods.c_str());
					return rtv;
				} else {
					std::cout << cs.c_str() << " " << magic << " packet from " << cs.GetCS() << " at " << ip << " is for '" << rmods << "' but the mrefd interlink file specifies '" << imods << "'" << std::endl;
				}
			} else {
				std::cout << magic << "request from " << ip << " does not match the address specified in the interlink file" << std::endl;
			}
		} else {
			std::cout << magic << " request from " << cs.c_str() << " at " << ip << " is not defined in the mrefd interlink file" << std::endl;
		}
	} else {
		std::cout << "Could not find a null in the mods field of a " << magic << " packet from " << cs << " at " << ip << std::endl;
	}

	return EInterlinkPacketType::bad;
}


bool CProtocol::IsValidNAcknowledge(const uint8_t *buf, CCallsign &cs)
{
	if (0 == memcmp(buf, "NACK", 4))
	{
		cs.CodeIn(buf + 4);
		return true;
	}
	return false;
}

////////////////////////////////////////////////////////////////////////////////////////
// packet encoding helpers

void CProtocol::EncodeKeepAlivePacket(uint8_t *buf)
{
	memcpy(buf, "PING", 4);
	GetReflectorCallsign().CodeOut(buf + 4);
}

void CProtocol::EncodeInterlinkConnectPacket(SInterlinkPacket &conn, const std::string &mods)
{
	memset(conn.magic, 0, sizeof(SInterlinkPacket));
	memcpy(conn.magic, "CONN", 4);
	GetReflectorCallsign().CodeOut(conn.fromcs);
	memcpy(conn.mods, mods.c_str(), mods.size());
}

void CProtocol::EncodeConnectAckPacket(uint8_t *buf)
{
	memcpy(buf, "ACKN", 4);
}

void CProtocol::EncodeInterlinkAckPacket(SInterlinkPacket &ackn, const char *mods)
{
	memset(ackn.magic, 0, sizeof(SInterlinkPacket));
	memcpy(ackn.magic, "ACKN", 4);
	GetReflectorCallsign().CodeOut(ackn.fromcs);
	memcpy(ackn.mods, mods, strlen(mods));
}

void CProtocol::EncodeInterlinkNackPacket(uint8_t *buf)
{
	memcpy(buf, "NACK", 4);
	GetReflectorCallsign().CodeOut(buf + 4);
}

void CProtocol::EncodeConnectNackPacket(uint8_t *buf)
{
	memcpy(buf, "NACK", 4);
}

void CProtocol::EncodeDisconnectPacket(uint8_t *buf, char mod)
{
	memcpy(buf, "DISC", 4);
	CCallsign cs(GetReflectorCallsign());
	if (mod)
		cs.SetModule(mod);
	cs.CodeOut(buf + 4);
}

void CProtocol::EncodeDisconnectedPacket(uint8_t *buf)
{
	memcpy(buf, "DISC", 4);
}

CPacketStream *CProtocol::OpenStream(CPacket &packet, SPClient client)
{
	// if it is a stream packet, check sid is not zero
	if (packet.IsStreamData() and 0U == packet.GetStreamId())
	{
		std::cerr << "Incoming stream has zero streamID" << std::endl;
		return nullptr;
	}

	if (client->IsTransmitting())
	{
		std::cerr << "Client " << client->GetCallsign() << " is already transmitting" << std::endl;
		return nullptr;
	}

	// get the module's packet stream queue
	const char module = client->GetReflectorModule();

	if (packet.IsStreamData())
	{
		// check if no stream with same streamid already open
		// to prevent loops
		for (auto &pit : m_streamMap)
		{
			if (pit.second->IsOpen() and (packet.GetStreamId() == pit.second->GetPacketStreamId()))
			{
				std::cerr << "Detected stream loop on module " << module << " for client " << client->GetCallsign() << " with sid " << packet.GetStreamId() << std::endl;
				return nullptr;
			}
		}
	}

	auto pit = m_streamMap.find(module);
	if (m_streamMap.end() == pit)
	{
		std::cerr << "Can't get stream from module '" << module << "'" << std::endl;
		return nullptr;
	}

	// is it available ?
	if (pit->second->OpenPacketStream(packet, client))
	{
		// stream open, mark client as master
		// so that it can't be deleted
		client->SetTX();

		// update last heard time
		client->Heard();

		// report
		const CCallsign src(packet.GetCSrcAddress());
		if (packet.IsStreamData())
			std::cout << "Opening stream on module " << module << " from client " << client->GetCallsign() << " with id 0x" << std::hex << packet.GetStreamId() << std::dec << " by user " << src << std::endl;
		else
			std::cout << "Packet data on module " << module << " from client " << client->GetCallsign() << " by user " << src << std::endl;

		// and push the packet
		pit->second->Tickle();
		return pit->second.get();
	}
	return nullptr;
}

void CProtocol::CloseStream(char module)
{
	if (not g_CFG.IsValidModule(module))
	{
		Dump("CProtocol::CloseStream can find module:", &module, 1);
		return;
	}
	auto pit = m_streamMap.find(module);
	if (m_streamMap.end() == pit)
	{
		return;
	}
	auto stream = pit->second.get();
	if (stream)
	{
		g_Reflector.GetClients(); // lock clients

		// get and check the master
		SPClient client = stream->GetOwnerClient();
		if (client != nullptr)
		{
			// client no longer a master
			client->ClearTX();

			std::cout << "Closing stream on module " << module << std::endl;
		}

		// release clients
		g_Reflector.ReleaseClients();

		// and stop the queue
		stream->ClosePacketStream();
	}
}