Add the LICH processing.
This commit is contained in:
parent
a00ecbe7d9
commit
c549cf3594
|
@ -45,9 +45,9 @@ const unsigned int INTERLEAVER[] = {
|
||||||
8U, 145U, 98U, 235U, 188U, 325U, 278U, 47U};
|
8U, 145U, 98U, 235U, 188U, 325U, 278U, 47U};
|
||||||
|
|
||||||
const unsigned char SCRAMBLER[] = {
|
const unsigned char SCRAMBLER[] = {
|
||||||
0xD6U, 0xB5U, 0xE2U, 0x30U, 0x82U, 0xFFU, 0x84U, 0x62U, 0xBAU, 0x4EU, 0x96U, 0x90U, 0xD8U, 0x98U, 0xDDU, 0x5DU, 0x0CU,
|
0x00U, 0x00U, 0xD6U, 0xB5U, 0xE2U, 0x30U, 0x82U, 0xFFU, 0x84U, 0x62U, 0xBAU, 0x4EU, 0x96U, 0x90U, 0xD8U, 0x98U, 0xDDU,
|
||||||
0xC8U, 0x52U, 0x43U, 0x91U, 0x1DU, 0xF8U, 0x6EU, 0x68U, 0x2FU, 0x35U, 0xDAU, 0x14U, 0xEAU, 0xCDU, 0x76U, 0x19U, 0x8DU,
|
0x5DU, 0x0CU, 0xC8U, 0x52U, 0x43U, 0x91U, 0x1DU, 0xF8U, 0x6EU, 0x68U, 0x2FU, 0x35U, 0xDAU, 0x14U, 0xEAU, 0xCDU, 0x76U,
|
||||||
0xD5U, 0x80U, 0xD1U, 0x33U, 0x87U, 0x13U, 0x57U, 0x18U, 0x2DU, 0x29U, 0x78U, 0xC3U};
|
0x19U, 0x8DU, 0xD5U, 0x80U, 0xD1U, 0x33U, 0x87U, 0x13U, 0x57U, 0x18U, 0x2DU, 0x29U, 0x78U, 0xC3U};
|
||||||
|
|
||||||
// #define DUMP_M17
|
// #define DUMP_M17
|
||||||
|
|
||||||
|
@ -417,7 +417,7 @@ bool CM17Control::writeModem(unsigned char* data, unsigned int len)
|
||||||
|
|
||||||
unsigned char netData[M17_LICH_LENGTH_BYTES + M17_FN_LENGTH_BYTES + M17_PAYLOAD_LENGTH_BYTES + M17_CRC_LENGTH_BYTES];
|
unsigned char netData[M17_LICH_LENGTH_BYTES + M17_FN_LENGTH_BYTES + M17_PAYLOAD_LENGTH_BYTES + M17_CRC_LENGTH_BYTES];
|
||||||
|
|
||||||
m_rfLICH.getNetworkData(netData + 0U);
|
m_rfLICH.getNetwork(netData + 0U);
|
||||||
|
|
||||||
// Copy the FN and payload from the frame
|
// Copy the FN and payload from the frame
|
||||||
::memcpy(netData + M17_LICH_LENGTH_BYTES, frame, M17_FN_LENGTH_BYTES + M17_PAYLOAD_LENGTH_BYTES);
|
::memcpy(netData + M17_LICH_LENGTH_BYTES, frame, M17_FN_LENGTH_BYTES + M17_PAYLOAD_LENGTH_BYTES);
|
||||||
|
@ -507,7 +507,7 @@ void CM17Control::writeNetwork()
|
||||||
m_networkWatchdog.start();
|
m_networkWatchdog.start();
|
||||||
|
|
||||||
if (m_netState == RS_NET_IDLE) {
|
if (m_netState == RS_NET_IDLE) {
|
||||||
m_netLICH.setNetworkData(netData);
|
m_netLICH.setNetwork(netData);
|
||||||
|
|
||||||
std::string source = m_netLICH.getSource();
|
std::string source = m_netLICH.getSource();
|
||||||
std::string dest = m_netLICH.getDest();
|
std::string dest = m_netLICH.getDest();
|
||||||
|
@ -725,8 +725,9 @@ void CM17Control::decorrelator(const unsigned char* in, unsigned char* out) cons
|
||||||
assert(in != NULL);
|
assert(in != NULL);
|
||||||
assert(out != NULL);
|
assert(out != NULL);
|
||||||
|
|
||||||
for (unsigned int i = M17_SYNC_LENGTH_BYTES; i < M17_FRAME_LENGTH_BYTES; i++)
|
for (unsigned int i = M17_SYNC_LENGTH_BYTES; i < M17_FRAME_LENGTH_BYTES; i++) {
|
||||||
out[i] = in[i] ^ SCRAMBLER[i - M17_SYNC_LENGTH_BYTES];
|
out[i] = in[i] ^ SCRAMBLER[i];
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
bool CM17Control::openFile()
|
bool CM17Control::openFile()
|
||||||
|
|
160
M17LICH.cpp
Normal file
160
M17LICH.cpp
Normal file
|
@ -0,0 +1,160 @@
|
||||||
|
/*
|
||||||
|
* Copyright (C) 2020 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.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "M17LICH.h"
|
||||||
|
#include "M17Utils.h"
|
||||||
|
#include "M17CRC.h"
|
||||||
|
|
||||||
|
#include <cassert>
|
||||||
|
|
||||||
|
CM17LICH::CM17LICH(const CM17LICH& lich) :
|
||||||
|
m_lich(NULL),
|
||||||
|
m_valid(false)
|
||||||
|
{
|
||||||
|
m_lich = new unsigned char[30U];
|
||||||
|
|
||||||
|
::memcpy(m_lich, lich.m_lich, 30U);
|
||||||
|
|
||||||
|
m_valid = lich.m_valid;
|
||||||
|
}
|
||||||
|
|
||||||
|
CM17LICH::CM17LICH() :
|
||||||
|
m_lich(NULL),
|
||||||
|
m_valid(false)
|
||||||
|
{
|
||||||
|
m_lich = new unsigned char[30U];
|
||||||
|
}
|
||||||
|
|
||||||
|
CM17LICH::~CM17LICH()
|
||||||
|
{
|
||||||
|
delete[] m_lich;
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::getNetwork(unsigned char* data) const
|
||||||
|
{
|
||||||
|
assert(data != NULL);
|
||||||
|
|
||||||
|
::memcpy(data, m_lich, 28U);
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::setNetwork(const unsigned char* data)
|
||||||
|
{
|
||||||
|
assert(data != NULL);
|
||||||
|
|
||||||
|
::memcpy(m_lich, data, 28U);
|
||||||
|
|
||||||
|
m_valid = true;
|
||||||
|
}
|
||||||
|
|
||||||
|
std::string CM17LICH::getSource() const
|
||||||
|
{
|
||||||
|
if (!m_valid)
|
||||||
|
return "";
|
||||||
|
|
||||||
|
std::string callsign;
|
||||||
|
CM17Utils::decodeCallsign(m_lich + 6U, callsign);
|
||||||
|
|
||||||
|
return callsign;
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::setSource(const std::string& callsign)
|
||||||
|
{
|
||||||
|
CM17Utils::encodeCallsign(callsign, m_lich + 6U);
|
||||||
|
}
|
||||||
|
|
||||||
|
std::string CM17LICH::getDest() const
|
||||||
|
{
|
||||||
|
if (!m_valid)
|
||||||
|
return "";
|
||||||
|
|
||||||
|
std::string callsign;
|
||||||
|
CM17Utils::decodeCallsign(m_lich + 0U, callsign);
|
||||||
|
|
||||||
|
return callsign;
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::setDest(const std::string& callsign)
|
||||||
|
{
|
||||||
|
CM17Utils::encodeCallsign(callsign, m_lich + 0U);
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned char CM17LICH::getDataType() const
|
||||||
|
{
|
||||||
|
if (!m_valid)
|
||||||
|
return 0U;
|
||||||
|
|
||||||
|
return (m_lich[12U] >> 1) & 0x03U;
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::setDataType(unsigned char type)
|
||||||
|
{
|
||||||
|
m_lich[12U] &= 0xF9U;
|
||||||
|
m_lich[12U] |= (type << 1) & 0x06U;
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::reset()
|
||||||
|
{
|
||||||
|
::memset(m_lich, 0x00U, 30U);
|
||||||
|
|
||||||
|
m_valid = false;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool CM17LICH::isValid() const
|
||||||
|
{
|
||||||
|
return m_valid;
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::getLinkSetup(unsigned char* data) const
|
||||||
|
{
|
||||||
|
assert(data != NULL);
|
||||||
|
|
||||||
|
::memcpy(data, m_lich, 30U);
|
||||||
|
|
||||||
|
CM17CRC::encodeCRC(data, 30U);
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::setLinkSetup(const unsigned char* data)
|
||||||
|
{
|
||||||
|
assert(data != NULL);
|
||||||
|
|
||||||
|
::memcpy(m_lich, data, 30U);
|
||||||
|
|
||||||
|
m_valid = CM17CRC::checkCRC(m_lich, 30U);
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::getFragment(unsigned char* data, unsigned short fn) const
|
||||||
|
{
|
||||||
|
assert(data != NULL);
|
||||||
|
|
||||||
|
CM17CRC::encodeCRC(m_lich, 30U);
|
||||||
|
|
||||||
|
unsigned int n = (fn & 0x7FFFU) % 5U;
|
||||||
|
|
||||||
|
::memcpy(data, m_lich + (n * 6U), 6U);
|
||||||
|
}
|
||||||
|
|
||||||
|
void CM17LICH::setFragment(const unsigned char* data, unsigned short fn)
|
||||||
|
{
|
||||||
|
assert(data != NULL);
|
||||||
|
|
||||||
|
unsigned int n = (fn & 0x7FFFU) % 5U;
|
||||||
|
|
||||||
|
::memcpy(m_lich + (n * 6U), data, 6U);
|
||||||
|
|
||||||
|
m_valid = CM17CRC::checkCRC(m_lich, 30U);
|
||||||
|
}
|
|
@ -27,8 +27,8 @@ public:
|
||||||
CM17LICH();
|
CM17LICH();
|
||||||
~CM17LICH();
|
~CM17LICH();
|
||||||
|
|
||||||
void getNetworkData(unsigned char* data);
|
void getNetwork(unsigned char* data) const;
|
||||||
void setNetworkData(const unsigned char* data);
|
void setNetwork(const unsigned char* data);
|
||||||
|
|
||||||
std::string getSource() const;
|
std::string getSource() const;
|
||||||
void setSource(const std::string& callsign);
|
void setSource(const std::string& callsign);
|
||||||
|
@ -43,15 +43,16 @@ public:
|
||||||
bool isValid() const;
|
bool isValid() const;
|
||||||
|
|
||||||
void getLinkSetup(unsigned char* data) const;
|
void getLinkSetup(unsigned char* data) const;
|
||||||
void setLinkSetup(const unsigned char* data) const;
|
void setLinkSetup(const unsigned char* data);
|
||||||
|
|
||||||
void getFragment(unsigned char* data, unsigned short fn);
|
void getFragment(unsigned char* data, unsigned short fn) const;
|
||||||
void setFragment(const unsigned char* data, unsigned short fn);
|
void setFragment(const unsigned char* data, unsigned short fn);
|
||||||
|
|
||||||
CM17LICH& operator=(const CM17LICH& lich);
|
CM17LICH& operator=(const CM17LICH& lich);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
unsigned char* m_lich;
|
unsigned char* m_lich;
|
||||||
|
bool m_valid;
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -31,7 +31,6 @@
|
||||||
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(const std::string& callsign, unsigned int port, bool debug) :
|
||||||
m_callsign(callsign),
|
|
||||||
m_socket(port),
|
m_socket(port),
|
||||||
m_addr(),
|
m_addr(),
|
||||||
m_addrLen(0U),
|
m_addrLen(0U),
|
||||||
|
@ -52,7 +51,11 @@ m_timer(1000U, 5U)
|
||||||
|
|
||||||
m_encoded = new unsigned char[6U];
|
m_encoded = new unsigned char[6U];
|
||||||
|
|
||||||
CM17Utils::encodeCallsign(m_callsign, m_encoded);
|
std::string call = callsign;
|
||||||
|
call.resize(8U, ' ');
|
||||||
|
call += "D";
|
||||||
|
|
||||||
|
CM17Utils::encodeCallsign(call, m_encoded);
|
||||||
}
|
}
|
||||||
|
|
||||||
CM17Network::~CM17Network()
|
CM17Network::~CM17Network()
|
||||||
|
|
|
@ -58,7 +58,6 @@ public:
|
||||||
void clock(unsigned int ms);
|
void clock(unsigned int ms);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
std::string m_callsign;
|
|
||||||
CUDPSocket m_socket;
|
CUDPSocket m_socket;
|
||||||
sockaddr_storage m_addr;
|
sockaddr_storage m_addr;
|
||||||
unsigned int m_addrLen;
|
unsigned int m_addrLen;
|
||||||
|
|
|
@ -292,6 +292,7 @@
|
||||||
<ClCompile Include="Log.cpp" />
|
<ClCompile Include="Log.cpp" />
|
||||||
<ClCompile Include="M17Control.cpp" />
|
<ClCompile Include="M17Control.cpp" />
|
||||||
<ClCompile Include="M17CRC.cpp" />
|
<ClCompile Include="M17CRC.cpp" />
|
||||||
|
<ClCompile Include="M17LICH.cpp" />
|
||||||
<ClCompile Include="M17Network.cpp" />
|
<ClCompile Include="M17Network.cpp" />
|
||||||
<ClCompile Include="MMDVMHost.cpp" />
|
<ClCompile Include="MMDVMHost.cpp" />
|
||||||
<ClCompile Include="Modem.cpp" />
|
<ClCompile Include="Modem.cpp" />
|
||||||
|
|
|
@ -595,5 +595,8 @@
|
||||||
<ClCompile Include="M17Utils.cpp">
|
<ClCompile Include="M17Utils.cpp">
|
||||||
<Filter>Source Files</Filter>
|
<Filter>Source Files</Filter>
|
||||||
</ClCompile>
|
</ClCompile>
|
||||||
|
<ClCompile Include="M17LICH.cpp">
|
||||||
|
<Filter>Source Files</Filter>
|
||||||
|
</ClCompile>
|
||||||
</ItemGroup>
|
</ItemGroup>
|
||||||
</Project>
|
</Project>
|
Loading…
Reference in a new issue