mirror of
https://github.com/g4klx/MMDVMHost
synced 2025-12-21 23:45:49 +08:00
Convert M17 to use the new M17 Gateway.
This commit is contained in:
169
M17Network.cpp
169
M17Network.cpp
@@ -29,8 +29,8 @@
|
|||||||
|
|
||||||
const unsigned int BUFFER_LENGTH = 200U;
|
const unsigned int BUFFER_LENGTH = 200U;
|
||||||
|
|
||||||
CM17Network::CM17Network(const std::string& callsign, unsigned int port, bool debug) :
|
CM17Network::CM17Network(unsigned int localPort, const std::string& gwyAddress, unsigned int gwyPort, bool debug) :
|
||||||
m_socket(port),
|
m_socket(localPort),
|
||||||
m_addr(),
|
m_addr(),
|
||||||
m_addrLen(0U),
|
m_addrLen(0U),
|
||||||
m_debug(debug),
|
m_debug(debug),
|
||||||
@@ -39,69 +39,44 @@ m_outId(0U),
|
|||||||
m_inId(0U),
|
m_inId(0U),
|
||||||
m_buffer(1000U, "M17 Network"),
|
m_buffer(1000U, "M17 Network"),
|
||||||
m_random(),
|
m_random(),
|
||||||
m_state(M17N_NOTLINKED),
|
|
||||||
m_encoded(NULL),
|
|
||||||
m_module(' '),
|
|
||||||
m_timer(1000U, 5U)
|
m_timer(1000U, 5U)
|
||||||
{
|
{
|
||||||
|
if (CUDPSocket::lookup(gwyAddress, gwyPort, m_addr, m_addrLen) != 0) {
|
||||||
|
m_addrLen = 0U;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
std::random_device rd;
|
std::random_device rd;
|
||||||
std::mt19937 mt(rd());
|
std::mt19937 mt(rd());
|
||||||
m_random = mt;
|
m_random = mt;
|
||||||
|
|
||||||
m_encoded = new unsigned char[6U];
|
|
||||||
|
|
||||||
std::string call = callsign;
|
|
||||||
call.resize(8U, ' ');
|
|
||||||
call += "D";
|
|
||||||
|
|
||||||
CM17Utils::encodeCallsign(call, m_encoded);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
CM17Network::~CM17Network()
|
CM17Network::~CM17Network()
|
||||||
{
|
{
|
||||||
delete[] m_encoded;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
bool CM17Network::open()
|
bool CM17Network::open()
|
||||||
{
|
{
|
||||||
LogMessage("Opening M17 network connection");
|
if (m_addrLen == 0U) {
|
||||||
|
LogError("M17, unable to resolve the gateway address");
|
||||||
return m_socket.open(m_addr);
|
|
||||||
}
|
|
||||||
|
|
||||||
bool CM17Network::link(const std::string& address, unsigned int port, char module)
|
|
||||||
{
|
|
||||||
if (CUDPSocket::lookup(address, port, m_addr, m_addrLen) != 0) {
|
|
||||||
m_state = M17N_NOTLINKED;
|
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
m_module = module;
|
LogMessage("Opening M17 network connection");
|
||||||
|
|
||||||
m_state = M17N_LINKING;
|
bool ret = m_socket.open(m_addr);
|
||||||
|
|
||||||
sendConnect();
|
if (ret) {
|
||||||
|
m_timer.start();
|
||||||
m_timer.start();
|
return true;
|
||||||
|
} else {
|
||||||
return true;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
void CM17Network::unlink()
|
|
||||||
{
|
|
||||||
if (m_state != M17N_LINKED)
|
|
||||||
return;
|
|
||||||
|
|
||||||
m_state = M17N_UNLINKING;
|
|
||||||
|
|
||||||
sendConnect();
|
|
||||||
|
|
||||||
m_timer.start();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
bool CM17Network::write(const unsigned char* data)
|
bool CM17Network::write(const unsigned char* data)
|
||||||
{
|
{
|
||||||
if (m_state != M17N_LINKED)
|
if (m_addrLen != 0U)
|
||||||
return false;
|
return false;
|
||||||
|
|
||||||
assert(data != NULL);
|
assert(data != NULL);
|
||||||
@@ -138,19 +113,8 @@ void CM17Network::clock(unsigned int ms)
|
|||||||
{
|
{
|
||||||
m_timer.clock(ms);
|
m_timer.clock(ms);
|
||||||
if (m_timer.isRunning() && m_timer.hasExpired()) {
|
if (m_timer.isRunning() && m_timer.hasExpired()) {
|
||||||
switch (m_state) {
|
sendPing();
|
||||||
case M17N_LINKING:
|
m_timer.start();
|
||||||
sendConnect();
|
|
||||||
m_timer.start();
|
|
||||||
break;
|
|
||||||
case M17N_UNLINKING:
|
|
||||||
sendDisconnect();
|
|
||||||
m_timer.start();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
m_timer.stop();
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
unsigned char buffer[BUFFER_LENGTH];
|
unsigned char buffer[BUFFER_LENGTH];
|
||||||
@@ -169,36 +133,12 @@ void CM17Network::clock(unsigned int ms)
|
|||||||
if (m_debug)
|
if (m_debug)
|
||||||
CUtils::dump(1U, "M17 Network Data Received", buffer, length);
|
CUtils::dump(1U, "M17 Network Data Received", buffer, length);
|
||||||
|
|
||||||
if (::memcmp(buffer + 0U, "ACKN", 4U) == 0) {
|
|
||||||
m_timer.stop();
|
|
||||||
m_state = M17N_LINKED;
|
|
||||||
LogMessage("M17, linked to reflector");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (::memcmp(buffer + 0U, "NACK", 4U) == 0) {
|
|
||||||
m_timer.stop();
|
|
||||||
m_state = M17N_NOTLINKED;
|
|
||||||
LogMessage("M17, link refused by reflector");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (::memcmp(buffer + 0U, "DISC", 4U) == 0) {
|
|
||||||
m_timer.stop();
|
|
||||||
m_state = M17N_NOTLINKED;
|
|
||||||
LogMessage("M17, unlinked from reflector");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (::memcmp(buffer + 0U, "PING", 4U) == 0) {
|
|
||||||
if (m_state == M17N_LINKED)
|
|
||||||
sendPong();
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (!m_enabled)
|
if (!m_enabled)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
|
if (::memcmp(buffer + 0U, "PING", 4U) == 0)
|
||||||
|
return;
|
||||||
|
|
||||||
if (::memcmp(buffer + 0U, "M17 ", 4U) != 0) {
|
if (::memcmp(buffer + 0U, "M17 ", 4U) != 0) {
|
||||||
CUtils::dump(2U, "M17, received unknown packet", buffer, length);
|
CUtils::dump(2U, "M17, received unknown packet", buffer, length);
|
||||||
return;
|
return;
|
||||||
@@ -254,70 +194,17 @@ void CM17Network::enable(bool enabled)
|
|||||||
m_enabled = enabled;
|
m_enabled = enabled;
|
||||||
}
|
}
|
||||||
|
|
||||||
void CM17Network::sendConnect()
|
void CM17Network::sendPing()
|
||||||
{
|
{
|
||||||
unsigned char buffer[15U];
|
unsigned char buffer[5U];
|
||||||
|
|
||||||
buffer[0U] = 'C';
|
|
||||||
buffer[1U] = 'O';
|
|
||||||
buffer[2U] = 'N';
|
|
||||||
buffer[3U] = 'N';
|
|
||||||
|
|
||||||
buffer[4U] = m_encoded[0U];
|
|
||||||
buffer[5U] = m_encoded[1U];
|
|
||||||
buffer[6U] = m_encoded[2U];
|
|
||||||
buffer[7U] = m_encoded[3U];
|
|
||||||
buffer[8U] = m_encoded[4U];
|
|
||||||
buffer[9U] = m_encoded[5U];
|
|
||||||
|
|
||||||
buffer[10U] = m_module;
|
|
||||||
|
|
||||||
if (m_debug)
|
|
||||||
CUtils::dump(1U, "M17 data transmitted", buffer, 11U);
|
|
||||||
|
|
||||||
m_socket.write(buffer, 11U, m_addr, m_addrLen);
|
|
||||||
}
|
|
||||||
|
|
||||||
void CM17Network::sendPong()
|
|
||||||
{
|
|
||||||
unsigned char buffer[15U];
|
|
||||||
|
|
||||||
buffer[0U] = 'P';
|
buffer[0U] = 'P';
|
||||||
buffer[1U] = 'O';
|
buffer[1U] = 'I';
|
||||||
buffer[2U] = 'N';
|
buffer[2U] = 'N';
|
||||||
buffer[3U] = 'G';
|
buffer[3U] = 'G';
|
||||||
|
|
||||||
buffer[4U] = m_encoded[0U];
|
|
||||||
buffer[5U] = m_encoded[1U];
|
|
||||||
buffer[6U] = m_encoded[2U];
|
|
||||||
buffer[7U] = m_encoded[3U];
|
|
||||||
buffer[8U] = m_encoded[4U];
|
|
||||||
buffer[9U] = m_encoded[5U];
|
|
||||||
|
|
||||||
if (m_debug)
|
if (m_debug)
|
||||||
CUtils::dump(1U, "M17 data transmitted", buffer, 10U);
|
CUtils::dump(1U, "M17 data transmitted", buffer, 4U);
|
||||||
|
|
||||||
m_socket.write(buffer, 10U, m_addr, m_addrLen);
|
m_socket.write(buffer, 4U, m_addr, m_addrLen);
|
||||||
}
|
|
||||||
|
|
||||||
void CM17Network::sendDisconnect()
|
|
||||||
{
|
|
||||||
unsigned char buffer[15U];
|
|
||||||
|
|
||||||
buffer[0U] = 'D';
|
|
||||||
buffer[1U] = 'I';
|
|
||||||
buffer[2U] = 'S';
|
|
||||||
buffer[3U] = 'C';
|
|
||||||
|
|
||||||
buffer[4U] = m_encoded[0U];
|
|
||||||
buffer[5U] = m_encoded[1U];
|
|
||||||
buffer[6U] = m_encoded[2U];
|
|
||||||
buffer[7U] = m_encoded[3U];
|
|
||||||
buffer[8U] = m_encoded[4U];
|
|
||||||
buffer[9U] = m_encoded[5U];
|
|
||||||
|
|
||||||
if (m_debug)
|
|
||||||
CUtils::dump(1U, "M17 data transmitted", buffer, 10U);
|
|
||||||
|
|
||||||
m_socket.write(buffer, 10U, m_addr, m_addrLen);
|
|
||||||
}
|
}
|
||||||
|
|||||||
20
M17Network.h
20
M17Network.h
@@ -27,24 +27,13 @@
|
|||||||
#include <random>
|
#include <random>
|
||||||
#include <cstdint>
|
#include <cstdint>
|
||||||
|
|
||||||
enum M17NET_STATUS {
|
|
||||||
M17N_NOTLINKED,
|
|
||||||
M17N_LINKING,
|
|
||||||
M17N_LINKED,
|
|
||||||
M17N_UNLINKING
|
|
||||||
};
|
|
||||||
|
|
||||||
class CM17Network {
|
class CM17Network {
|
||||||
public:
|
public:
|
||||||
CM17Network(const std::string& callsign, unsigned int port, bool debug);
|
CM17Network(unsigned int localPort, const std::string& gwyAddress, unsigned int gwyPort, bool debug);
|
||||||
~CM17Network();
|
~CM17Network();
|
||||||
|
|
||||||
bool open();
|
bool open();
|
||||||
|
|
||||||
bool link(const std::string& address, unsigned int port, char module);
|
|
||||||
|
|
||||||
void unlink();
|
|
||||||
|
|
||||||
void enable(bool enabled);
|
void enable(bool enabled);
|
||||||
|
|
||||||
bool write(const unsigned char* data);
|
bool write(const unsigned char* data);
|
||||||
@@ -67,14 +56,9 @@ private:
|
|||||||
uint16_t m_inId;
|
uint16_t m_inId;
|
||||||
CRingBuffer<unsigned char> m_buffer;
|
CRingBuffer<unsigned char> m_buffer;
|
||||||
std::mt19937 m_random;
|
std::mt19937 m_random;
|
||||||
M17NET_STATUS m_state;
|
|
||||||
unsigned char* m_encoded;
|
|
||||||
char m_module;
|
|
||||||
CTimer m_timer;
|
CTimer m_timer;
|
||||||
|
|
||||||
void sendConnect();
|
void sendPing();
|
||||||
void sendDisconnect();
|
|
||||||
void sendPong();
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
@@ -226,9 +226,9 @@ Debug=0
|
|||||||
|
|
||||||
[M17 Network]
|
[M17 Network]
|
||||||
Enable=1
|
Enable=1
|
||||||
GatewayAddress=3.138.122.152
|
GatewayAddress=127.0.0.1
|
||||||
GatewayPort=17000
|
GatewayPort=17010
|
||||||
LocalPort=17000
|
LocalPort=17011
|
||||||
# ModeHang=3
|
# ModeHang=3
|
||||||
Debug=0
|
Debug=0
|
||||||
|
|
||||||
|
|||||||
@@ -1556,7 +1556,7 @@ bool CMMDVMHost::createM17Network()
|
|||||||
LogInfo(" Local Port: %u", localPort);
|
LogInfo(" Local Port: %u", localPort);
|
||||||
LogInfo(" Mode Hang: %us", m_m17NetModeHang);
|
LogInfo(" Mode Hang: %us", m_m17NetModeHang);
|
||||||
|
|
||||||
m_m17Network = new CM17Network(m_callsign, localPort, debug);
|
m_m17Network = new CM17Network(localPort, gatewayAddress, gatewayPort, debug);
|
||||||
bool ret = m_m17Network->open();
|
bool ret = m_m17Network->open();
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
delete m_m17Network;
|
delete m_m17Network;
|
||||||
@@ -1564,8 +1564,6 @@ bool CMMDVMHost::createM17Network()
|
|||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
m_m17Network->link(gatewayAddress, gatewayPort, 'A');
|
|
||||||
|
|
||||||
m_m17Network->enable(true);
|
m_m17Network->enable(true);
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
|
|||||||
Reference in New Issue
Block a user