Bryan Biedenkapp
4 years ago
parent
820753a815
commit
4cef6e5aea
@ -1,222 +0,0 @@
|
||||
/**
|
||||
* Digital Voice Modem - Host Software
|
||||
* GPLv2 Open Source. Use is subject to license terms.
|
||||
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
||||
*
|
||||
* @package DVM / Host Software
|
||||
*
|
||||
*/
|
||||
//
|
||||
// Based on code from the MMDVMHost project. (https://github.com/g4klx/MMDVMHost)
|
||||
// Licensed under the GPLv2 License (https://opensource.org/licenses/GPL-2.0)
|
||||
//
|
||||
/*
|
||||
* Copyright (C) 2018 by Jonathan Naylor G4KLX
|
||||
* Copyright (C) 2022 by Bryan Biedenkapp N2PLL
|
||||
*
|
||||
* 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 "nxdn/NXDNDefines.h"
|
||||
#include "nxdn/data/Layer3.h"
|
||||
#include "Utils.h"
|
||||
|
||||
using namespace nxdn;
|
||||
using namespace nxdn::data;
|
||||
|
||||
#include <cstdio>
|
||||
#include <cassert>
|
||||
#include <cstring>
|
||||
|
||||
// ---------------------------------------------------------------------------
|
||||
// Public Class Members
|
||||
// ---------------------------------------------------------------------------
|
||||
|
||||
/// <summary>
|
||||
/// Initializes a copy instance of the Layer3 class.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
Layer3::Layer3(const Layer3& data) :
|
||||
m_verbose(false),
|
||||
m_messageType(MESSAGE_TYPE_IDLE),
|
||||
m_srcId(0U),
|
||||
m_dstId(0U),
|
||||
m_group(true),
|
||||
m_dataBlocks(0U),
|
||||
m_data(NULL)
|
||||
{
|
||||
m_data = new uint8_t[22U];
|
||||
::memcpy(m_data, data.m_data, 22U);
|
||||
|
||||
m_messageType = m_data[0U] & 0x3FU; // Message Type
|
||||
|
||||
m_group = (m_data[2U] & 0x80U) != 0x80U;
|
||||
|
||||
m_srcId = (m_data[3U] << 8) | m_data[4U]; // Source Radio Address
|
||||
m_dstId = (m_data[5U] << 8) | m_data[6U]; // Target Radio Address
|
||||
|
||||
m_dataBlocks = (m_data[8U] & 0x0FU) + 1U; // Data Blocks
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Initializes a new instance of the Layer3 class.
|
||||
/// </summary>
|
||||
Layer3::Layer3() :
|
||||
m_verbose(false),
|
||||
m_messageType(MESSAGE_TYPE_IDLE),
|
||||
m_srcId(0U),
|
||||
m_dstId(0U),
|
||||
m_group(true),
|
||||
m_dataBlocks(0U),
|
||||
m_data(NULL)
|
||||
{
|
||||
m_data = new uint8_t[22U];
|
||||
::memset(m_data, 0x00U, 22U);
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Finalizes a instance of Layer3 class.
|
||||
/// </summary>
|
||||
Layer3::~Layer3()
|
||||
{
|
||||
delete[] m_data;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Equals operator.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <returns></returns>
|
||||
Layer3& Layer3::operator=(const Layer3& data)
|
||||
{
|
||||
if (&data != this) {
|
||||
::memcpy(m_data, data.m_data, 22U);
|
||||
|
||||
m_verbose = data.m_verbose;
|
||||
|
||||
m_messageType = data.m_messageType;
|
||||
|
||||
m_group = data.m_group;
|
||||
|
||||
m_srcId = data.m_srcId;
|
||||
m_dstId = data.m_dstId;
|
||||
|
||||
m_dataBlocks = m_dataBlocks;
|
||||
}
|
||||
|
||||
return *this;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Decode layer 3 data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <returns>True, if SACCH was decoded, otherwise false.</returns>
|
||||
void Layer3::decode(const uint8_t* data, uint32_t length, uint32_t offset)
|
||||
{
|
||||
assert(data != NULL);
|
||||
|
||||
for (uint32_t i = 0U; i < length; i++, offset++) {
|
||||
bool b = READ_BIT(data, i);
|
||||
WRITE_BIT(m_data, offset, b);
|
||||
}
|
||||
|
||||
if (m_verbose) {
|
||||
Utils::dump(2U, "Decoded Layer 3 Data", m_data, 22U);
|
||||
}
|
||||
|
||||
m_messageType = m_data[0U] & 0x3FU; // Message Type
|
||||
|
||||
m_group = (m_data[2U] & 0x80U) != 0x80U;
|
||||
|
||||
m_srcId = (m_data[3U] << 8) | m_data[4U]; // Source Radio Address
|
||||
m_dstId = (m_data[5U] << 8) | m_data[6U]; // Target Radio Address
|
||||
|
||||
m_dataBlocks = (m_data[8U] & 0x0FU) + 1U; // Data Blocks
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Encode layer 3 data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
void Layer3::encode(uint8_t* data, uint32_t length, uint32_t offset)
|
||||
{
|
||||
assert(data != NULL);
|
||||
|
||||
m_data[0U] = m_messageType & 0x3FU; // Message Type
|
||||
|
||||
m_data[2U] = (m_group ? 0x80U : 0x00U);
|
||||
|
||||
m_data[3U] = (m_srcId >> 8U) & 0xFFU; // Source Radio Address
|
||||
m_data[4U] = (m_srcId >> 0U) & 0xFFU; // ...
|
||||
m_data[5U] = (m_dstId >> 8U) & 0xFFU; // Target Radio Address
|
||||
m_data[6U] = (m_dstId >> 0U) & 0xFFU; // ...
|
||||
|
||||
m_data[8U] = m_dataBlocks & 0x0FU; // Data Blocks
|
||||
|
||||
for (uint32_t i = 0U; i < length; i++, offset++) {
|
||||
bool b = READ_BIT(m_data, offset);
|
||||
WRITE_BIT(data, i, b);
|
||||
}
|
||||
|
||||
if (m_verbose) {
|
||||
Utils::dump(2U, "Encoded Layer 3 Data", data, length);
|
||||
}
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
///
|
||||
/// </summary>
|
||||
void Layer3::reset()
|
||||
{
|
||||
::memset(m_data, 0x00U, 22U);
|
||||
|
||||
m_messageType = MESSAGE_TYPE_IDLE;
|
||||
|
||||
m_srcId = 0U;
|
||||
m_dstId = 0U;
|
||||
|
||||
m_group = true;
|
||||
|
||||
m_dataBlocks = 0U;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Gets the raw layer 3 data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
void Layer3::getData(uint8_t* data) const
|
||||
{
|
||||
::memcpy(data, m_data, 22U);
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Sets the raw layer 3 data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <param name="length"></param>
|
||||
void Layer3::setData(const uint8_t* data, uint32_t length)
|
||||
{
|
||||
::memset(m_data, 0x00U, 22U);
|
||||
::memcpy(m_data, data, length);
|
||||
|
||||
m_messageType = m_data[0U] & 0x3FU;
|
||||
|
||||
m_group = (m_data[2U] & 0x80U) != 0x80U;
|
||||
|
||||
m_srcId = (m_data[3U] << 8) | m_data[4U];
|
||||
m_dstId = (m_data[5U] << 8) | m_data[6U];
|
||||
|
||||
m_dataBlocks = (m_data[8U] & 0x0FU) + 1U;
|
||||
}
|
||||
@ -1,95 +0,0 @@
|
||||
/**
|
||||
* Digital Voice Modem - Host Software
|
||||
* GPLv2 Open Source. Use is subject to license terms.
|
||||
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
||||
*
|
||||
* @package DVM / Host Software
|
||||
*
|
||||
*/
|
||||
//
|
||||
// Based on code from the MMDVMHost project. (https://github.com/g4klx/MMDVMHost)
|
||||
// Licensed under the GPLv2 License (https://opensource.org/licenses/GPL-2.0)
|
||||
//
|
||||
/*
|
||||
* Copyright (C) 2018 by Jonathan Naylor G4KLX
|
||||
* Copyright (C) 2022 by Bryan Biedenkapp N2PLL
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
#if !defined(__NXDN_LAYER_3_H__)
|
||||
#define __NXDN_LAYER_3_H__
|
||||
|
||||
#include "Defines.h"
|
||||
|
||||
namespace nxdn
|
||||
{
|
||||
namespace data
|
||||
{
|
||||
// ---------------------------------------------------------------------------
|
||||
// Class Declaration
|
||||
// Implements NXDN Layer 3 Connection Control.
|
||||
// ---------------------------------------------------------------------------
|
||||
|
||||
class HOST_SW_API Layer3 {
|
||||
public:
|
||||
/// <summary>Initializes a copy instance of the Layer3 class.</summary>
|
||||
Layer3(const Layer3& data);
|
||||
/// <summary>Initializes a new instance of the Layer3 class.</summary>
|
||||
Layer3();
|
||||
/// <summary>Finalizes a instance of the Layer3 class.</summary>
|
||||
~Layer3();
|
||||
|
||||
/// <summary>Equals operator.</summary>
|
||||
Layer3& operator=(const Layer3& data);
|
||||
|
||||
/// <summary>Decode layer 3 data.</summary>
|
||||
void decode(const uint8_t* data, uint32_t length, uint32_t offset = 0U);
|
||||
/// <summary>Encode layer 3 data.</summary>
|
||||
void encode(uint8_t* data, uint32_t length, uint32_t offset = 0U);
|
||||
|
||||
/// <summary></summary>
|
||||
void reset();
|
||||
|
||||
/// <summary>Gets the raw layer 3 data.</summary>
|
||||
void getData(uint8_t* data) const;
|
||||
/// <summary>Sets the raw layer 3 data.</summary>
|
||||
void setData(const uint8_t* data, uint32_t length);
|
||||
|
||||
public:
|
||||
/// <summary>Flag indicating verbose log output.</summary>
|
||||
__PROPERTY(bool, verbose, Verbose);
|
||||
|
||||
/** Common Data */
|
||||
/// <summary>Message Type</summary>
|
||||
__PROPERTY(uint8_t, messageType, MessageType);
|
||||
|
||||
/// <summary>Source ID.</summary>
|
||||
__PROPERTY(uint16_t, srcId, SrcId);
|
||||
/// <summary>Destination ID.</summary>
|
||||
__PROPERTY(uint16_t, dstId, DstId);
|
||||
|
||||
/// <summary>Flag indicating a group/talkgroup operation.</summary>
|
||||
__PROPERTY(bool, group, Group);
|
||||
|
||||
/// <summary></summary>
|
||||
__PROPERTY(uint8_t, dataBlocks, DataBlocks);
|
||||
|
||||
private:
|
||||
uint8_t* m_data;
|
||||
};
|
||||
} // namespace data
|
||||
} // namespace nxdn
|
||||
|
||||
#endif // __NXDN_LAYER_3_H__
|
||||
@ -0,0 +1,480 @@
|
||||
/**
|
||||
* Digital Voice Modem - Host Software
|
||||
* GPLv2 Open Source. Use is subject to license terms.
|
||||
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
||||
*
|
||||
* @package DVM / Host Software
|
||||
*
|
||||
*/
|
||||
//
|
||||
// Based on code from the MMDVMHost project. (https://github.com/g4klx/MMDVMHost)
|
||||
// Licensed under the GPLv2 License (https://opensource.org/licenses/GPL-2.0)
|
||||
//
|
||||
/*
|
||||
* Copyright (C) 2018 by Jonathan Naylor G4KLX
|
||||
* Copyright (C) 2022 by Bryan Biedenkapp N2PLL
|
||||
*
|
||||
* 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 "nxdn/NXDNDefines.h"
|
||||
#include "nxdn/lc/LC.h"
|
||||
#include "Log.h"
|
||||
#include "Utils.h"
|
||||
|
||||
using namespace nxdn;
|
||||
using namespace nxdn::lc;
|
||||
|
||||
#include <cstdio>
|
||||
#include <cassert>
|
||||
#include <cstring>
|
||||
|
||||
// ---------------------------------------------------------------------------
|
||||
// Public Class Members
|
||||
// ---------------------------------------------------------------------------
|
||||
|
||||
/// <summary>
|
||||
/// Initializes a new instance of the LC class.
|
||||
/// </summary>
|
||||
LC::LC() :
|
||||
m_verbose(false),
|
||||
m_messageType(MESSAGE_TYPE_IDLE),
|
||||
m_callType(CALL_TYPE_UNSPECIFIED),
|
||||
m_srcId(0U),
|
||||
m_dstId(0U),
|
||||
m_emergency(false),
|
||||
m_encrypted(false),
|
||||
m_priority(false),
|
||||
m_group(true),
|
||||
m_duplex(false),
|
||||
m_transmissionMode(TRANSMISSION_MODE_4800),
|
||||
m_packetInfo(),
|
||||
m_rsp(),
|
||||
m_dataFrameNumber(0U),
|
||||
m_dataBlockNumber(0U),
|
||||
m_delayCount(0U),
|
||||
m_algId(NXDN_CIPHER_TYPE_NONE),
|
||||
m_kId(0U),
|
||||
m_causeRsp(NXDN_CAUSE_VD_NORMAL_1),
|
||||
m_data(NULL)
|
||||
{
|
||||
m_data = new uint8_t[22U];
|
||||
::memset(m_data, 0x00U, 22U);
|
||||
|
||||
m_mi = new uint8_t[NXDN_MI_LENGTH_BYTES];
|
||||
::memset(m_mi, 0x00U, NXDN_MI_LENGTH_BYTES);
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Initializes a copy instance of the LC class.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
LC::LC(const LC& data) :
|
||||
m_verbose(false),
|
||||
m_messageType(MESSAGE_TYPE_IDLE),
|
||||
m_callType(CALL_TYPE_UNSPECIFIED),
|
||||
m_srcId(0U),
|
||||
m_dstId(0U),
|
||||
m_emergency(false),
|
||||
m_encrypted(false),
|
||||
m_priority(false),
|
||||
m_group(true),
|
||||
m_duplex(false),
|
||||
m_transmissionMode(TRANSMISSION_MODE_4800),
|
||||
m_packetInfo(),
|
||||
m_rsp(),
|
||||
m_dataFrameNumber(0U),
|
||||
m_dataBlockNumber(0U),
|
||||
m_delayCount(0U),
|
||||
m_algId(NXDN_CIPHER_TYPE_NONE),
|
||||
m_kId(0U),
|
||||
m_causeRsp(NXDN_CAUSE_VD_NORMAL_1),
|
||||
m_data(NULL)
|
||||
{
|
||||
copy(data);
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Finalizes a instance of LC class.
|
||||
/// </summary>
|
||||
LC::~LC()
|
||||
{
|
||||
delete[] m_data;
|
||||
delete[] m_mi;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Equals operator.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <returns></returns>
|
||||
LC& LC::operator=(const LC& data)
|
||||
{
|
||||
if (&data != this) {
|
||||
::memcpy(m_data, data.m_data, 22U);
|
||||
decodeLC(m_data);
|
||||
}
|
||||
|
||||
return *this;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Decode call link control data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <returns>True, if LC was decoded, otherwise false.</returns>
|
||||
void LC::decode(const uint8_t* data, uint32_t length, uint32_t offset)
|
||||
{
|
||||
assert(data != NULL);
|
||||
|
||||
for (uint32_t i = 0U; i < length; i++, offset++) {
|
||||
bool b = READ_BIT(data, i);
|
||||
WRITE_BIT(m_data, offset, b);
|
||||
}
|
||||
|
||||
if (m_verbose) {
|
||||
Utils::dump(2U, "Decoded LC Data", m_data, 22U);
|
||||
}
|
||||
|
||||
decodeLC(m_data);
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Encode call link control data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <param name="length"></param>
|
||||
/// <param name="offset"></param>
|
||||
void LC::encode(uint8_t* data, uint32_t length, uint32_t offset)
|
||||
{
|
||||
assert(data != NULL);
|
||||
|
||||
encodeLC(m_data);
|
||||
|
||||
for (uint32_t i = 0U; i < length; i++, offset++) {
|
||||
bool b = READ_BIT(m_data, offset);
|
||||
WRITE_BIT(data, i, b);
|
||||
}
|
||||
|
||||
if (m_verbose) {
|
||||
Utils::dump(2U, "Encoded LC Data", data, length);
|
||||
}
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
///
|
||||
/// </summary>
|
||||
void LC::reset()
|
||||
{
|
||||
::memset(m_data, 0x00U, 22U);
|
||||
|
||||
m_messageType = MESSAGE_TYPE_IDLE;
|
||||
m_callType = CALL_TYPE_UNSPECIFIED;
|
||||
|
||||
m_srcId = 0U;
|
||||
m_dstId = 0U;
|
||||
|
||||
m_emergency = false;
|
||||
m_encrypted = false;
|
||||
m_priority = false;
|
||||
m_group = true;
|
||||
m_duplex = false;
|
||||
m_transmissionMode = TRANSMISSION_MODE_4800;
|
||||
|
||||
m_packetInfo = PacketInformation();
|
||||
m_rsp = PacketInformation();
|
||||
m_dataFrameNumber = 0U;
|
||||
m_dataBlockNumber = 0U;
|
||||
|
||||
m_delayCount = 0U;
|
||||
|
||||
m_algId = NXDN_CIPHER_TYPE_NONE;
|
||||
m_kId = 0U;
|
||||
|
||||
m_causeRsp = NXDN_CAUSE_VD_NORMAL_1;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Gets the raw layer 3 data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
void LC::getData(uint8_t* data) const
|
||||
{
|
||||
::memcpy(data, m_data, 22U);
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Sets the raw layer 3 data.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <param name="length"></param>
|
||||
void LC::setData(const uint8_t* data, uint32_t length)
|
||||
{
|
||||
::memset(m_data, 0x00U, 22U);
|
||||
::memcpy(m_data, data, length);
|
||||
|
||||
decodeLC(m_data);
|
||||
}
|
||||
|
||||
/// ---------------------------------------------------------------------------
|
||||
// Private Class Members
|
||||
// ---------------------------------------------------------------------------
|
||||
|
||||
|
||||
/// <summary>
|
||||
/// Decode link control.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
/// <returns></returns>
|
||||
bool LC::decodeLC(const uint8_t* data)
|
||||
{
|
||||
m_messageType = data[0U] & 0x3FU; // Message Type
|
||||
|
||||
// message type opcodes
|
||||
switch (m_messageType) {
|
||||
case RTCH_MESSAGE_TYPE_VCALL:
|
||||
m_callType = (data[2U] >> 5) & 0x07U; // Call Type
|
||||
m_emergency = (data[1U] & 0x80U) == 0x80U; // Emergency Flag
|
||||
m_priority = (data[1U] & 0x20U) == 0x20U; // Priority Flag
|
||||
m_duplex = (data[2U] & 0x10U) == 0x10U; // Half/Full Duplex Flag
|
||||
m_transmissionMode = (data[2U] & 0x07U); // Transmission Mode
|
||||
m_srcId = (uint16_t)((data[3U] << 8) | data[4U]) & 0xFFFFU; // Source Radio Address
|
||||
m_dstId = (uint16_t)((data[5U] << 8) | data[6U]) & 0xFFFFU; // Target Radio Address
|
||||
m_algId = (data[7U] >> 6) & 0x03U; // Cipher Type
|
||||
m_kId = (data[7U] & 0x3FU); // Key ID
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_VCALL_IV:
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_IV:
|
||||
if (m_algId != NXDN_CIPHER_TYPE_NONE && m_kId > 0U) {
|
||||
m_mi = new uint8_t[NXDN_MI_LENGTH_BYTES];
|
||||
::memset(m_mi, 0x00U, NXDN_MI_LENGTH_BYTES);
|
||||
::memcpy(m_mi, data + 1U, NXDN_MI_LENGTH_BYTES); // Message Indicator
|
||||
}
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_TX_REL:
|
||||
m_callType = (data[2U] >> 5) & 0x07U; // Call Type
|
||||
m_emergency = (data[1U] & 0x80U) == 0x80U; // Emergency Flag
|
||||
m_priority = (data[1U] & 0x20U) == 0x20U; // Priority Flag
|
||||
m_srcId = (uint16_t)((data[3U] << 8) | data[4U]) & 0xFFFFU; // Source Radio Address
|
||||
m_dstId = (uint16_t)((data[5U] << 8) | data[6U]) & 0xFFFFU; // Target Radio Address
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_HDR:
|
||||
m_callType = (data[2U] >> 5) & 0x07U; // Call Type
|
||||
m_emergency = (data[1U] & 0x80U) == 0x80U; // Emergency Flag
|
||||
m_priority = (data[1U] & 0x20U) == 0x20U; // Priority Flag
|
||||
m_duplex = (data[2U] & 0x10U) == 0x10U; // Half/Full Duplex Flag
|
||||
m_transmissionMode = (data[2U] & 0x07U); // Transmission Mode
|
||||
m_srcId = (uint16_t)((data[3U] << 8) | data[4U]) & 0xFFFFU; // Source Radio Address
|
||||
m_dstId = (uint16_t)((data[5U] << 8) | data[6U]) & 0xFFFFU; // Target Radio Address
|
||||
m_algId = (data[7U] >> 6) & 0x03U; // Cipher Type
|
||||
m_kId = (data[7U] & 0x3FU); // Key ID
|
||||
|
||||
m_packetInfo = PacketInformation();
|
||||
m_packetInfo.decode(m_messageType, data + 8U); // Packet Information
|
||||
|
||||
if (m_algId != NXDN_CIPHER_TYPE_NONE && m_kId > 0U) {
|
||||
::memset(m_mi, 0x00U, NXDN_MI_LENGTH_BYTES);
|
||||
::memcpy(m_mi, data + 11U, NXDN_MI_LENGTH_BYTES); // Message Indicator
|
||||
}
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_DATA:
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_REQ_DATA:
|
||||
m_dataFrameNumber = (data[1U] >> 4) & 0x0FU; // Frame Number
|
||||
m_dataBlockNumber = (data[1U] & 0x0FU); // Block Number
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_ACK:
|
||||
m_callType = (data[2U] >> 5) & 0x07U; // Call Type
|
||||
m_emergency = (data[1U] & 0x80U) == 0x80U; // Emergency Flag
|
||||
m_priority = (data[1U] & 0x20U) == 0x20U; // Priority Flag
|
||||
m_duplex = (data[2U] & 0x10U) == 0x10U; // Half/Full Duplex Flag
|
||||
m_transmissionMode = (data[2U] & 0x07U); // Transmission Mode
|
||||
m_srcId = (uint16_t)((data[3U] << 8) | data[4U]) & 0xFFFFU; // Source Radio Address
|
||||
m_dstId = (uint16_t)((data[5U] << 8) | data[6U]) & 0xFFFFU; // Target Radio Address
|
||||
|
||||
m_rsp = PacketInformation();
|
||||
m_rsp.decode(m_messageType, data + 7U); // Response
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_HEAD_DLY:
|
||||
m_callType = (data[2U] >> 5) & 0x07U; // Call Type
|
||||
m_emergency = (data[1U] & 0x80U) == 0x80U; // Emergency Flag
|
||||
m_priority = (data[1U] & 0x20U) == 0x20U; // Priority Flag
|
||||
m_srcId = (uint16_t)((data[3U] << 8) | data[4U]) & 0xFFFFU; // Source Radio Address
|
||||
m_dstId = (uint16_t)((data[5U] << 8) | data[6U]) & 0xFFFFU; // Target Radio Address
|
||||
m_delayCount = (uint16_t)((data[7U] << 8) | data[8U]) & 0xFFFFU; // Delay Count
|
||||
break;
|
||||
case MESSAGE_TYPE_IDLE:
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_REQ_HDR:
|
||||
m_callType = (data[2U] >> 5) & 0x07U; // Call Type
|
||||
m_emergency = (data[1U] & 0x80U) == 0x80U; // Emergency Flag
|
||||
m_priority = (data[1U] & 0x20U) == 0x20U; // Priority Flag
|
||||
m_duplex = (data[2U] & 0x10U) == 0x10U; // Half/Full Duplex Flag
|
||||
m_transmissionMode = (data[2U] & 0x07U); // Transmission Mode
|
||||
m_srcId = (uint16_t)((data[3U] << 8) | data[4U]) & 0xFFFFU; // Source Radio Address
|
||||
m_dstId = (uint16_t)((data[5U] << 8) | data[6U]) & 0xFFFFU; // Target Radio Address
|
||||
m_algId = (data[7U] >> 6) & 0x03U; // Cipher Type
|
||||
m_kId = (data[7U] & 0x3FU); // Key ID
|
||||
|
||||
m_packetInfo = PacketInformation();
|
||||
m_packetInfo.decode(m_messageType, data + 8U); // Packet Information
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_RESP:
|
||||
m_callType = (data[2U] >> 5) & 0x07U; // Call Type
|
||||
m_emergency = (data[1U] & 0x80U) == 0x80U; // Emergency Flag
|
||||
m_priority = (data[1U] & 0x20U) == 0x20U; // Priority Flag
|
||||
m_duplex = (data[2U] & 0x10U) == 0x10U; // Half/Full Duplex Flag
|
||||
m_transmissionMode = (data[2U] & 0x07U); // Transmission Mode
|
||||
m_srcId = (uint16_t)((data[3U] << 8) | data[4U]) & 0xFFFFU; // Source Radio Address
|
||||
m_dstId = (uint16_t)((data[5U] << 8) | data[6U]) & 0xFFFFU; // Target Radio Address
|
||||
m_causeRsp = data[7U]; // Cause (SS)
|
||||
break;
|
||||
default:
|
||||
LogError(LOG_NXDN, "LC::decodeLC(), unknown LC value, messageType = $%02X", m_messageType);
|
||||
return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Encode link control.
|
||||
/// </summary>
|
||||
/// <param name="rs"></param>
|
||||
void LC::encodeLC(uint8_t* data)
|
||||
{
|
||||
m_messageType = m_data[0U] & 0x3FU; // Message Type
|
||||
|
||||
// message type opcodes
|
||||
switch (m_messageType) {
|
||||
case RTCH_MESSAGE_TYPE_VCALL:
|
||||
m_data[1U] = (m_emergency ? 0x80U : 0x00U) + // Emergency Flag
|
||||
(m_priority ? 0x20U : 0x00U); // Priority Flag
|
||||
m_data[2U] = ((m_callType & 0x07U) << 5) + // Call Type
|
||||
(m_duplex ? 0x10U : 0x00U) + // Half/Full Duplex Flag
|
||||
(m_transmissionMode & 0x07U); // Transmission Mode
|
||||
|
||||
m_data[3U] = (m_srcId >> 8U) & 0xFFU; // Source Radio Address
|
||||
m_data[4U] = (m_srcId >> 0U) & 0xFFU; // ...
|
||||
m_data[5U] = (m_dstId >> 8U) & 0xFFU; // Target Radio Address
|
||||
m_data[6U] = (m_dstId >> 0U) & 0xFFU; // ...
|
||||
|
||||
m_data[7U] = ((m_algId & 0x03U) << 6) + // Cipher Type
|
||||
(m_kId & 0x3FU); // Key ID
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_VCALL_IV:
|
||||
if (m_algId != NXDN_CIPHER_TYPE_NONE && m_kId > 0U) {
|
||||
::memcpy(m_data + 1U, m_mi, NXDN_MI_LENGTH_BYTES); // Message Indicator
|
||||
}
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_TX_REL:
|
||||
m_data[1U] = (m_emergency ? 0x80U : 0x00U) + // Emergency Flag
|
||||
(m_priority ? 0x20U : 0x00U); // Priority Flag
|
||||
m_data[2U] = (m_callType & 0x07U) << 5; // Call Type
|
||||
|
||||
m_data[3U] = (m_srcId >> 8U) & 0xFFU; // Source Radio Address
|
||||
m_data[4U] = (m_srcId >> 0U) & 0xFFU; // ...
|
||||
m_data[5U] = (m_dstId >> 8U) & 0xFFU; // Target Radio Address
|
||||
m_data[6U] = (m_dstId >> 0U) & 0xFFU; // ...
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_HDR:
|
||||
m_data[1U] = (m_emergency ? 0x80U : 0x00U) + // Emergency Flag
|
||||
(m_priority ? 0x20U : 0x00U); // Priority Flag
|
||||
m_data[2U] = ((m_callType & 0x07U) << 5) + // Call Type
|
||||
(m_duplex ? 0x10U : 0x00U) + // Half/Full Duplex Flag
|
||||
(m_transmissionMode & 0x07U); // Transmission Mode
|
||||
|
||||
m_data[3U] = (m_srcId >> 8U) & 0xFFU; // Source Radio Address
|
||||
m_data[4U] = (m_srcId >> 0U) & 0xFFU; // ...
|
||||
m_data[5U] = (m_dstId >> 8U) & 0xFFU; // Target Radio Address
|
||||
m_data[6U] = (m_dstId >> 0U) & 0xFFU; // ...
|
||||
|
||||
m_data[7U] = ((m_algId & 0x03U) << 6) + // Cipher Type
|
||||
(m_kId & 0x3FU); // Key ID
|
||||
|
||||
m_packetInfo.encode(m_messageType, data + 8U); // Packet Information
|
||||
|
||||
if (m_algId != NXDN_CIPHER_TYPE_NONE && m_kId > 0U) {
|
||||
::memcpy(m_data + 11U, m_mi, NXDN_MI_LENGTH_BYTES); // Message Indicator
|
||||
}
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_DATA:
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_REQ_DATA:
|
||||
data[1U] = (m_dataFrameNumber & 0x0FU << 4) + // Frame Number
|
||||
(m_dataBlockNumber & 0x0FU); // Block Number
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_ACK:
|
||||
m_data[1U] = (m_emergency ? 0x80U : 0x00U) + // Emergency Flag
|
||||
(m_priority ? 0x20U : 0x00U); // Priority Flag
|
||||
m_data[2U] = ((m_callType & 0x07U) << 5) + // Call Type
|
||||
(m_duplex ? 0x10U : 0x00U) + // Half/Full Duplex Flag
|
||||
(m_transmissionMode & 0x07U); // Transmission Mode
|
||||
|
||||
m_data[3U] = (m_srcId >> 8U) & 0xFFU; // Source Radio Address
|
||||
m_data[4U] = (m_srcId >> 0U) & 0xFFU; // ...
|
||||
m_data[5U] = (m_dstId >> 8U) & 0xFFU; // Target Radio Address
|
||||
m_data[6U] = (m_dstId >> 0U) & 0xFFU; // ...
|
||||
|
||||
m_rsp.encode(m_messageType, data + 7U); // Response
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_HEAD_DLY:
|
||||
m_data[1U] = (m_emergency ? 0x80U : 0x00U) + // Emergency Flag
|
||||
(m_priority ? 0x20U : 0x00U); // Priority Flag
|
||||
m_data[2U] = (m_callType & 0x07U) << 5; // Call Type
|
||||
|
||||
m_data[3U] = (m_srcId >> 8U) & 0xFFU; // Source Radio Address
|
||||
m_data[4U] = (m_srcId >> 0U) & 0xFFU; // ...
|
||||
m_data[5U] = (m_dstId >> 8U) & 0xFFU; // Target Radio Address
|
||||
m_data[6U] = (m_dstId >> 0U) & 0xFFU; // ...
|
||||
|
||||
m_data[7U] = (m_delayCount >> 8U) & 0xFFU; // Delay Count
|
||||
m_data[8U] = (m_delayCount >> 0U) & 0xFFU; // ...
|
||||
break;
|
||||
case MESSAGE_TYPE_IDLE:
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_REQ_HDR:
|
||||
m_data[1U] = (m_emergency ? 0x80U : 0x00U) + // Emergency Flag
|
||||
(m_priority ? 0x20U : 0x00U); // Priority Flag
|
||||
m_data[2U] = ((m_callType & 0x07U) << 5) + // Call Type
|
||||
(m_duplex ? 0x10U : 0x00U) + // Half/Full Duplex Flag
|
||||
(m_transmissionMode & 0x07U); // Transmission Mode
|
||||
|
||||
m_data[3U] = (m_srcId >> 8U) & 0xFFU; // Source Radio Address
|
||||
m_data[4U] = (m_srcId >> 0U) & 0xFFU; // ...
|
||||
m_data[5U] = (m_dstId >> 8U) & 0xFFU; // Target Radio Address
|
||||
m_data[6U] = (m_dstId >> 0U) & 0xFFU; // ...
|
||||
|
||||
m_data[7U] = ((m_algId & 0x03U) << 6) + // Cipher Type
|
||||
(m_kId & 0x3FU); // Key ID
|
||||
|
||||
m_packetInfo.encode(m_messageType, data + 8U); // Packet Information
|
||||
break;
|
||||
default:
|
||||
LogError(LOG_NXDN, "LC::encodeLC(), unknown LC value, messageType = $%02X", m_messageType);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
// <summary>
|
||||
/// Internal helper to copy the the class.
|
||||
/// </summary>
|
||||
/// <param name="data"></param>
|
||||
void LC::copy(const LC& data)
|
||||
{
|
||||
m_data = new uint8_t[22U];
|
||||
::memcpy(m_data, data.m_data, 22U);
|
||||
|
||||
m_verbose = data.m_verbose;
|
||||
|
||||
decodeLC(m_data);
|
||||
}
|
||||
@ -0,0 +1,142 @@
|
||||
/**
|
||||
* Digital Voice Modem - Host Software
|
||||
* GPLv2 Open Source. Use is subject to license terms.
|
||||
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
||||
*
|
||||
* @package DVM / Host Software
|
||||
*
|
||||
*/
|
||||
//
|
||||
// Based on code from the MMDVMHost project. (https://github.com/g4klx/MMDVMHost)
|
||||
// Licensed under the GPLv2 License (https://opensource.org/licenses/GPL-2.0)
|
||||
//
|
||||
/*
|
||||
* Copyright (C) 2018 by Jonathan Naylor G4KLX
|
||||
* Copyright (C) 2022 by Bryan Biedenkapp N2PLL
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
#if !defined(__NXDN_LC__LC_H__)
|
||||
#define __NXDN_LC__LC_H__
|
||||
|
||||
#include "Defines.h"
|
||||
#include "nxdn/lc/PacketInformation.h"
|
||||
|
||||
namespace nxdn
|
||||
{
|
||||
namespace lc
|
||||
{
|
||||
// ---------------------------------------------------------------------------
|
||||
// Class Declaration
|
||||
// Represents link control data for NXDN calls.
|
||||
// ---------------------------------------------------------------------------
|
||||
|
||||
class HOST_SW_API LC {
|
||||
public:
|
||||
/// <summary>Initializes a new instance of the LC class.</summary>
|
||||
LC();
|
||||
/// <summary>Initializes a copy instance of the LC class.</summary>
|
||||
LC(const LC& data);
|
||||
/// <summary>Finalizes a instance of the LC class.</summary>
|
||||
~LC();
|
||||
|
||||
/// <summary>Equals operator.</summary>
|
||||
LC& operator=(const LC& data);
|
||||
|
||||
/// <summary>Decode layer 3 data.</summary>
|
||||
void decode(const uint8_t* data, uint32_t length, uint32_t offset = 0U);
|
||||
/// <summary>Encode layer 3 data.</summary>
|
||||
void encode(uint8_t* data, uint32_t length, uint32_t offset = 0U);
|
||||
|
||||
/// <summary></summary>
|
||||
void reset();
|
||||
|
||||
/// <summary>Gets the raw layer 3 data.</summary>
|
||||
void getData(uint8_t* data) const;
|
||||
/// <summary>Sets the raw layer 3 data.</summary>
|
||||
void setData(const uint8_t* data, uint32_t length);
|
||||
|
||||
public:
|
||||
/// <summary>Flag indicating verbose log output.</summary>
|
||||
__PROPERTY(bool, verbose, Verbose);
|
||||
|
||||
/** Common Data */
|
||||
/// <summary>Message Type</summary>
|
||||
__PROPERTY(uint8_t, messageType, MessageType);
|
||||
|
||||
/// <summary>Call Type</summary>
|
||||
__PROPERTY(uint8_t, callType, CallType);
|
||||
|
||||
/// <summary>Source ID.</summary>
|
||||
__PROPERTY(uint16_t, srcId, SrcId);
|
||||
/// <summary>Destination ID.</summary>
|
||||
__PROPERTY(uint16_t, dstId, DstId);
|
||||
|
||||
/** Common Call Options */
|
||||
/// <summary>Flag indicating the emergency bits are set.</summary>
|
||||
__PROPERTY(bool, emergency, Emergency);
|
||||
/// <summary>Flag indicating that encryption is enabled.</summary>
|
||||
__PROPERTY(bool, encrypted, Encrypted);
|
||||
/// <summary>Flag indicating priority paging.</summary>
|
||||
__PROPERTY(bool, priority, Priority);
|
||||
/// <summary>Flag indicating a group/talkgroup operation.</summary>
|
||||
__PROPERTY(bool, group, Group);
|
||||
/// <summary>Flag indicating a half/full duplex operation.</summary>
|
||||
__PROPERTY(bool, duplex, Duplex);
|
||||
|
||||
/// <summary>Transmission mode.</summary>
|
||||
__PROPERTY(uint8_t, transmissionMode, TransmissionMode);
|
||||
|
||||
/** Data Call Data */
|
||||
/// <summary>Data packet information.</summary>
|
||||
__PROPERTY(PacketInformation, packetInfo, PacketInfo);
|
||||
/// <summary>Data packet information.</summary>
|
||||
__PROPERTY(PacketInformation, rsp, Response);
|
||||
/// <summary>Data packet frame number.</summary>
|
||||
__PROPERTY(uint8_t, dataFrameNumber, DataFrameNumber);
|
||||
/// <summary>Data packet block number.</summary>
|
||||
__PROPERTY(uint8_t, dataBlockNumber, DataBlockNumber);
|
||||
|
||||
/** Header Delay Data */
|
||||
/// <summary>Delay count.</summary>
|
||||
__PROPERTY(uint16_t, delayCount, DelayCount);
|
||||
|
||||
/** Encryption data */
|
||||
/// <summary>Encryption algorithm ID.</summary>
|
||||
__PROPERTY(uint8_t, algId, AlgId);
|
||||
/// <summary>Encryption key ID.</summary>
|
||||
__PROPERTY(uint8_t, kId, KId);
|
||||
|
||||
/// <summary>Cause Response.</summary>
|
||||
__PROPERTY(uint8_t, causeRsp, CauseResponse);
|
||||
|
||||
private:
|
||||
uint8_t* m_data;
|
||||
|
||||
/** Encryption data */
|
||||
uint8_t* m_mi;
|
||||
|
||||
/// <summary>Decode link control.</summary>
|
||||
bool decodeLC(const uint8_t* data);
|
||||
/// <summary>Encode link control.</summary>
|
||||
void encodeLC(uint8_t* data);
|
||||
|
||||
/// <summary>Internal helper to copy the class.</summary>
|
||||
void copy(const LC& data);
|
||||
};
|
||||
} // namespace lc
|
||||
} // namespace nxdn
|
||||
|
||||
#endif // __NXDN_LC__LC_H__
|
||||
@ -0,0 +1,187 @@
|
||||
/**
|
||||
* Digital Voice Modem - Host Software
|
||||
* GPLv2 Open Source. Use is subject to license terms.
|
||||
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
||||
*
|
||||
* @package DVM / Host Software
|
||||
*
|
||||
*/
|
||||
/*
|
||||
* Copyright (C) 2022 by Bryan Biedenkapp N2PLL
|
||||
*
|
||||
* 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 "Defines.h"
|
||||
#include "nxdn/NXDNDefines.h"
|
||||
#include "nxdn/lc/PacketInformation.h"
|
||||
#include "Log.h"
|
||||
#include "Utils.h"
|
||||
|
||||
using namespace nxdn::lc;
|
||||
using namespace nxdn;
|
||||
|
||||
#include <cstdio>
|
||||
#include <cassert>
|
||||
#include <cstring>
|
||||
|
||||
// ---------------------------------------------------------------------------
|
||||
// Public Class Members
|
||||
// ---------------------------------------------------------------------------
|
||||
|
||||
/// <summary>
|
||||
/// Initializes a new instance of the PacketInformation class.
|
||||
/// </summary>
|
||||
PacketInformation::PacketInformation() :
|
||||
m_delivery(false),
|
||||
m_selectiveRetry(false),
|
||||
m_blockCount(0U),
|
||||
m_padCount(0U),
|
||||
m_start(true),
|
||||
m_circular(false),
|
||||
m_fragmentCount(0U),
|
||||
m_rspClass(DATA_RSP_CLASS_ACK),
|
||||
m_rspType(1U),
|
||||
m_rspErrorBlock(0U)
|
||||
{
|
||||
/* stub */
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Finalizes a instance of the PacketInformation class.
|
||||
/// </summary>
|
||||
PacketInformation::~PacketInformation()
|
||||
{
|
||||
/* stub */
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Decodes packet information.
|
||||
/// </summary>
|
||||
/// <param name="messageType"></param>
|
||||
/// <param name="data"></param>
|
||||
/// <returns>True, if packet information was decoded, otherwise false.</returns>
|
||||
bool PacketInformation::decode(const uint8_t messageType, const uint8_t* data)
|
||||
{
|
||||
assert(data != NULL);
|
||||
|
||||
switch (messageType)
|
||||
{
|
||||
case RTCH_MESSAGE_TYPE_DCALL_HDR:
|
||||
m_delivery = (data[0U] & 0x80U) == 0x80U; // Delivery
|
||||
m_selectiveRetry = (data[0U] & 0x20U) == 0x20U; // Selective Retry
|
||||
m_blockCount = (data[0U] & 0x0FU); // Block Count
|
||||
|
||||
m_padCount = (data[1U] >> 3) & 0x1FU; // Pad Count
|
||||
m_start = (data[1U] & 0x08U) == 0x08U; // Start/First Fragment
|
||||
m_circular = (data[1U] & 0x04U) == 0x04U; // Circular Fragment Count
|
||||
|
||||
m_fragmentCount = ((data[1U] & 0x01U) << 8) + data[2U]; // Fragment Count
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_ACK:
|
||||
m_rspClass = (data[0U] >> 4) & 0x03U; // Response Class
|
||||
m_rspType = (data[0U] >> 1) & 0x07U; // Response Type
|
||||
m_fragmentCount = ((data[0U] & 0x01U) << 8) + data[1U]; // Fragment Count
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_REQ_HDR:
|
||||
m_delivery = (data[0U] & 0x80U) == 0x80U; // Delivery
|
||||
m_selectiveRetry = (data[0U] & 0x20U) == 0x20U; // Selective Retry
|
||||
m_blockCount = (data[0U] & 0x0FU); // Block Count
|
||||
|
||||
m_padCount = (data[1U] >> 3) & 0x1FU; // Pad Count
|
||||
m_start = (data[1U] & 0x08U) == 0x08U; // Start/First Fragment
|
||||
m_circular = (data[1U] & 0x04U) == 0x04U; // Circular Fragment Count
|
||||
break;
|
||||
default:
|
||||
LogError(LOG_NXDN, "PacketInformation::decode(), unknown LC value, messageType = $%02X", messageType);
|
||||
return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Encodes packet information.
|
||||
/// </summary>
|
||||
/// <param name="messageType"></param>
|
||||
/// <param name="data"></param>
|
||||
void PacketInformation::encode(const uint8_t messageType, uint8_t* data)
|
||||
{
|
||||
assert(data != NULL);
|
||||
|
||||
switch (messageType)
|
||||
{
|
||||
case RTCH_MESSAGE_TYPE_DCALL_HDR:
|
||||
{
|
||||
::memset(data, 0x00U, NXDN_PCKT_INFO_LENGTH_BYTES);
|
||||
|
||||
data[0U] = (m_delivery ? 0x80U : 0x00U) + // Delivery
|
||||
(m_selectiveRetry ? 0x20U : 0x00U) + // Selective Retry
|
||||
m_blockCount; // Block Count
|
||||
|
||||
data[1U] = (m_padCount << 3) + // Pad Count
|
||||
(m_start ? 0x08U : 0x00U) + // Start/First Fragment
|
||||
(m_circular ? 0x04U : 0x00U); // Circular Fragment Count
|
||||
|
||||
bool highFragCount = (m_fragmentCount & 0x100U) == 0x100U;
|
||||
data[1U] += (highFragCount ? 0x01U : 0x00U); // Fragment Count - bit 8
|
||||
data[2U] = m_fragmentCount & 0xFFU; // Fragment Count - bit 0 - 7
|
||||
}
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_DCALL_ACK:
|
||||
{
|
||||
data[0U] = (m_rspClass & 0x03U << 4) + // Response Class
|
||||
(m_rspType & 0x07U << 1); // Response Type
|
||||
|
||||
bool highFragCount = (m_fragmentCount & 0x100U) == 0x100U;
|
||||
data[0U] += (highFragCount ? 0x01U : 0x00U); // Fragment Count - bit 8
|
||||
data[1U] = m_fragmentCount & 0xFFU; // Fragment Count - bit 0 - 7
|
||||
}
|
||||
break;
|
||||
case RTCH_MESSAGE_TYPE_SDCALL_REQ_HDR:
|
||||
::memset(data, 0x00U, NXDN_PCKT_INFO_LENGTH_BYTES);
|
||||
|
||||
data[0U] = (m_delivery ? 0x80U : 0x00U) + // Delivery
|
||||
(m_selectiveRetry ? 0x20U : 0x00U) + // Selective Retry
|
||||
m_blockCount; // Block Count
|
||||
|
||||
data[1U] = (m_padCount << 3) + // Pad Count
|
||||
(m_start ? 0x08U : 0x00U) + // Start/First Fragment
|
||||
(m_circular ? 0x04U : 0x00U); // Circular Fragment Count
|
||||
break;
|
||||
default:
|
||||
LogError(LOG_NXDN, "PacketInformation::encode(), unknown LC value, messageType = $%02X", messageType);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Helper to reset data values to defaults.
|
||||
/// </summary>
|
||||
void PacketInformation::reset()
|
||||
{
|
||||
m_delivery = false;
|
||||
m_selectiveRetry = false;
|
||||
m_blockCount = 0U;
|
||||
|
||||
m_padCount = 0U;
|
||||
m_start = true;
|
||||
m_circular = false;
|
||||
|
||||
m_fragmentCount = 0U;
|
||||
|
||||
m_rspClass = DATA_RSP_CLASS_ACK;
|
||||
m_rspType = 0U;
|
||||
m_rspErrorBlock = 0U;
|
||||
}
|
||||
@ -0,0 +1,83 @@
|
||||
/**
|
||||
* Digital Voice Modem - Host Software
|
||||
* GPLv2 Open Source. Use is subject to license terms.
|
||||
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
||||
*
|
||||
* @package DVM / Host Software
|
||||
*
|
||||
*/
|
||||
/*
|
||||
* Copyright (C) 2022 by Bryan Biedenkapp N2PLL
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
#if !defined(__NXDN_LC__PACKET_INFORMATION_H__)
|
||||
#define __NXDN_LC__PACKET_INFORMATION_H__
|
||||
|
||||
#include "Defines.h"
|
||||
|
||||
namespace nxdn
|
||||
{
|
||||
namespace lc
|
||||
{
|
||||
// ---------------------------------------------------------------------------
|
||||
// Class Declaration
|
||||
// Represents the packet information data for link control data.
|
||||
// ---------------------------------------------------------------------------
|
||||
|
||||
class HOST_SW_API PacketInformation {
|
||||
public:
|
||||
/// <summary>Initializes a new instance of the PacketInformation class.</summary>
|
||||
PacketInformation();
|
||||
/// <summary>Finalizes a instance of the PacketInformation class.</summary>
|
||||
~PacketInformation();
|
||||
|
||||
/// <summary>Decodes packet information.</summary>
|
||||
bool decode(const uint8_t messageType, const uint8_t* data);
|
||||
/// <summary>Encodes packet information.</summary>
|
||||
void encode(const uint8_t messageType, uint8_t* data);
|
||||
|
||||
/// <summary>Helper to reset data values to defaults.</summary>
|
||||
void reset();
|
||||
|
||||
public:
|
||||
/** Common Data **/
|
||||
/// <summary>Flag indicating if confirmed delivery is needed.</summary>
|
||||
__PROPERTY(bool, delivery, Delivery);
|
||||
/// <summary>Flag indicating if the packet is a selective retry packet.</summary>
|
||||
__PROPERTY(bool, selectiveRetry, SelectiveRetry);
|
||||
/// <summary>Count of data blocks in t he transmission packet.</summary>
|
||||
__PROPERTY(uint8_t, blockCount, BlockCount);
|
||||
/// <summary>Number of padding octets of the last block.</summary>
|
||||
__PROPERTY(uint8_t, padCount, PadCount);
|
||||
/// <summary>Flag indicating the first fragment.</summary>
|
||||
__PROPERTY(bool, start, Start);
|
||||
/// <summary>Flag indicating if the Tx fragment count circulates.</summary>
|
||||
__PROPERTY(bool, circular, Circular);
|
||||
/// <summary>The number and sequence of fragments.</summary>
|
||||
__PROPERTY(uint16_t, fragmentCount, FragmentCount);
|
||||
|
||||
/** Response Data */
|
||||
/// <summary>Response class.</summary>
|
||||
__PROPERTY(uint8_t, rspClass, ResponseClass);
|
||||
/// <summary>Response type.</summary>
|
||||
__PROPERTY(uint8_t, rspType, ResponseType);
|
||||
/// <summary>Error Block Flag.</summary>
|
||||
__PROPERTY(uint16_t, rspErrorBlock, ResponseErrorBlock);
|
||||
};
|
||||
} // namespace lc
|
||||
} // namespace nxdn
|
||||
|
||||
#endif // __NXDN_LC__PACKET_INFORMATION_H__
|
||||
Loading…
Reference in new issue