You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
2698 lines
103 KiB
2698 lines
103 KiB
/**
|
|
* 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) 2017-2022 by Bryan Biedenkapp N2PLL
|
|
* Copyright (C) 2022 by Jason-UWU - TIME_DATE_ANN & RAD_MON_CMD
|
|
*
|
|
* 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 "p25/P25Defines.h"
|
|
#include "p25/packet/Voice.h"
|
|
#include "p25/packet/Trunk.h"
|
|
#include "p25/acl/AccessControl.h"
|
|
#include "p25/lc/tsbk/TSBKFactory.h"
|
|
#include "p25/lookups/P25AffiliationLookup.h"
|
|
#include "p25/P25Utils.h"
|
|
#include "p25/Sync.h"
|
|
#include "edac/CRC.h"
|
|
#include "Log.h"
|
|
#include "Utils.h"
|
|
|
|
using namespace p25;
|
|
using namespace p25::data;
|
|
using namespace p25::lc::tsbk;
|
|
using namespace p25::packet;
|
|
|
|
#include <cassert>
|
|
#include <cstdio>
|
|
#include <cstring>
|
|
#include <ctime>
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Macros
|
|
// ---------------------------------------------------------------------------
|
|
|
|
// Make sure control data is supported.
|
|
#define IS_SUPPORT_CONTROL_CHECK(_PCKT_STR, _PCKT, _SRCID) \
|
|
if (!m_p25->m_control) { \
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", " _PCKT_STR " denial, unsupported service, srcId = %u", _SRCID); \
|
|
writeRF_TSDU_Deny(_SRCID, P25_DENY_RSN_SYS_UNSUPPORTED_SVC, _PCKT); \
|
|
m_p25->m_rfState = RS_RF_REJECTED; \
|
|
return false; \
|
|
}
|
|
|
|
// Validate the source RID.
|
|
#define VALID_SRCID(_PCKT_STR, _PCKT, _SRCID) \
|
|
if (!acl::AccessControl::validateSrcId(_SRCID)) { \
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", " _PCKT_STR " denial, RID rejection, srcId = %u", _SRCID); \
|
|
writeRF_TSDU_Deny(_SRCID, P25_DENY_RSN_REQ_UNIT_NOT_VALID, _PCKT); \
|
|
denialInhibit(_SRCID); \
|
|
m_p25->m_rfState = RS_RF_REJECTED; \
|
|
return false; \
|
|
}
|
|
|
|
// Validate the target RID.
|
|
#define VALID_DSTID(_PCKT_STR, _PCKT, _SRCID, _DSTID) \
|
|
if (!acl::AccessControl::validateSrcId(_DSTID)) { \
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", " _PCKT_STR " denial, RID rejection, dstId = %u", _DSTID); \
|
|
writeRF_TSDU_Deny(_SRCID, P25_DENY_RSN_TGT_UNIT_NOT_VALID, _PCKT); \
|
|
m_p25->m_rfState = RS_RF_REJECTED; \
|
|
return false; \
|
|
}
|
|
|
|
// Validate the talkgroup ID.
|
|
#define VALID_TGID(_PCKT_STR, _PCKT, _SRCID, _DSTID) \
|
|
if (!acl::AccessControl::validateTGId(_DSTID)) { \
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", " _PCKT_STR " denial, TGID rejection, dstId = %u", _DSTID); \
|
|
writeRF_TSDU_Deny(_SRCID, P25_DENY_RSN_TGT_GROUP_NOT_VALID, _PCKT); \
|
|
m_p25->m_rfState = RS_RF_REJECTED; \
|
|
return false; \
|
|
}
|
|
|
|
// Verify the source RID is registered.
|
|
#define VERIFY_SRCID_REG(_PCKT_STR, _PCKT, _SRCID) \
|
|
if (!m_p25->m_affiliations.isUnitReg(_SRCID) && m_verifyReg) { \
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", " _PCKT_STR " denial, RID not registered, srcId = %u", _SRCID); \
|
|
writeRF_TSDU_Deny(_SRCID, P25_DENY_RSN_REQ_UNIT_NOT_AUTH, _PCKT); \
|
|
writeRF_TSDU_U_Reg_Cmd(_SRCID); \
|
|
m_p25->m_rfState = RS_RF_REJECTED; \
|
|
return false; \
|
|
}
|
|
|
|
// Verify the source RID is affiliated.
|
|
#define VERIFY_SRCID_AFF(_PCKT_STR, _PCKT, _SRCID, _DSTID) \
|
|
if (!m_p25->m_affiliations.isGroupAff(_SRCID, _DSTID) && m_verifyAff) { \
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", " _PCKT_STR " denial, RID not affiliated to TGID, srcId = %u, dstId = %u", _SRCID, _DSTID); \
|
|
writeRF_TSDU_Deny(_SRCID, P25_DENY_RSN_REQ_UNIT_NOT_AUTH, _PCKT); \
|
|
writeRF_TSDU_U_Reg_Cmd(_SRCID); \
|
|
m_p25->m_rfState = RS_RF_REJECTED; \
|
|
return false; \
|
|
}
|
|
|
|
// Validate the source RID (network).
|
|
#define VALID_SRCID_NET(_PCKT_STR, _SRCID) \
|
|
if (!acl::AccessControl::validateSrcId(_SRCID)) { \
|
|
LogWarning(LOG_NET, P25_TSDU_STR ", " _PCKT_STR " denial, RID rejection, srcId = %u", _SRCID); \
|
|
return false; \
|
|
}
|
|
|
|
// Validate the target RID (network).
|
|
#define VALID_DSTID_NET(_PCKT_STR, _DSTID) \
|
|
if (!acl::AccessControl::validateSrcId(_DSTID)) { \
|
|
LogWarning(LOG_NET, P25_TSDU_STR ", " _PCKT_STR " denial RID rejection, dstId = %u", _DSTID); \
|
|
return false; \
|
|
}
|
|
|
|
#define RF_TO_WRITE_NET(OSP) \
|
|
if (m_network != nullptr) { \
|
|
uint8_t _buf[P25_TSDU_FRAME_LENGTH_BYTES]; \
|
|
writeNet_TSDU_From_RF(OSP, _buf); \
|
|
writeNetworkRF(OSP, _buf, true); \
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Constants
|
|
// ---------------------------------------------------------------------------
|
|
|
|
const uint32_t ADJ_SITE_TIMER_TIMEOUT = 30U;
|
|
const uint32_t ADJ_SITE_UPDATE_CNT = 5U;
|
|
const uint32_t TSDU_CTRL_BURST_COUNT = 2U;
|
|
const uint32_t TSBK_MBF_CNT = 3U;
|
|
const uint32_t GRANT_TIMER_TIMEOUT = 15U;
|
|
const uint8_t CONV_FALLBACK_PACKET_DELAY = 8U;
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Public Class Members
|
|
// ---------------------------------------------------------------------------
|
|
|
|
/// <summary>
|
|
/// Process a data frame from the RF interface.
|
|
/// </summary>
|
|
/// <param name="data">Buffer containing data frame.</param>
|
|
/// <param name="len">Length of data frame.</param>
|
|
/// <param name="preDecodedTSBK">Pre-decoded TSBK.</param>
|
|
/// <returns></returns>
|
|
bool Trunk::process(uint8_t* data, uint32_t len, lc::TSBK* preDecodedTSBK)
|
|
{
|
|
assert(data != nullptr);
|
|
|
|
if (!m_p25->m_control)
|
|
return false;
|
|
|
|
uint8_t duid = 0U;
|
|
if (preDecodedTSBK == nullptr) {
|
|
// Decode the NID
|
|
bool valid = m_p25->m_nid.decode(data + 2U);
|
|
|
|
if (m_p25->m_rfState == RS_RF_LISTENING && !valid)
|
|
return false;
|
|
|
|
duid = m_p25->m_nid.getDUID();
|
|
} else {
|
|
duid = P25_DUID_TSDU;
|
|
}
|
|
|
|
RPT_RF_STATE prevRfState = m_p25->m_rfState;
|
|
std::unique_ptr<lc::TSBK> tsbk;
|
|
|
|
// handle individual DUIDs
|
|
if (duid == P25_DUID_TSDU) {
|
|
if (m_p25->m_rfState != RS_RF_DATA) {
|
|
m_p25->m_rfState = RS_RF_DATA;
|
|
}
|
|
|
|
m_p25->m_queue.clear();
|
|
|
|
if (preDecodedTSBK == nullptr) {
|
|
tsbk = TSBKFactory::createTSBK(data + 2U);
|
|
if (tsbk == nullptr) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", undecodable LC");
|
|
m_p25->m_rfState = prevRfState;
|
|
return false;
|
|
}
|
|
} else {
|
|
tsbk = std::unique_ptr<lc::TSBK>(preDecodedTSBK);
|
|
}
|
|
|
|
uint32_t srcId = tsbk->getSrcId();
|
|
uint32_t dstId = tsbk->getDstId();
|
|
|
|
// handle standard P25 reference opcodes
|
|
switch (tsbk->getLCO()) {
|
|
case TSBK_IOSP_GRP_VCH:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_IOSP_GRP_VCH (Group Voice Channel Request)", TSBK_IOSP_GRP_VCH, srcId);
|
|
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_GRP_VCH (Group Voice Channel Request)", TSBK_IOSP_GRP_VCH, srcId);
|
|
|
|
// validate the talkgroup ID
|
|
VALID_TGID("TSBK_IOSP_GRP_VCH (Group Voice Channel Request)", TSBK_IOSP_GRP_VCH, srcId, dstId);
|
|
|
|
// verify the source RID is affiliated
|
|
VERIFY_SRCID_AFF("TSBK_IOSP_GRP_VCH (Group Voice Channel Request)", TSBK_IOSP_GRP_VCH, srcId, dstId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_VCH (Group Voice Channel Request), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
uint8_t serviceOptions = (tsbk->getEmergency() ? 0x80U : 0x00U) + // Emergency Flag
|
|
(tsbk->getEncrypted() ? 0x40U : 0x00U) + // Encrypted Flag
|
|
(tsbk->getPriority() & 0x07U); // Priority
|
|
|
|
writeRF_TSDU_Grant(srcId, dstId, serviceOptions, true);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_UU_VCH:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Request)", TSBK_IOSP_UU_VCH, srcId);
|
|
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Request)", TSBK_IOSP_UU_VCH, srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID("TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Request)", TSBK_IOSP_UU_VCH, srcId, dstId);
|
|
|
|
// verify the source RID is registered
|
|
VERIFY_SRCID_REG("TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Request)", TSBK_IOSP_UU_VCH, srcId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Request), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
if (m_unitToUnitAvailCheck) {
|
|
writeRF_TSDU_UU_Ans_Req(srcId, dstId);
|
|
}
|
|
else {
|
|
uint8_t serviceOptions = (tsbk->getEmergency() ? 0x80U : 0x00U) + // Emergency Flag
|
|
(tsbk->getEncrypted() ? 0x40U : 0x00U) + // Encrypted Flag
|
|
(tsbk->getPriority() & 0x07U); // Priority
|
|
|
|
writeRF_TSDU_Grant(srcId, dstId, serviceOptions, false);
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_IOSP_UU_ANS:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_IOSP_UU_ANS (Unit-to-Unit Answer Response)", TSBK_IOSP_UU_ANS, srcId);
|
|
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_UU_ANS (Unit-to-Unit Answer Response)", TSBK_IOSP_UU_ANS, srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID("TSBK_IOSP_UU_ANS (Unit-to-Unit Answer Response)", TSBK_IOSP_UU_ANS, srcId, dstId);
|
|
|
|
IOSP_UU_ANS* iosp = static_cast<IOSP_UU_ANS*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_UU_ANS (Unit-to-Unit Answer Response), response = $%02X, srcId = %u, dstId = %u",
|
|
iosp->getResponse(), srcId, dstId);
|
|
}
|
|
|
|
if (iosp->getResponse() == P25_ANS_RSP_PROCEED) {
|
|
if (m_p25->m_ackTSBKRequests) {
|
|
writeRF_TSDU_ACK_FNE(dstId, TSBK_IOSP_UU_ANS, false, true);
|
|
}
|
|
|
|
uint8_t serviceOptions = (tsbk->getEmergency() ? 0x80U : 0x00U) + // Emergency Flag
|
|
(tsbk->getEncrypted() ? 0x40U : 0x00U) + // Encrypted Flag
|
|
(tsbk->getPriority() & 0x07U); // Priority
|
|
|
|
writeRF_TSDU_Grant(srcId, dstId, serviceOptions, false);
|
|
}
|
|
else if (iosp->getResponse() == P25_ANS_RSP_DENY) {
|
|
writeRF_TSDU_Deny(srcId, P25_DENY_RSN_TGT_UNIT_REFUSED, TSBK_IOSP_UU_ANS);
|
|
}
|
|
else if (iosp->getResponse() == P25_ANS_RSP_WAIT) {
|
|
writeRF_TSDU_Queue(srcId, P25_QUE_RSN_TGT_UNIT_QUEUED, TSBK_IOSP_UU_ANS);
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_IOSP_TELE_INT_ANS:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_IOSP_TELE_INT_ANS (Telephone Interconnect Answer Response)", TSBK_IOSP_TELE_INT_ANS, srcId);
|
|
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_TELE_INT_ANS (Telephone Interconnect Answer Response)", TSBK_IOSP_TELE_INT_ANS, srcId);
|
|
|
|
writeRF_TSDU_Deny(srcId, P25_DENY_RSN_SYS_UNSUPPORTED_SVC, TSBK_IOSP_TELE_INT_ANS);
|
|
}
|
|
break;
|
|
case TSBK_ISP_SNDCP_CH_REQ:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_ISP_SNDCP_CH_REQ (SNDCP Channel Request)", TSBK_ISP_SNDCP_CH_REQ, srcId);
|
|
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_ISP_SNDCP_CH_REQ (SNDCP Channel Request)", TSBK_ISP_SNDCP_CH_REQ, srcId);
|
|
|
|
ISP_SNDCP_CH_REQ* isp = static_cast<ISP_SNDCP_CH_REQ*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_SNDCP_CH_REQ (SNDCP Channel Request), dataServiceOptions = $%02X, dataAccessControl = %u, srcId = %u",
|
|
isp->getDataServiceOptions(), isp->getDataAccessControl(), srcId);
|
|
}
|
|
|
|
if (m_sndcpChGrant) {
|
|
writeRF_TSDU_SNDCP_Grant(false, false);
|
|
}
|
|
else {
|
|
writeRF_TSDU_Deny(srcId, P25_DENY_RSN_SYS_UNSUPPORTED_SVC, TSBK_ISP_SNDCP_CH_REQ);
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_IOSP_STS_UPDT:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_STS_UPDT (Status Update)", TSBK_IOSP_STS_UPDT, srcId);
|
|
|
|
IOSP_STS_UPDT* iosp = static_cast<IOSP_STS_UPDT*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_STS_UPDT (Status Update), status = $%02X, srcId = %u", iosp->getStatus(), srcId);
|
|
}
|
|
|
|
RF_TO_WRITE_NET(iosp);
|
|
|
|
if (!m_noStatusAck) {
|
|
writeRF_TSDU_ACK_FNE(srcId, TSBK_IOSP_STS_UPDT, false, false);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "status update from %u", srcId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_MSG_UPDT:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_MSG_UPDT (Message Update)", TSBK_IOSP_MSG_UPDT, srcId);
|
|
|
|
IOSP_MSG_UPDT* iosp = static_cast<IOSP_MSG_UPDT*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_MSG_UPDT (Message Update), message = $%02X, srcId = %u, dstId = %u",
|
|
iosp->getMessage(), srcId, dstId);
|
|
}
|
|
|
|
RF_TO_WRITE_NET(iosp);
|
|
|
|
if (!m_noMessageAck) {
|
|
writeRF_TSDU_ACK_FNE(srcId, TSBK_IOSP_MSG_UPDT, false, false);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "message update from %u", srcId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_RAD_MON:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_RAD_MON (Radio Monitor)", TSBK_IOSP_RAD_MON, srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID("TSBK_IOSP_RAD_MON (Radio Monitor)", TSBK_IOSP_RAD_MON, srcId, dstId);
|
|
|
|
IOSP_RAD_MON* iosp = static_cast<IOSP_RAD_MON*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_RAD_MON_REQ (Radio Monitor), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25" , true , "radio monitor request from %u to %u" , srcId , dstId);
|
|
|
|
writeRF_TSDU_Radio_Mon(srcId, dstId, iosp->getTxMult());
|
|
}
|
|
break;
|
|
case TSBK_IOSP_CALL_ALRT:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_CALL_ALRT (Call Alert)", TSBK_IOSP_CALL_ALRT, srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID("TSBK_IOSP_CALL_ALRT (Call Alert)", TSBK_IOSP_CALL_ALRT, srcId, dstId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_CALL_ALRT (Call Alert), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "call alert request from %u to %u", srcId, dstId);
|
|
|
|
writeRF_TSDU_Call_Alrt(srcId, dstId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_ACK_RSP:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_IOSP_ACK_RSP (Acknowledge Response)", TSBK_IOSP_ACK_RSP, srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID("TSBK_IOSP_ACK_RSP (Acknowledge Response)", TSBK_IOSP_ACK_RSP, srcId, dstId);
|
|
|
|
IOSP_ACK_RSP* iosp = static_cast<IOSP_ACK_RSP*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_ACK_RSP (Acknowledge Response), AIV = %u, serviceType = $%02X, srcId = %u, dstId = %u",
|
|
iosp->getAIV(), iosp->getService(), srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "ack response from %u to %u", srcId, dstId);
|
|
|
|
// bryanb: HACK -- for some reason, if the AIV is false and we have a dstId
|
|
// its very likely srcId and dstId are swapped so we'll swap them
|
|
if (!iosp->getAIV() && dstId != 0U) {
|
|
iosp->setAIV(true);
|
|
iosp->setSrcId(dstId);
|
|
iosp->setDstId(srcId);
|
|
}
|
|
|
|
writeRF_TSDU_SBF(iosp, false);
|
|
}
|
|
break;
|
|
case TSBK_ISP_CAN_SRV_REQ:
|
|
{
|
|
ISP_CAN_SRV_REQ* isp = static_cast<ISP_CAN_SRV_REQ*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_CAN_SRV_REQ (Cancel Service Request), AIV = %u, serviceType = $%02X, reason = $%02X, srcId = %u, dstId = %u",
|
|
isp->getAIV(), isp->getService(), isp->getResponse(), srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "cancel service request from %u", srcId);
|
|
|
|
writeRF_TSDU_ACK_FNE(srcId, TSBK_ISP_CAN_SRV_REQ, false, true);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_EXT_FNCT:
|
|
{
|
|
IOSP_EXT_FNCT* iosp = static_cast<IOSP_EXT_FNCT*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_EXT_FNCT (Extended Function), op = $%02X, arg = %u, tgt = %u",
|
|
iosp->getExtendedFunction(), dstId, srcId);
|
|
}
|
|
|
|
// generate activity log entry
|
|
if (iosp->getExtendedFunction() == P25_EXT_FNCT_CHECK_ACK) {
|
|
::ActivityLog("P25", true, "radio check response from %u to %u", dstId, srcId);
|
|
}
|
|
else if (iosp->getExtendedFunction() == P25_EXT_FNCT_INHIBIT_ACK) {
|
|
::ActivityLog("P25", true, "radio inhibit response from %u to %u", dstId, srcId);
|
|
}
|
|
else if (iosp->getExtendedFunction() == P25_EXT_FNCT_UNINHIBIT_ACK) {
|
|
::ActivityLog("P25", true, "radio uninhibit response from %u to %u", dstId, srcId);
|
|
}
|
|
|
|
writeRF_TSDU_SBF(iosp, true);
|
|
}
|
|
break;
|
|
case TSBK_ISP_EMERG_ALRM_REQ:
|
|
{
|
|
if (!m_p25->m_emergDisabled) {
|
|
ISP_EMERG_ALRM_REQ* isp = static_cast<ISP_EMERG_ALRM_REQ*>(tsbk.get());
|
|
if (isp->getEmergency()) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_EMERG_ALRM_REQ (Emergency Alarm Request), srcId = %u, dstId = %u",
|
|
srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "emergency alarm request request from %u", srcId);
|
|
|
|
writeRF_TSDU_ACK_FNE(srcId, TSBK_ISP_EMERG_ALRM_REQ, false, true);
|
|
if (m_localEmergAlarm) {
|
|
writeRF_TSDU_Emerg_Alrm(srcId, dstId);
|
|
}
|
|
}
|
|
} else {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_ISP_EMERG_ALRM_REQ (Emergency Alarm Request) denial, emergency while emergency disabled, srcId = %u", srcId);
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_IOSP_GRP_AFF:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_IOSP_GRP_AFF (Group Affiliation Request)", TSBK_IOSP_GRP_AFF, srcId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_AFF (Group Affiliation Request), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
if (m_p25->m_ackTSBKRequests) {
|
|
writeRF_TSDU_ACK_FNE(srcId, TSBK_IOSP_GRP_AFF, true, true);
|
|
}
|
|
|
|
writeRF_TSDU_Grp_Aff_Rsp(srcId, dstId);
|
|
}
|
|
break;
|
|
case TSBK_ISP_GRP_AFF_Q_RSP:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_IOSP_GRP_AFF (Group Affiliation Query Response)", TSBK_ISP_GRP_AFF_Q_RSP, srcId);
|
|
|
|
ISP_GRP_AFF_Q_RSP* isp = static_cast<ISP_GRP_AFF_Q_RSP*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_AFF (Group Affiliation Query Response), srcId = %u, dstId = %u, anncId = %u", srcId, dstId,
|
|
isp->getAnnounceGroup());
|
|
}
|
|
|
|
::ActivityLog("P25", true, "group affiliation query response from %u to %s %u", srcId, "TG ", dstId);
|
|
}
|
|
break;
|
|
case TSBK_ISP_U_DEREG_REQ:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_ISP_U_DEREG_REQ (Unit Deregistration Request)", TSBK_ISP_U_DEREG_REQ, srcId);
|
|
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_ISP_U_DEREG_REQ (Unit Deregistration Request)", TSBK_ISP_U_DEREG_REQ, srcId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_U_DEREG_REQ (Unit Deregistration Request) srcId = %u, sysId = $%03X, netId = $%05X",
|
|
srcId, tsbk->getSysId(), tsbk->getNetId());
|
|
}
|
|
|
|
if (m_p25->m_ackTSBKRequests) {
|
|
writeRF_TSDU_ACK_FNE(srcId, TSBK_ISP_U_DEREG_REQ, true, true);
|
|
}
|
|
|
|
writeRF_TSDU_U_Dereg_Ack(srcId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_U_REG:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_ISP_U_REG_REQ (Unit Registration Request)", TSBK_IOSP_U_REG, srcId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_U_REG_REQ (Unit Registration Request), srcId = %u, sysId = $%03X, netId = $%05X",
|
|
srcId, tsbk->getSysId(), tsbk->getNetId());
|
|
}
|
|
|
|
if (m_p25->m_ackTSBKRequests) {
|
|
writeRF_TSDU_ACK_FNE(srcId, TSBK_IOSP_U_REG, true, true);
|
|
}
|
|
|
|
writeRF_TSDU_U_Reg_Rsp(srcId, tsbk->getSysId());
|
|
}
|
|
break;
|
|
case TSBK_ISP_LOC_REG_REQ:
|
|
{
|
|
// make sure control data is supported
|
|
IS_SUPPORT_CONTROL_CHECK("TSBK_ISP_LOC_REG_REQ (Location Registration Request)", TSBK_ISP_LOC_REG_REQ, srcId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_LOC_REG_REQ (Location Registration Request), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
writeRF_TSDU_Loc_Reg_Rsp(srcId, dstId, tsbk->getGroup());
|
|
}
|
|
break;
|
|
default:
|
|
LogError(LOG_RF, P25_TSDU_STR ", unhandled LCO, mfId = $%02X, lco = $%02X", tsbk->getMFId(), tsbk->getLCO());
|
|
break;
|
|
} // switch (tsbk->getLCO())
|
|
|
|
// add trailing null pad; only if control data isn't being transmitted
|
|
if (!m_p25->m_ccRunning) {
|
|
m_p25->writeRF_Nulls();
|
|
}
|
|
|
|
m_p25->m_rfState = prevRfState;
|
|
return true;
|
|
}
|
|
else {
|
|
LogError(LOG_RF, "P25 unhandled data DUID, duid = $%02X", duid);
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Process a data frame from the network.
|
|
/// </summary>
|
|
/// <param name="data">Buffer containing data frame.</param>
|
|
/// <param name="len">Length of data frame.</param>
|
|
/// <param name="control"></param>
|
|
/// <param name="lsd"></param>
|
|
/// <param name="duid"></param>
|
|
/// <returns></returns>
|
|
bool Trunk::processNetwork(uint8_t* data, uint32_t len, lc::LC& control, data::LowSpeedData& lsd, uint8_t& duid)
|
|
{
|
|
if (!m_p25->m_control)
|
|
return false;
|
|
if (m_p25->m_rfState != RS_RF_LISTENING && m_p25->m_netState == RS_NET_IDLE)
|
|
return false;
|
|
|
|
switch (duid) {
|
|
case P25_DUID_TSDU:
|
|
if (m_p25->m_netState == RS_NET_IDLE) {
|
|
std::unique_ptr<lc::TSBK> tsbk = TSBKFactory::createTSBK(data);
|
|
if (tsbk == nullptr) {
|
|
return false;
|
|
}
|
|
|
|
// handle updating internal adjacent site information
|
|
if (tsbk->getLCO() == TSBK_OSP_ADJ_STS_BCAST) {
|
|
if (!m_p25->m_control) {
|
|
return false;
|
|
}
|
|
|
|
OSP_ADJ_STS_BCAST* osp = static_cast<OSP_ADJ_STS_BCAST*>(tsbk.get());
|
|
if (osp->getAdjSiteId() != m_p25->m_siteData.siteId()) {
|
|
// update site table data
|
|
SiteData site;
|
|
try {
|
|
site = m_adjSiteTable.at(osp->getAdjSiteId());
|
|
} catch (...) {
|
|
site = SiteData();
|
|
}
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_OSP_ADJ_STS_BCAST (Adjacent Site Status Broadcast), sysId = $%03X, rfss = $%02X, site = $%02X, chId = %u, chNo = %u, svcClass = $%02X",
|
|
osp->getAdjSiteSysId(), osp->getAdjSiteRFSSId(), osp->getAdjSiteId(), osp->getAdjSiteChnId(), osp->getAdjSiteChnNo(), osp->getAdjSiteSvcClass());
|
|
}
|
|
|
|
site.setAdjSite(osp->getAdjSiteSysId(), osp->getAdjSiteRFSSId(), osp->getAdjSiteId(), osp->getAdjSiteChnId(), osp->getAdjSiteChnNo(), osp->getAdjSiteSvcClass());
|
|
|
|
m_adjSiteTable[site.siteId()] = site;
|
|
m_adjSiteUpdateCnt[site.siteId()] = ADJ_SITE_UPDATE_CNT;
|
|
} else {
|
|
/*
|
|
** treat same site adjacent site broadcast as a SCCB for this site
|
|
*/
|
|
// update site table data
|
|
SiteData site;
|
|
try {
|
|
site = m_sccbTable.at(osp->getAdjSiteRFSSId());
|
|
}
|
|
catch (...) {
|
|
site = SiteData();
|
|
}
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_OSP_SCCB_EXP (Secondary Control Channel Broadcast), sysId = $%03X, rfss = $%02X, site = $%02X, chId = %u, chNo = %u, svcClass = $%02X",
|
|
osp->getAdjSiteSysId(), osp->getAdjSiteRFSSId(), osp->getAdjSiteId(), osp->getAdjSiteChnId(), osp->getAdjSiteChnNo(), osp->getAdjSiteSvcClass());
|
|
}
|
|
|
|
site.setAdjSite(osp->getAdjSiteSysId(), osp->getAdjSiteRFSSId(), osp->getAdjSiteId(), osp->getAdjSiteChnId(), osp->getAdjSiteChnNo(), osp->getAdjSiteSvcClass());
|
|
|
|
m_sccbTable[site.rfssId()] = site;
|
|
m_sccbUpdateCnt[site.rfssId()] = ADJ_SITE_UPDATE_CNT;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
uint32_t srcId = tsbk->getSrcId();
|
|
uint32_t dstId = tsbk->getDstId();
|
|
|
|
// handle internal DVM TSDUs
|
|
if (tsbk->getMFId() == P25_MFG_DVM) {
|
|
switch (tsbk->getLCO()) {
|
|
case LC_CALL_TERM:
|
|
{
|
|
if (m_p25->m_dedicatedControl) {
|
|
uint32_t chNo = tsbk->getGrpVchNo();
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", LC_CALL_TERM (Call Termination), chNo = %u, srcId = %u, dstId = %u", chNo, srcId, dstId);
|
|
}
|
|
|
|
// is the specified channel granted?
|
|
if (m_p25->m_affiliations.isChBusy(chNo) && m_p25->m_affiliations.isGranted(dstId)) {
|
|
m_p25->m_affiliations.releaseGrant(dstId, false);
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
default:
|
|
LogError(LOG_NET, P25_TSDU_STR ", unhandled LCO, mfId = $%02X, lco = $%02X", tsbk->getMFId(), tsbk->getLCO());
|
|
return false;
|
|
}
|
|
|
|
writeNet_TSDU(tsbk.get());
|
|
return true;
|
|
}
|
|
|
|
// handle standard P25 reference opcodes
|
|
switch (tsbk->getLCO()) {
|
|
case TSBK_IOSP_GRP_VCH:
|
|
{
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_GRP_VCH (Group Voice Channel Grant), emerg = %u, encrypt = %u, prio = %u, chNo = %u, srcId = %u, dstId = %u",
|
|
tsbk->getEmergency(), tsbk->getEncrypted(), tsbk->getPriority(), tsbk->getGrpVchNo(), srcId, dstId);
|
|
}
|
|
|
|
uint8_t serviceOptions = (tsbk->getEmergency() ? 0x80U : 0x00U) + // Emergency Flag
|
|
(tsbk->getEncrypted() ? 0x40U : 0x00U) + // Encrypted Flag
|
|
(tsbk->getPriority() & 0x07U); // Priority
|
|
|
|
// workaround for single channel dedicated sites to pass network traffic on a lone VC
|
|
if (m_p25->m_dedicatedControl && !m_p25->m_voiceOnControl && m_p25->m_affiliations.getRFChCnt() == 1U) {
|
|
writeRF_TSDU_Grant(srcId, dstId, serviceOptions, true);
|
|
}
|
|
}
|
|
return true; // don't allow this to write to the air
|
|
case TSBK_IOSP_UU_VCH:
|
|
{
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Grant), emerg = %u, encrypt = %u, prio = %u, chNo = %u, srcId = %u, dstId = %u",
|
|
tsbk->getEmergency(), tsbk->getEncrypted(), tsbk->getPriority(), tsbk->getGrpVchNo(), srcId, dstId);
|
|
}
|
|
|
|
uint8_t serviceOptions = (tsbk->getEmergency() ? 0x80U : 0x00U) + // Emergency Flag
|
|
(tsbk->getEncrypted() ? 0x40U : 0x00U) + // Encrypted Flag
|
|
(tsbk->getPriority() & 0x07U); // Priority
|
|
|
|
// workaround for single channel dedicated sites to pass network traffic on a lone VC
|
|
if (m_p25->m_dedicatedControl && !m_p25->m_voiceOnControl && m_p25->m_affiliations.getRFChCnt() == 1U) {
|
|
writeRF_TSDU_Grant(srcId, dstId, serviceOptions, false);
|
|
}
|
|
}
|
|
return true; // don't allow this to write to the air
|
|
case TSBK_IOSP_UU_ANS:
|
|
{
|
|
IOSP_UU_ANS* iosp = static_cast<IOSP_UU_ANS*>(tsbk.get());
|
|
if (iosp->getResponse() > 0U) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_UU_ANS (Unit-to-Unit Answer Response), response = $%02X, srcId = %u, dstId = %u",
|
|
iosp->getResponse(), srcId, dstId);
|
|
}
|
|
}
|
|
else {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_UU_ANS (Unit-to-Unit Answer Request), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_IOSP_STS_UPDT:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID_NET("TSBK_IOSP_STS_UPDT (Status Update)", srcId);
|
|
|
|
IOSP_STS_UPDT* iosp = static_cast<IOSP_STS_UPDT*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_STS_UPDT (Status Update), status = $%02X, srcId = %u",
|
|
iosp->getStatus(), srcId);
|
|
}
|
|
|
|
::ActivityLog("P25", false, "status update from %u", srcId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_MSG_UPDT:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID_NET("TSBK_IOSP_MSG_UPDT (Message Update)", srcId);
|
|
|
|
IOSP_MSG_UPDT* iosp = static_cast<IOSP_MSG_UPDT*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_MSG_UPDT (Message Update), message = $%02X, srcId = %u, dstId = %u",
|
|
iosp->getMessage(), srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", false, "message update from %u", srcId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_RAD_MON:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID("TSBK_ISP_RAD_MON_REQ (Radio Monitor)", TSBK_IOSP_RAD_MON, srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID("TSBK_ISP_RAD_MON_REQ (Radio monitor)", TSBK_IOSP_RAD_MON, srcId, dstId);
|
|
|
|
IOSP_RAD_MON* iosp = static_cast<IOSP_RAD_MON*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF , P25_TSDU_STR ", TSBK_ISP_RAD_MON_REQ (Radio Monitor), srcId = %u, dstId = %u" , srcId , dstId);
|
|
}
|
|
|
|
::ActivityLog("P25" , true , "radio monitor request from %u to %u" , srcId , dstId);
|
|
|
|
writeRF_TSDU_Radio_Mon(srcId , dstId , iosp->getTxMult());
|
|
}
|
|
break;
|
|
case TSBK_IOSP_CALL_ALRT:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID_NET("TSBK_IOSP_CALL_ALRT (Call Alert)", srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID_NET("TSBK_IOSP_CALL_ALRT (Call Alert)", dstId);
|
|
|
|
// validate source RID
|
|
if (!acl::AccessControl::validateSrcId(srcId)) {
|
|
LogWarning(LOG_NET, "P25_DUID_TSDU (Trunking System Data Unit) denial, RID rejection, srcId = %u", srcId);
|
|
return false;
|
|
}
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_CALL_ALRT (Call Alert), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", false, "call alert request from %u to %u", srcId, dstId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_ACK_RSP:
|
|
{
|
|
// validate the source RID
|
|
VALID_SRCID_NET("TSBK_IOSP_ACK_RSP (Acknowledge Response)", srcId);
|
|
|
|
// validate the target RID
|
|
VALID_DSTID_NET("TSBK_IOSP_ACK_RSP (Acknowledge Response)", dstId);
|
|
|
|
IOSP_ACK_RSP* iosp = static_cast<IOSP_ACK_RSP*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_ACK_RSP (Acknowledge Response), AIV = %u, serviceType = $%02X, srcId = %u, dstId = %u",
|
|
iosp->getAIV(), iosp->getService(), dstId, srcId);
|
|
}
|
|
|
|
::ActivityLog("P25", false, "ack response from %u to %u", srcId, dstId);
|
|
}
|
|
break;
|
|
case TSBK_IOSP_EXT_FNCT:
|
|
{
|
|
// validate the target RID
|
|
VALID_DSTID_NET("TSBK_IOSP_EXT_FNCT (Extended Function)", dstId);
|
|
|
|
IOSP_EXT_FNCT* iosp = static_cast<IOSP_EXT_FNCT*>(tsbk.get());
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_IOSP_EXT_FNCT (Extended Function), serviceType = $%02X, arg = %u, tgt = %u",
|
|
iosp->getService(), srcId, dstId);
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_ISP_EMERG_ALRM_REQ:
|
|
{
|
|
ISP_EMERG_ALRM_REQ* isp = static_cast<ISP_EMERG_ALRM_REQ*>(tsbk.get());
|
|
|
|
// non-emergency mode is a TSBK_OSP_DENY_RSP
|
|
if (!isp->getEmergency()) {
|
|
// ignore a network deny command
|
|
return true; // don't allow this to write to the air
|
|
} else {
|
|
if (!m_p25->m_emergDisabled) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_ISP_EMERG_ALRM_REQ (Emergency Alarm Request), srcId = %u, dstId = %u",
|
|
srcId, dstId);
|
|
}
|
|
} else {
|
|
LogWarning(LOG_NET, P25_TSDU_STR ", TSBK_ISP_EMERG_ALRM_REQ (Emergency Alarm Request) denial, emergency while emergency disabled, srcId = %u", srcId);
|
|
return true; // don't allow this to write to the air
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_IOSP_GRP_AFF:
|
|
// ignore a network group affiliation command
|
|
return true; // don't allow this to write to the air
|
|
case TSBK_OSP_U_DEREG_ACK:
|
|
// ignore a network user deregistration command
|
|
return true; // don't allow this to write to the air
|
|
case TSBK_OSP_LOC_REG_RSP:
|
|
// ignore a network location registration command
|
|
return true; // don't allow this to write to the air
|
|
case TSBK_OSP_QUE_RSP:
|
|
// ignore a network queue command
|
|
return true; // don't allow this to write to the air
|
|
default:
|
|
LogError(LOG_NET, P25_TSDU_STR ", unhandled LCO, mfId = $%02X, lco = $%02X", tsbk->getMFId(), tsbk->getLCO());
|
|
return false;
|
|
} // switch (tsbk->getLCO())
|
|
|
|
writeNet_TSDU(tsbk.get());
|
|
}
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper used to process AMBTs from PDU data.
|
|
/// </summary>
|
|
/// <param name="dataHeader"></param>
|
|
/// <param name="dataBlock"></param>
|
|
bool Trunk::processMBT(DataHeader dataHeader, DataBlock* blocks)
|
|
{
|
|
uint8_t data[1U];
|
|
::memset(data, 0x00U, 1U);
|
|
|
|
std::unique_ptr<lc::AMBT> ambt = TSBKFactory::createAMBT(dataHeader, blocks);
|
|
if (ambt != nullptr) {
|
|
return process(data, 1U, ambt.get());
|
|
} else {
|
|
return false;
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write P25 adjacent site information to the network.
|
|
/// </summary>
|
|
void Trunk::writeAdjSSNetwork()
|
|
{
|
|
if (!m_p25->m_control) {
|
|
return;
|
|
}
|
|
|
|
if (m_network != nullptr) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TSDU_STR ", TSBK_OSP_ADJ_STS_BCAST (Adjacent Site Status Broadcast), network announce, sysId = $%03X, rfss = $%02X, site = $%02X, chId = %u, chNo = %u, svcClass = $%02X",
|
|
m_p25->m_siteData.sysId(), m_p25->m_siteData.rfssId(), m_p25->m_siteData.siteId(), m_p25->m_siteData.channelId(), m_p25->m_siteData.channelNo(), m_p25->m_siteData.serviceClass());
|
|
}
|
|
|
|
uint8_t cfva = P25_CFVA_VALID;
|
|
if (m_p25->m_control && m_p25->m_voiceOnControl) {
|
|
cfva |= P25_CFVA_CONV;
|
|
}
|
|
|
|
// transmit adjacent site broadcast
|
|
std::unique_ptr<OSP_ADJ_STS_BCAST> osp = new_unique(OSP_ADJ_STS_BCAST);
|
|
osp->setSrcId(P25_WUID_FNE);
|
|
osp->setAdjSiteCFVA(cfva);
|
|
osp->setAdjSiteSysId(m_p25->m_siteData.sysId());
|
|
osp->setAdjSiteRFSSId(m_p25->m_siteData.rfssId());
|
|
osp->setAdjSiteId(m_p25->m_siteData.siteId());
|
|
osp->setAdjSiteChnId(m_p25->m_siteData.channelId());
|
|
osp->setAdjSiteChnNo(m_p25->m_siteData.channelNo());
|
|
osp->setAdjSiteSvcClass(m_p25->m_siteData.serviceClass());
|
|
|
|
RF_TO_WRITE_NET(osp.get());
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Updates the processor by the passed number of milliseconds.
|
|
/// </summary>
|
|
/// <param name="ms"></param>
|
|
void Trunk::clock(uint32_t ms)
|
|
{
|
|
if (m_p25->m_control) {
|
|
if (m_p25->m_network != nullptr) {
|
|
if (m_p25->m_network->isHandlingChGrants() && m_p25->m_siteData.netActive()) {
|
|
bool grp = true;
|
|
uint32_t srcId = 0U;
|
|
uint32_t dstId = 0U;
|
|
uint32_t grpVchNo = 0U;
|
|
|
|
// do we have a grant response?
|
|
if (m_p25->m_network->readGrantRsp(grp, srcId, dstId, grpVchNo)) {
|
|
writeRF_TSDU_Grant(srcId, dstId, 4U, grp, true, grpVchNo, true, true);
|
|
}
|
|
}
|
|
}
|
|
|
|
// clock all the grant timers
|
|
m_p25->m_affiliations.clock(ms);
|
|
|
|
// clock adjacent site and SCCB update timers
|
|
m_adjSiteUpdateTimer.clock(ms);
|
|
if (m_adjSiteUpdateTimer.isRunning() && m_adjSiteUpdateTimer.hasExpired()) {
|
|
// update adjacent site data
|
|
for (auto it = m_adjSiteUpdateCnt.begin(); it != m_adjSiteUpdateCnt.end(); ++it) {
|
|
uint8_t siteId = it->first;
|
|
|
|
uint8_t updateCnt = it->second;
|
|
if (updateCnt > 0U) {
|
|
updateCnt--;
|
|
}
|
|
|
|
if (updateCnt == 0U) {
|
|
SiteData siteData = m_adjSiteTable[siteId];
|
|
LogWarning(LOG_NET, P25_TSDU_STR ", TSBK_OSP_ADJ_STS_BCAST (Adjacent Site Status Broadcast), no data [FAILED], sysId = $%03X, rfss = $%02X, site = $%02X, chId = %u, chNo = %u, svcClass = $%02X",
|
|
siteData.sysId(), siteData.rfssId(), siteData.siteId(), siteData.channelId(), siteData.channelNo(), siteData.serviceClass());
|
|
}
|
|
|
|
m_adjSiteUpdateCnt[siteId] = updateCnt;
|
|
}
|
|
|
|
// update SCCB data
|
|
for (auto it = m_sccbUpdateCnt.begin(); it != m_sccbUpdateCnt.end(); ++it) {
|
|
uint8_t rfssId = it->first;
|
|
|
|
uint8_t updateCnt = it->second;
|
|
if (updateCnt > 0U) {
|
|
updateCnt--;
|
|
}
|
|
|
|
if (updateCnt == 0U) {
|
|
SiteData siteData = m_sccbTable[rfssId];
|
|
LogWarning(LOG_NET, P25_TSDU_STR ", TSBK_OSP_SCCB (Secondary Control Channel Broadcast), no data [FAILED], sysId = $%03X, rfss = $%02X, site = $%02X, chId = %u, chNo = %u, svcClass = $%02X",
|
|
siteData.sysId(), siteData.rfssId(), siteData.siteId(), siteData.channelId(), siteData.channelNo(), siteData.serviceClass());
|
|
}
|
|
|
|
m_sccbUpdateCnt[rfssId] = updateCnt;
|
|
}
|
|
|
|
m_adjSiteUpdateTimer.setTimeout(m_adjSiteUpdateInterval);
|
|
m_adjSiteUpdateTimer.start();
|
|
}
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a call alert packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
void Trunk::writeRF_TSDU_Call_Alrt(uint32_t srcId, uint32_t dstId)
|
|
{
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_CALL_ALRT (Call Alert), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "call alert request from %u to %u", srcId, dstId);
|
|
|
|
std::unique_ptr<IOSP_CALL_ALRT> iosp = new_unique(IOSP_CALL_ALRT);
|
|
iosp->setSrcId(srcId);
|
|
iosp->setDstId(dstId);
|
|
|
|
writeRF_TSDU_SBF(iosp.get(), false);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a radio monitor packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
/// <param name="txMult"></param>
|
|
void Trunk::writeRF_TSDU_Radio_Mon(uint32_t srcId, uint32_t dstId, uint8_t txMult)
|
|
{
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF , P25_TSDU_STR ", TSBK_OSP_RAD_MON_CMD (Radio monitor), srcId = %u, dstId = %u, txMult = %u" , srcId, dstId, txMult);
|
|
}
|
|
|
|
::ActivityLog("P25" , true , "Radio Unit Monitor request from %u to %u" , srcId , dstId);
|
|
|
|
std::unique_ptr<IOSP_RAD_MON> iosp = new_unique(IOSP_RAD_MON);
|
|
iosp->setSrcId(srcId);
|
|
iosp->setDstId(dstId);
|
|
iosp->setTxMult(txMult);
|
|
|
|
writeRF_TSDU_SBF(iosp.get(), false);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a extended function packet.
|
|
/// </summary>
|
|
/// <param name="func"></param>
|
|
/// <param name="arg"></param>
|
|
/// <param name="dstId"></param>
|
|
void Trunk::writeRF_TSDU_Ext_Func(uint32_t func, uint32_t arg, uint32_t dstId)
|
|
{
|
|
std::unique_ptr<IOSP_EXT_FNCT> iosp = new_unique(IOSP_EXT_FNCT);
|
|
iosp->setExtendedFunction(func);
|
|
iosp->setSrcId(arg);
|
|
iosp->setDstId(dstId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_EXT_FNCT (Extended Function), op = $%02X, arg = %u, tgt = %u",
|
|
iosp->getExtendedFunction(), iosp->getSrcId(), iosp->getDstId());
|
|
}
|
|
|
|
// generate activity log entry
|
|
if (func == P25_EXT_FNCT_CHECK) {
|
|
::ActivityLog("P25", true, "radio check request from %u to %u", arg, dstId);
|
|
}
|
|
else if (func == P25_EXT_FNCT_INHIBIT) {
|
|
::ActivityLog("P25", true, "radio inhibit request from %u to %u", arg, dstId);
|
|
}
|
|
else if (func == P25_EXT_FNCT_UNINHIBIT) {
|
|
::ActivityLog("P25", true, "radio uninhibit request from %u to %u", arg, dstId);
|
|
}
|
|
|
|
writeRF_TSDU_SBF(iosp.get(), false);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a group affiliation query packet.
|
|
/// </summary>
|
|
/// <param name="dstId"></param>
|
|
void Trunk::writeRF_TSDU_Grp_Aff_Q(uint32_t dstId)
|
|
{
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_GRP_AFF_Q (Group Affiliation Query), dstId = %u", dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "group affiliation query command from %u to %u", P25_WUID_FNE, dstId);
|
|
|
|
std::unique_ptr<OSP_GRP_AFF_Q> osp = new_unique(OSP_GRP_AFF_Q);
|
|
osp->setSrcId(P25_WUID_FNE);
|
|
osp->setDstId(dstId);
|
|
|
|
writeRF_TSDU_SBF(osp.get(), true);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a unit registration command packet.
|
|
/// </summary>
|
|
/// <param name="dstId"></param>
|
|
void Trunk::writeRF_TSDU_U_Reg_Cmd(uint32_t dstId)
|
|
{
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_U_REG_CMD (Unit Registration Command), dstId = %u", dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "unit registration command from %u to %u", P25_WUID_FNE, dstId);
|
|
|
|
std::unique_ptr<OSP_U_REG_CMD> osp = new_unique(OSP_U_REG_CMD);
|
|
osp->setSrcId(P25_WUID_FNE);
|
|
osp->setDstId(dstId);
|
|
|
|
writeRF_TSDU_SBF(osp.get(), true);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a emergency alarm packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
void Trunk::writeRF_TSDU_Emerg_Alrm(uint32_t srcId, uint32_t dstId)
|
|
{
|
|
if (m_p25->m_emergDisabled) {
|
|
return;
|
|
}
|
|
|
|
std::unique_ptr<ISP_EMERG_ALRM_REQ> isp = new_unique(ISP_EMERG_ALRM_REQ);
|
|
isp->setSrcId(srcId);
|
|
isp->setDstId(dstId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_EMERG_ALRM_REQ (Emergency Alarm Request), srcId = %u, dstId = %u",
|
|
srcId, dstId);
|
|
}
|
|
|
|
writeRF_TSDU_SBF(isp.get(), true);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to change the conventional fallback state.
|
|
/// </summary>
|
|
/// <param name="verbose">Flag indicating whether conventional fallback is enabled.</param>
|
|
void Trunk::setConvFallback(bool fallback)
|
|
{
|
|
m_convFallback = fallback;
|
|
if (m_convFallback && m_p25->m_control) {
|
|
m_convFallbackPacketDelay = 0U;
|
|
|
|
std::unique_ptr<OSP_MOT_PSH_CCH> osp = new_unique(OSP_MOT_PSH_CCH);
|
|
for (uint8_t i = 0U; i < 3U; i++) {
|
|
writeRF_TSDU_SBF(osp.get(), true);
|
|
}
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to change the TSBK verbose state.
|
|
/// </summary>
|
|
/// <param name="verbose">Flag indicating whether TSBK dumping is enabled.</param>
|
|
void Trunk::setTSBKVerbose(bool verbose)
|
|
{
|
|
m_dumpTSBK = verbose;
|
|
lc::TSBK::setVerbose(verbose);
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Protected Class Members
|
|
// ---------------------------------------------------------------------------
|
|
|
|
/// <summary>
|
|
/// Initializes a new instance of the Trunk class.
|
|
/// </summary>
|
|
/// <param name="p25">Instance of the Control class.</param>
|
|
/// <param name="network">Instance of the BaseNetwork class.</param>
|
|
/// <param name="dumpTSBKData">Flag indicating whether TSBK data is dumped to the log.</param>
|
|
/// <param name="debug">Flag indicating whether P25 debug is enabled.</param>
|
|
/// <param name="verbose">Flag indicating whether P25 verbose logging is enabled.</param>
|
|
Trunk::Trunk(Control* p25, network::BaseNetwork* network, bool dumpTSBKData, bool debug, bool verbose) :
|
|
m_p25(p25),
|
|
m_network(network),
|
|
m_patchSuperGroup(0xFFFFU),
|
|
m_verifyAff(false),
|
|
m_verifyReg(false),
|
|
m_rfMBF(nullptr),
|
|
m_mbfCnt(0U),
|
|
m_mbfIdenCnt(0U),
|
|
m_mbfAdjSSCnt(0U),
|
|
m_mbfSCCBCnt(0U),
|
|
m_mbfGrpGrntCnt(0U),
|
|
m_adjSiteTable(),
|
|
m_adjSiteUpdateCnt(),
|
|
m_sccbTable(),
|
|
m_sccbUpdateCnt(),
|
|
m_noStatusAck(false),
|
|
m_noMessageAck(true),
|
|
m_unitToUnitAvailCheck(true),
|
|
m_convFallbackPacketDelay(0U),
|
|
m_convFallback(false),
|
|
m_adjSiteUpdateTimer(1000U),
|
|
m_adjSiteUpdateInterval(ADJ_SITE_TIMER_TIMEOUT),
|
|
m_microslotCount(0U),
|
|
m_ctrlTSDUMBF(true),
|
|
m_localEmergAlarm(false),
|
|
m_sndcpChGrant(false),
|
|
m_dumpTSBK(dumpTSBKData),
|
|
m_verbose(verbose),
|
|
m_debug(debug)
|
|
{
|
|
m_rfMBF = new uint8_t[P25_MAX_PDU_COUNT * P25_LDU_FRAME_LENGTH_BYTES + 2U];
|
|
::memset(m_rfMBF, 0x00U, P25_MAX_PDU_COUNT * P25_LDU_FRAME_LENGTH_BYTES + 2U);
|
|
|
|
m_adjSiteTable.clear();
|
|
m_adjSiteUpdateCnt.clear();
|
|
|
|
m_sccbTable.clear();
|
|
m_sccbUpdateCnt.clear();
|
|
|
|
m_adjSiteUpdateInterval = ADJ_SITE_TIMER_TIMEOUT;
|
|
m_adjSiteUpdateTimer.setTimeout(m_adjSiteUpdateInterval);
|
|
m_adjSiteUpdateTimer.start();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Finalizes a instance of the Trunk class.
|
|
/// </summary>
|
|
Trunk::~Trunk()
|
|
{
|
|
delete[] m_rfMBF;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Write data processed from RF to the network.
|
|
/// </summary>
|
|
/// <param name="tsbk"></param>
|
|
/// <param name="data"></param>
|
|
/// <param name="autoReset"></param>
|
|
void Trunk::writeNetworkRF(lc::TSBK* tsbk, const uint8_t* data, bool autoReset)
|
|
{
|
|
assert(tsbk != nullptr);
|
|
assert(data != nullptr);
|
|
|
|
if (m_network == nullptr)
|
|
return;
|
|
|
|
if (m_p25->m_rfTimeout.isRunning() && m_p25->m_rfTimeout.hasExpired())
|
|
return;
|
|
|
|
lc::LC lc = lc::LC();
|
|
lc.setLCO(tsbk->getLCO());
|
|
lc.setMFId(tsbk->getMFId());
|
|
lc.setSrcId(tsbk->getSrcId());
|
|
lc.setDstId(tsbk->getDstId());
|
|
|
|
m_network->writeP25TSDU(lc, data);
|
|
if (autoReset)
|
|
m_network->resetP25();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Write data processed from RF to the network.
|
|
/// </summary>
|
|
/// <param name="tduLc"></param>
|
|
/// <param name="data"></param>
|
|
/// <param name="autoReset"></param>
|
|
void Trunk::writeNetworkRF(lc::TDULC& tduLc, const uint8_t* data, bool autoReset)
|
|
{
|
|
assert(data != nullptr);
|
|
|
|
if (m_network == nullptr)
|
|
return;
|
|
|
|
if (m_p25->m_rfTimeout.isRunning() && m_p25->m_rfTimeout.hasExpired())
|
|
return;
|
|
|
|
lc::LC lc = lc::LC();
|
|
lc.setLCO(tduLc.getLCO());
|
|
lc.setMFId(tduLc.getMFId());
|
|
lc.setSrcId(tduLc.getSrcId());
|
|
lc.setDstId(tduLc.getDstId());
|
|
|
|
m_network->writeP25TSDU(lc, data);
|
|
if (autoReset)
|
|
m_network->resetP25();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write control channel packet data.
|
|
/// </summary>
|
|
/// <param name="frameCnt"></param>
|
|
/// <param name="n"></param>
|
|
/// <param name="adjSS"></param>
|
|
void Trunk::writeRF_ControlData(uint8_t frameCnt, uint8_t n, bool adjSS)
|
|
{
|
|
if (!m_p25->m_control)
|
|
return;
|
|
|
|
if (m_convFallback) {
|
|
bool fallbackTx = (frameCnt % 253U) == 0U;
|
|
if (fallbackTx && n == 7U) {
|
|
if (m_convFallbackPacketDelay >= CONV_FALLBACK_PACKET_DELAY) {
|
|
lc::TDULC lc = lc::TDULC();
|
|
lc.setLCO(LC_CONV_FALLBACK);
|
|
|
|
for (uint8_t i = 0U; i < 3U; i++) {
|
|
writeRF_TDULC(lc, true);
|
|
}
|
|
|
|
m_convFallbackPacketDelay = 0U;
|
|
} else {
|
|
m_convFallbackPacketDelay++;
|
|
}
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
if (m_debug) {
|
|
LogDebug(LOG_P25, "writeRF_ControlData, mbfCnt = %u, frameCnt = %u, seq = %u, adjSS = %u", m_mbfCnt, frameCnt, n, adjSS);
|
|
}
|
|
|
|
// bryanb: this is just a simple counter because we treat the SYNC_BCST as unlocked
|
|
m_microslotCount++;
|
|
if (m_microslotCount > 7999U)
|
|
m_microslotCount = 0;
|
|
|
|
bool forcePad = false;
|
|
bool alt = (frameCnt % 2U) > 0U;
|
|
switch (n)
|
|
{
|
|
/** required data */
|
|
case 0:
|
|
default:
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_IDEN_UP);
|
|
break;
|
|
case 1:
|
|
if (alt)
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_RFSS_STS_BCAST);
|
|
else
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_NET_STS_BCAST);
|
|
break;
|
|
case 2:
|
|
if (alt)
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_NET_STS_BCAST);
|
|
else
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_RFSS_STS_BCAST);
|
|
break;
|
|
case 3:
|
|
if (alt)
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_RFSS_STS_BCAST);
|
|
else
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_NET_STS_BCAST);
|
|
break;
|
|
case 4:
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_SYNC_BCAST);
|
|
break;
|
|
/** update data */
|
|
case 5:
|
|
if (m_p25->m_affiliations.grantSize() > 0) {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_GRP_VCH_GRANT_UPD);
|
|
}
|
|
break;
|
|
/** extra data */
|
|
case 6:
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_SNDCP_CH_ANN);
|
|
break;
|
|
case 7:
|
|
// write ADJSS
|
|
if (adjSS && m_adjSiteTable.size() > 0) {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_ADJ_STS_BCAST);
|
|
break;
|
|
} else {
|
|
forcePad = true;
|
|
}
|
|
break;
|
|
case 8:
|
|
// write SCCB
|
|
if (adjSS && m_sccbTable.size() > 0) {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_SCCB_EXP);
|
|
break;
|
|
}
|
|
break;
|
|
}
|
|
|
|
// should we insert the BSI bursts?
|
|
bool bsi = (frameCnt % 127U) == 0U;
|
|
if (bsi && n > 3U) {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_MOT_CC_BSI);
|
|
}
|
|
|
|
// shuld we insert the Git Hash burst?
|
|
bool hash = (frameCnt % 125U) == 0U;
|
|
if (hash && n > 3U) {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_DVM_GIT_HASH);
|
|
}
|
|
|
|
// add padding after the last sequence or if forced; and only
|
|
// if we're doing multiblock frames (MBF)
|
|
if ((n >= 4U || forcePad) && m_ctrlTSDUMBF)
|
|
{
|
|
// pad MBF if we have 1 queued TSDUs
|
|
if (m_mbfCnt == 1U) {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_RFSS_STS_BCAST);
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_NET_STS_BCAST);
|
|
if (m_debug) {
|
|
LogDebug(LOG_P25, "writeRF_ControlData, have 1 pad 2, mbfCnt = %u", m_mbfCnt);
|
|
}
|
|
}
|
|
|
|
// pad MBF if we have 2 queued TSDUs
|
|
if (m_mbfCnt == 2U) {
|
|
std::vector<::lookups::IdenTable> entries = m_p25->m_idenTable->list();
|
|
if (entries.size() > 1U) {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_IDEN_UP);
|
|
}
|
|
else {
|
|
queueRF_TSBK_Ctrl(TSBK_OSP_RFSS_STS_BCAST);
|
|
}
|
|
|
|
if (m_debug) {
|
|
LogDebug(LOG_P25, "writeRF_ControlData, have 2 pad 1, mbfCnt = %u", m_mbfCnt);
|
|
}
|
|
}
|
|
|
|
// reset MBF count
|
|
m_mbfCnt = 0U;
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a P25 TDU w/ link control packet.
|
|
/// </summary>
|
|
/// <param name="lc"></param>
|
|
/// <param name="noNetwork"></param>
|
|
void Trunk::writeRF_TDULC(lc::TDULC lc, bool noNetwork)
|
|
{
|
|
uint8_t data[P25_TDULC_FRAME_LENGTH_BYTES + 2U];
|
|
::memset(data + 2U, 0x00U, P25_TDULC_FRAME_LENGTH_BYTES);
|
|
|
|
// Generate Sync
|
|
Sync::addP25Sync(data + 2U);
|
|
|
|
// Generate NID
|
|
m_p25->m_nid.encode(data + 2U, P25_DUID_TDULC);
|
|
|
|
// Generate TDULC Data
|
|
lc.encode(data + 2U);
|
|
|
|
// Add busy bits
|
|
m_p25->addBusyBits(data + 2U, P25_TDULC_FRAME_LENGTH_BITS, true, true);
|
|
|
|
m_p25->m_rfTimeout.stop();
|
|
|
|
if (!noNetwork)
|
|
writeNetworkRF(lc, data + 2U, P25_DUID_TDULC);
|
|
|
|
if (m_p25->m_duplex) {
|
|
data[0U] = modem::TAG_EOT;
|
|
data[1U] = 0x00U;
|
|
|
|
m_p25->addFrame(data, P25_TDULC_FRAME_LENGTH_BYTES + 2U);
|
|
}
|
|
|
|
//if (m_verbose) {
|
|
// LogMessage(LOG_RF, P25_TDULC_STR ", lc = $%02X, srcId = %u", m_rfTDULC.getLCO(), m_rfTDULC.getSrcId());
|
|
//}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a network P25 TDU w/ link control packet.
|
|
/// </summary>
|
|
/// <param name="lc"></param>
|
|
void Trunk::writeNet_TDULC(lc::TDULC lc)
|
|
{
|
|
uint8_t buffer[P25_TDULC_FRAME_LENGTH_BYTES + 2U];
|
|
::memset(buffer, 0x00U, P25_TDULC_FRAME_LENGTH_BYTES + 2U);
|
|
|
|
buffer[0U] = modem::TAG_EOT;
|
|
buffer[1U] = 0x00U;
|
|
|
|
// Generate Sync
|
|
Sync::addP25Sync(buffer + 2U);
|
|
|
|
// Generate NID
|
|
m_p25->m_nid.encode(buffer + 2U, P25_DUID_TDULC);
|
|
|
|
// Regenerate TDULC Data
|
|
lc.encode(buffer + 2U);
|
|
|
|
// Add busy bits
|
|
m_p25->addBusyBits(buffer + 2U, P25_TDULC_FRAME_LENGTH_BITS, true, true);
|
|
|
|
m_p25->addFrame(buffer, P25_TDULC_FRAME_LENGTH_BYTES + 2U, true);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_NET, P25_TDULC_STR ", lc = $%02X, srcId = %u", lc.getLCO(), lc.getSrcId());
|
|
}
|
|
|
|
if (m_p25->m_voice->m_netFrames > 0) {
|
|
::ActivityLog("P25", false, "network end of transmission, %.1f seconds, %u%% packet loss",
|
|
float(m_p25->m_voice->m_netFrames) / 50.0F, (m_p25->m_voice->m_netLost * 100U) / m_p25->m_voice->m_netFrames);
|
|
}
|
|
else {
|
|
::ActivityLog("P25", false, "network end of transmission, %u frames", m_p25->m_voice->m_netFrames);
|
|
}
|
|
|
|
if (m_network != nullptr)
|
|
m_network->resetP25();
|
|
|
|
m_p25->m_netTimeout.stop();
|
|
m_p25->m_networkWatchdog.stop();
|
|
m_p25->m_netState = RS_NET_IDLE;
|
|
m_p25->m_tailOnIdle = true;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a P25 TDU w/ link control channel release packet.
|
|
/// </summary>
|
|
/// <param name="grp"></param>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
void Trunk::writeRF_TDULC_ChanRelease(bool grp, uint32_t srcId, uint32_t dstId)
|
|
{
|
|
if (!m_p25->m_duplex) {
|
|
return;
|
|
}
|
|
|
|
uint32_t count = m_p25->m_hangCount / 2;
|
|
lc::TDULC lc = lc::TDULC();
|
|
|
|
if (m_p25->m_control) {
|
|
for (uint32_t i = 0; i < count; i++) {
|
|
if ((srcId != 0U) && (dstId != 0U)) {
|
|
lc.setSrcId(srcId);
|
|
lc.setDstId(dstId);
|
|
lc.setEmergency(false);
|
|
|
|
if (grp) {
|
|
lc.setLCO(LC_GROUP);
|
|
writeRF_TDULC(lc, true);
|
|
}
|
|
else {
|
|
lc.setLCO(LC_PRIVATE);
|
|
writeRF_TDULC(lc, true);
|
|
}
|
|
}
|
|
|
|
lc.setLCO(LC_NET_STS_BCAST);
|
|
writeRF_TDULC(lc, true);
|
|
lc.setLCO(LC_RFSS_STS_BCAST);
|
|
writeRF_TDULC(lc, true);
|
|
}
|
|
}
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TDULC_STR ", LC_CALL_TERM (Call Termination), srcId = %u, dstId = %u", lc.getSrcId(), lc.getDstId());
|
|
}
|
|
|
|
lc.setLCO(LC_CALL_TERM);
|
|
writeRF_TDULC(lc, true);
|
|
|
|
if (m_p25->m_control) {
|
|
writeNet_TSDU_Call_Term(srcId, dstId);
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a single-block P25 TSDU packet.
|
|
/// </summary>
|
|
/// <param name="tsbk"></param>
|
|
/// <param name="noNetwork"></param>
|
|
/// <param name="clearBeforeWrite"></param>
|
|
/// <param name="force"></param>
|
|
void Trunk::writeRF_TSDU_SBF(lc::TSBK* tsbk, bool noNetwork, bool clearBeforeWrite, bool force)
|
|
{
|
|
if (!m_p25->m_control)
|
|
return;
|
|
|
|
assert(tsbk != nullptr);
|
|
|
|
uint8_t data[P25_TSDU_FRAME_LENGTH_BYTES + 2U];
|
|
::memset(data + 2U, 0x00U, P25_TSDU_FRAME_LENGTH_BYTES);
|
|
|
|
// Generate Sync
|
|
Sync::addP25Sync(data + 2U);
|
|
|
|
// Generate NID
|
|
m_p25->m_nid.encode(data + 2U, P25_DUID_TSDU);
|
|
|
|
// Generate TSBK block
|
|
tsbk->setLastBlock(true); // always set last block -- this a Single Block TSDU
|
|
tsbk->encode(data + 2U);
|
|
|
|
if (m_debug) {
|
|
LogDebug(LOG_RF, P25_TSDU_STR ", lco = $%02X, mfId = $%02X, lastBlock = %u, AIV = %u, EX = %u, srcId = %u, dstId = %u, sysId = $%03X, netId = $%05X",
|
|
tsbk->getLCO(), tsbk->getMFId(), tsbk->getLastBlock(), tsbk->getAIV(), tsbk->getEX(), tsbk->getSrcId(), tsbk->getDstId(),
|
|
tsbk->getSysId(), tsbk->getNetId());
|
|
|
|
Utils::dump(1U, "!!! *TSDU (SBF) TSBK Block Data", data + P25_PREAMBLE_LENGTH_BYTES + 2U, P25_TSBK_FEC_LENGTH_BYTES);
|
|
}
|
|
|
|
// Add busy bits
|
|
m_p25->addBusyBits(data + 2U, P25_TSDU_FRAME_LENGTH_BITS, true, false);
|
|
|
|
// Set first busy bits to 1,1
|
|
m_p25->setBusyBits(data + 2U, P25_SS0_START, true, true);
|
|
|
|
if (!noNetwork)
|
|
writeNetworkRF(tsbk, data + 2U, true);
|
|
|
|
if (!force) {
|
|
if (m_p25->m_dedicatedControl && m_ctrlTSDUMBF) {
|
|
writeRF_TSDU_MBF(tsbk, clearBeforeWrite);
|
|
return;
|
|
}
|
|
|
|
if (m_p25->m_ccRunning && m_ctrlTSDUMBF) {
|
|
writeRF_TSDU_MBF(tsbk, clearBeforeWrite);
|
|
return;
|
|
}
|
|
|
|
if (clearBeforeWrite) {
|
|
m_p25->m_modem->clearP25Data();
|
|
m_p25->m_queue.clear();
|
|
}
|
|
}
|
|
|
|
if (m_p25->m_duplex) {
|
|
data[0U] = modem::TAG_DATA;
|
|
data[1U] = 0x00U;
|
|
|
|
m_p25->addFrame(data, P25_TSDU_FRAME_LENGTH_BYTES + 2U);
|
|
}
|
|
}
|
|
|
|
|
|
/// <summary>
|
|
/// Helper to write a network single-block P25 TSDU packet.
|
|
/// </summary>
|
|
/// <param name="tsbk"></param>
|
|
void Trunk::writeNet_TSDU(lc::TSBK* tsbk)
|
|
{
|
|
assert(tsbk != nullptr);
|
|
|
|
uint8_t buffer[P25_TSDU_FRAME_LENGTH_BYTES + 2U];
|
|
::memset(buffer, 0x00U, P25_TSDU_FRAME_LENGTH_BYTES + 2U);
|
|
|
|
buffer[0U] = modem::TAG_DATA;
|
|
buffer[1U] = 0x00U;
|
|
|
|
// Generate Sync
|
|
Sync::addP25Sync(buffer + 2U);
|
|
|
|
// Generate NID
|
|
m_p25->m_nid.encode(buffer + 2U, P25_DUID_TSDU);
|
|
|
|
// Regenerate TSDU Data
|
|
tsbk->setLastBlock(true); // always set last block -- this a Single Block TSDU
|
|
tsbk->encode(buffer + 2U);
|
|
|
|
// Add busy bits
|
|
m_p25->addBusyBits(buffer + 2U, P25_TSDU_FRAME_LENGTH_BYTES, true, false);
|
|
|
|
// Set first busy bits to 1,1
|
|
m_p25->setBusyBits(buffer + 2U, P25_SS0_START, true, true);
|
|
|
|
m_p25->addFrame(buffer, P25_TSDU_FRAME_LENGTH_BYTES + 2U, true);
|
|
|
|
if (m_network != nullptr)
|
|
m_network->resetP25();
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a multi-block (3-block) P25 TSDU packet.
|
|
/// </summary>
|
|
/// <param name="tsbk"></param>
|
|
/// <param name="clearBeforeWrite"></param>
|
|
void Trunk::writeRF_TSDU_MBF(lc::TSBK* tsbk, bool clearBeforeWrite)
|
|
{
|
|
if (!m_p25->m_control) {
|
|
::memset(m_rfMBF, 0x00U, P25_MAX_PDU_COUNT * P25_LDU_FRAME_LENGTH_BYTES + 2U);
|
|
m_mbfCnt = 0U;
|
|
return;
|
|
}
|
|
|
|
assert(tsbk != nullptr);
|
|
|
|
uint8_t frame[P25_TSBK_FEC_LENGTH_BYTES];
|
|
::memset(frame, 0x00U, P25_TSBK_FEC_LENGTH_BYTES);
|
|
|
|
// LogDebug(LOG_P25, "writeRF_TSDU_MBF, mbfCnt = %u", m_mbfCnt);
|
|
|
|
// trunking data is unsupported in simplex operation
|
|
if (!m_p25->m_duplex) {
|
|
::memset(m_rfMBF, 0x00U, P25_MAX_PDU_COUNT * P25_LDU_FRAME_LENGTH_BYTES + 2U);
|
|
m_mbfCnt = 0U;
|
|
return;
|
|
}
|
|
|
|
if (m_mbfCnt == 0U) {
|
|
::memset(m_rfMBF, 0x00U, P25_TSBK_FEC_LENGTH_BYTES * TSBK_MBF_CNT);
|
|
}
|
|
|
|
// trigger encoding of last block and write to queue
|
|
if (m_mbfCnt + 1U == TSBK_MBF_CNT) {
|
|
// Generate TSBK block
|
|
tsbk->setLastBlock(true); // set last block
|
|
tsbk->encode(frame, true);
|
|
|
|
if (m_debug) {
|
|
LogDebug(LOG_RF, P25_TSDU_STR " (MBF), lco = $%02X, mfId = $%02X, lastBlock = %u, AIV = %u, EX = %u, srcId = %u, dstId = %u, sysId = $%03X, netId = $%05X",
|
|
tsbk->getLCO(), tsbk->getMFId(), tsbk->getLastBlock(), tsbk->getAIV(), tsbk->getEX(), tsbk->getSrcId(), tsbk->getDstId(),
|
|
tsbk->getSysId(), tsbk->getNetId());
|
|
|
|
Utils::dump(1U, "!!! *TSDU MBF Last TSBK Block", frame, P25_TSBK_FEC_LENGTH_BYTES);
|
|
}
|
|
|
|
Utils::setBitRange(frame, m_rfMBF, (m_mbfCnt * P25_TSBK_FEC_LENGTH_BITS), P25_TSBK_FEC_LENGTH_BITS);
|
|
|
|
// Generate TSDU frame
|
|
uint8_t tsdu[P25_TSDU_TRIPLE_FRAME_LENGTH_BYTES];
|
|
::memset(tsdu, 0x00U, P25_TSDU_TRIPLE_FRAME_LENGTH_BYTES);
|
|
|
|
uint32_t offset = 0U;
|
|
for (uint8_t i = 0U; i < m_mbfCnt + 1U; i++) {
|
|
::memset(frame, 0x00U, P25_TSBK_FEC_LENGTH_BYTES);
|
|
Utils::getBitRange(m_rfMBF, frame, offset, P25_TSBK_FEC_LENGTH_BITS);
|
|
|
|
if (m_debug) {
|
|
LogDebug(LOG_RF, P25_TSDU_STR " (MBF), lco = $%02X, mfId = $%02X, lastBlock = %u, AIV = %u, EX = %u, srcId = %u, dstId = %u, sysId = $%03X, netId = $%05X",
|
|
tsbk->getLCO(), tsbk->getMFId(), tsbk->getLastBlock(), tsbk->getAIV(), tsbk->getEX(), tsbk->getSrcId(), tsbk->getDstId(),
|
|
tsbk->getSysId(), tsbk->getNetId());
|
|
|
|
Utils::dump(1U, "!!! *TSDU (MBF) TSBK Block", frame, P25_TSBK_FEC_LENGTH_BYTES);
|
|
}
|
|
|
|
// Add TSBK data
|
|
Utils::setBitRange(frame, tsdu, offset, P25_TSBK_FEC_LENGTH_BITS);
|
|
|
|
offset += P25_TSBK_FEC_LENGTH_BITS;
|
|
}
|
|
|
|
// Utils::dump(2U, "!!! *TSDU DEBUG - tsdu", tsdu, P25_TSDU_TRIPLE_FRAME_LENGTH_BYTES);
|
|
|
|
uint8_t data[P25_TSDU_TRIPLE_FRAME_LENGTH_BYTES + 2U];
|
|
::memset(data + 2U, 0x00U, P25_TSDU_TRIPLE_FRAME_LENGTH_BYTES);
|
|
|
|
// Generate Sync
|
|
Sync::addP25Sync(data + 2U);
|
|
|
|
// Generate NID
|
|
m_p25->m_nid.encode(data + 2U, P25_DUID_TSDU);
|
|
|
|
// interleave
|
|
P25Utils::encode(tsdu, data + 2U, 114U, 720U);
|
|
|
|
// Add busy bits
|
|
m_p25->addBusyBits(data + 2U, P25_TSDU_TRIPLE_FRAME_LENGTH_BITS, true, false);
|
|
|
|
// Add idle bits
|
|
addIdleBits(data + 2U, P25_TSDU_TRIPLE_FRAME_LENGTH_BITS, true, true);
|
|
|
|
data[0U] = modem::TAG_DATA;
|
|
data[1U] = 0x00U;
|
|
|
|
if (clearBeforeWrite) {
|
|
m_p25->m_modem->clearP25Data();
|
|
m_p25->m_queue.clear();
|
|
}
|
|
|
|
m_p25->addFrame(data, P25_TSDU_TRIPLE_FRAME_LENGTH_BYTES + 2U);
|
|
|
|
::memset(m_rfMBF, 0x00U, P25_MAX_PDU_COUNT * P25_LDU_FRAME_LENGTH_BYTES + 2U);
|
|
m_mbfCnt = 0U;
|
|
return;
|
|
}
|
|
|
|
// Generate TSBK block
|
|
tsbk->setLastBlock(false); // clear last block
|
|
tsbk->encode(frame, true);
|
|
|
|
if (m_debug) {
|
|
LogDebug(LOG_RF, P25_TSDU_STR " (MBF), lco = $%02X, mfId = $%02X, lastBlock = %u, AIV = %u, EX = %u, srcId = %u, dstId = %u, sysId = $%03X, netId = $%05X",
|
|
tsbk->getLCO(), tsbk->getMFId(), tsbk->getLastBlock(), tsbk->getAIV(), tsbk->getEX(), tsbk->getSrcId(), tsbk->getDstId(),
|
|
tsbk->getSysId(), tsbk->getNetId());
|
|
|
|
Utils::dump(1U, "!!! *TSDU MBF Block Data", frame, P25_TSBK_FEC_LENGTH_BYTES);
|
|
}
|
|
|
|
Utils::setBitRange(frame, m_rfMBF, (m_mbfCnt * P25_TSBK_FEC_LENGTH_BITS), P25_TSBK_FEC_LENGTH_BITS);
|
|
m_mbfCnt++;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a alternate multi-block trunking PDU packet.
|
|
/// </summary>
|
|
/// <param name="ambt"></param>
|
|
/// <param name="clearBeforeWrite"></param>
|
|
void Trunk::writeRF_TSDU_AMBT(lc::AMBT* ambt, bool clearBeforeWrite)
|
|
{
|
|
if (!m_p25->m_control)
|
|
return;
|
|
|
|
assert(ambt != nullptr);
|
|
|
|
DataHeader header = DataHeader();
|
|
uint8_t pduUserData[P25_PDU_UNCONFIRMED_LENGTH_BYTES * P25_MAX_PDU_COUNT];
|
|
::memset(pduUserData, 0x00U, P25_PDU_UNCONFIRMED_LENGTH_BYTES * P25_MAX_PDU_COUNT);
|
|
|
|
// Generate TSBK block
|
|
ambt->setLastBlock(true); // always set last block -- this a Single Block TSDU
|
|
ambt->encodeMBT(header, pduUserData);
|
|
|
|
if (m_debug) {
|
|
LogDebug(LOG_RF, P25_PDU_STR ", ack = %u, outbound = %u, fmt = $%02X, sap = $%02X, fullMessage = %u, blocksToFollow = %u, padCount = %u, n = %u, seqNo = %u, hdrOffset = %u",
|
|
header.getAckNeeded(), header.getOutbound(), header.getFormat(), header.getSAP(), header.getFullMessage(),
|
|
header.getBlocksToFollow(), header.getPadCount(), header.getNs(), header.getFSN(),
|
|
header.getHeaderOffset());
|
|
LogDebug(LOG_RF, P25_PDU_STR " AMBT, lco = $%02X, mfId = $%02X, lastBlock = %u, AIV = %u, EX = %u, srcId = %u, dstId = %u, sysId = $%03X, netId = $%05X",
|
|
ambt->getLCO(), ambt->getMFId(), ambt->getLastBlock(), ambt->getAIV(), ambt->getEX(), ambt->getSrcId(), ambt->getDstId(),
|
|
ambt->getSysId(), ambt->getNetId());
|
|
|
|
Utils::dump(1U, "!!! *PDU (AMBT) TSBK Block Data", pduUserData, P25_PDU_UNCONFIRMED_LENGTH_BYTES * header.getBlocksToFollow());
|
|
}
|
|
|
|
m_p25->m_data->writeRF_PDU_User(header, pduUserData, clearBeforeWrite);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to generate the given control TSBK into the TSDU frame queue.
|
|
/// </summary>
|
|
/// <param name="lco"></param>
|
|
void Trunk::queueRF_TSBK_Ctrl(uint8_t lco)
|
|
{
|
|
if (!m_p25->m_control)
|
|
return;
|
|
|
|
std::unique_ptr<lc::TSBK> tsbk;
|
|
|
|
switch (lco) {
|
|
case TSBK_OSP_GRP_VCH_GRANT_UPD:
|
|
// write group voice grant update
|
|
if (m_p25->m_affiliations.grantSize() > 0) {
|
|
if (m_mbfGrpGrntCnt >= m_p25->m_affiliations.grantSize())
|
|
m_mbfGrpGrntCnt = 0U;
|
|
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_GRP_VCH_GRANT_UPD (Group Voice Channel Grant Update)");
|
|
}
|
|
|
|
std::unique_ptr<OSP_GRP_VCH_GRANT_UPD> osp = new_unique(OSP_GRP_VCH_GRANT_UPD);
|
|
|
|
bool noData = false;
|
|
uint8_t i = 0U;
|
|
std::unordered_map<uint32_t, uint32_t> grantTable = m_p25->m_affiliations.grantTable();
|
|
for (auto it = grantTable.begin(); it != grantTable.end(); ++it) {
|
|
// no good very bad way of skipping entries...
|
|
if (i != m_mbfGrpGrntCnt) {
|
|
i++;
|
|
continue;
|
|
}
|
|
else {
|
|
uint32_t dstId = it->first;
|
|
uint32_t chNo = it->second;
|
|
|
|
if (chNo == 0U) {
|
|
noData = true;
|
|
m_mbfGrpGrntCnt++;
|
|
break;
|
|
}
|
|
else {
|
|
// transmit group voice grant update
|
|
osp->setLCO(TSBK_OSP_GRP_VCH_GRANT_UPD);
|
|
osp->setDstId(dstId);
|
|
osp->setGrpVchNo(chNo);
|
|
|
|
m_mbfGrpGrntCnt++;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (noData) {
|
|
return; // don't create anything
|
|
} else {
|
|
tsbk = std::move(osp);
|
|
}
|
|
}
|
|
else {
|
|
return; // don't create anything
|
|
}
|
|
break;
|
|
case TSBK_OSP_IDEN_UP:
|
|
{
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_IDEN_UP (Identity Update)");
|
|
}
|
|
|
|
std::vector<::lookups::IdenTable> entries = m_p25->m_idenTable->list();
|
|
if (m_mbfIdenCnt >= entries.size())
|
|
m_mbfIdenCnt = 0U;
|
|
|
|
uint8_t i = 0U;
|
|
for (auto it = entries.begin(); it != entries.end(); ++it) {
|
|
// no good very bad way of skipping entries...
|
|
if (i != m_mbfIdenCnt) {
|
|
i++;
|
|
continue;
|
|
}
|
|
else {
|
|
::lookups::IdenTable entry = *it;
|
|
|
|
// LogDebug(LOG_P25, "baseFrequency = %uHz, txOffsetMhz = %fMHz, chBandwidthKhz = %fKHz, chSpaceKhz = %fKHz",
|
|
// entry.baseFrequency(), entry.txOffsetMhz(), entry.chBandwidthKhz(), entry.chSpaceKhz());
|
|
|
|
// handle 700/800/900 identities
|
|
if (entry.baseFrequency() >= 762000000U) {
|
|
std::unique_ptr<OSP_IDEN_UP> osp = new_unique(OSP_IDEN_UP);
|
|
osp->siteIdenEntry(entry);
|
|
|
|
// transmit channel ident broadcast
|
|
tsbk = std::move(osp);
|
|
}
|
|
else {
|
|
std::unique_ptr<OSP_IDEN_UP_VU> osp = new_unique(OSP_IDEN_UP_VU);
|
|
osp->siteIdenEntry(entry);
|
|
|
|
// transmit channel ident broadcast
|
|
tsbk = std::move(osp);
|
|
}
|
|
|
|
m_mbfIdenCnt++;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
case TSBK_OSP_NET_STS_BCAST:
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_NET_STS_BCAST (Network Status Broadcast)");
|
|
}
|
|
|
|
// transmit net status burst
|
|
tsbk = new_unique(OSP_NET_STS_BCAST);
|
|
break;
|
|
case TSBK_OSP_RFSS_STS_BCAST:
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_RFSS_STS_BCAST (RFSS Status Broadcast)");
|
|
}
|
|
|
|
// transmit rfss status burst
|
|
tsbk = new_unique(OSP_RFSS_STS_BCAST);
|
|
break;
|
|
case TSBK_OSP_ADJ_STS_BCAST:
|
|
// write ADJSS
|
|
if (m_adjSiteTable.size() > 0) {
|
|
if (m_mbfAdjSSCnt >= m_adjSiteTable.size())
|
|
m_mbfAdjSSCnt = 0U;
|
|
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_ADJ_STS_BCAST (Adjacent Site Broadcast)");
|
|
}
|
|
|
|
std::unique_ptr<OSP_ADJ_STS_BCAST> osp = new_unique(OSP_ADJ_STS_BCAST);
|
|
|
|
uint8_t i = 0U;
|
|
for (auto it = m_adjSiteTable.begin(); it != m_adjSiteTable.end(); ++it) {
|
|
// no good very bad way of skipping entries...
|
|
if (i != m_mbfAdjSSCnt) {
|
|
i++;
|
|
continue;
|
|
}
|
|
else {
|
|
SiteData site = it->second;
|
|
|
|
uint8_t cfva = P25_CFVA_NETWORK;
|
|
if (m_adjSiteUpdateCnt[site.siteId()] == 0U) {
|
|
cfva |= P25_CFVA_FAILURE;
|
|
}
|
|
else {
|
|
cfva |= P25_CFVA_VALID;
|
|
}
|
|
|
|
// transmit adjacent site broadcast
|
|
osp->setAdjSiteCFVA(cfva);
|
|
osp->setAdjSiteSysId(site.sysId());
|
|
osp->setAdjSiteRFSSId(site.rfssId());
|
|
osp->setAdjSiteId(site.siteId());
|
|
osp->setAdjSiteChnId(site.channelId());
|
|
osp->setAdjSiteChnNo(site.channelNo());
|
|
osp->setAdjSiteSvcClass(site.serviceClass());
|
|
|
|
tsbk = std::move(osp);
|
|
m_mbfAdjSSCnt++;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
return; // don't create anything
|
|
}
|
|
break;
|
|
case TSBK_OSP_SCCB_EXP:
|
|
// write SCCB
|
|
if (m_sccbTable.size() > 0) {
|
|
if (m_mbfSCCBCnt >= m_sccbTable.size())
|
|
m_mbfSCCBCnt = 0U;
|
|
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_SCCB_EXP (Secondary Control Channel Broadcast)");
|
|
}
|
|
|
|
std::unique_ptr<OSP_SCCB_EXP> osp = new_unique(OSP_SCCB_EXP);
|
|
|
|
uint8_t i = 0U;
|
|
for (auto it = m_sccbTable.begin(); it != m_sccbTable.end(); ++it) {
|
|
// no good very bad way of skipping entries...
|
|
if (i != m_mbfSCCBCnt) {
|
|
i++;
|
|
continue;
|
|
}
|
|
else {
|
|
SiteData site = it->second;
|
|
|
|
// transmit SCCB broadcast
|
|
osp->setLCO(TSBK_OSP_SCCB_EXP);
|
|
osp->setSCCBChnId1(site.channelId());
|
|
osp->setSCCBChnNo(site.channelNo());
|
|
|
|
tsbk = std::move(osp);
|
|
m_mbfSCCBCnt++;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
return; // don't create anything
|
|
}
|
|
break;
|
|
case TSBK_OSP_SNDCP_CH_ANN:
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_SNDCP_CH_ANN (SNDCP Channel Announcement)");
|
|
}
|
|
|
|
// transmit SNDCP announcement
|
|
tsbk = new_unique(OSP_SNDCP_CH_ANN);
|
|
break;
|
|
case TSBK_OSP_SYNC_BCAST:
|
|
{
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF , P25_TSDU_STR ", TSBK_OSP_SYNC_BCAST (Synchronization Broadcast)");
|
|
}
|
|
|
|
// transmit sync broadcast
|
|
std::unique_ptr<OSP_SYNC_BCAST> osp = new_unique(OSP_SYNC_BCAST);
|
|
osp->setMicroslotCount(m_microslotCount);
|
|
tsbk = std::move(osp);
|
|
}
|
|
break;
|
|
|
|
/** Motorola CC data */
|
|
case TSBK_OSP_MOT_PSH_CCH:
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_MOT_PSH_CCH (Motorola Planned Shutdown)");
|
|
}
|
|
|
|
// transmit motorola PSH CCH burst
|
|
tsbk = new_unique(OSP_MOT_PSH_CCH);
|
|
break;
|
|
|
|
case TSBK_OSP_MOT_CC_BSI:
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_MOT_CC_BSI (Motorola Control Channel BSI)");
|
|
}
|
|
|
|
// transmit motorola CC BSI burst
|
|
tsbk = new_unique(OSP_MOT_CC_BSI);
|
|
break;
|
|
|
|
/** DVM CC data */
|
|
case TSBK_OSP_DVM_GIT_HASH:
|
|
if (m_debug) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_DVM_GIT_HASH (DVM Git Hash)");
|
|
}
|
|
|
|
// transmit git hash burst
|
|
tsbk = new_unique(OSP_DVM_GIT_HASH);
|
|
break;
|
|
}
|
|
|
|
if (tsbk != nullptr) {
|
|
tsbk->setLastBlock(true); // always set last block
|
|
|
|
// are we transmitting CC as a multi-block?
|
|
if (m_ctrlTSDUMBF) {
|
|
writeRF_TSDU_MBF(tsbk.get());
|
|
}
|
|
else {
|
|
writeRF_TSDU_SBF(tsbk.get(), true);
|
|
}
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a grant packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
/// <param name="chNo"></param>
|
|
/// <param name="grp"></param>
|
|
/// <param name="skip"></param>
|
|
/// <param name="net"></param>
|
|
/// <param name="skipNetCheck"></param>
|
|
/// <returns></returns>
|
|
bool Trunk::writeRF_TSDU_Grant(uint32_t srcId, uint32_t dstId, uint8_t serviceOptions, bool grp, bool skip, uint32_t chNo, bool net, bool skipNetCheck)
|
|
{
|
|
bool emergency = ((serviceOptions & 0xFFU) & 0x80U) == 0x80U; // Emergency Flag
|
|
bool encryption = ((serviceOptions & 0xFFU) & 0x40U) == 0x40U; // Encryption Flag
|
|
uint8_t priority = ((serviceOptions & 0xFFU) & 0x07U); // Priority
|
|
|
|
if (dstId == P25_TGID_ALL) {
|
|
return true; // do not generate grant packets for $FFFF (All Call) TGID
|
|
}
|
|
|
|
// do we have a network connection and are we handling grants at the network?
|
|
if (m_p25->m_network != nullptr) {
|
|
if (m_p25->m_network->isHandlingChGrants() && m_p25->m_siteData.netActive() && !skipNetCheck) {
|
|
return m_p25->m_network->writeGrantReq(grp, srcId, dstId);
|
|
}
|
|
}
|
|
|
|
// are we skipping checking?
|
|
if (!skip) {
|
|
if (m_p25->m_rfState != RS_RF_LISTENING && m_p25->m_rfState != RS_RF_DATA) {
|
|
if (!net) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_VCH (Group Voice Channel Request) denied, traffic in progress, dstId = %u", dstId);
|
|
writeRF_TSDU_Deny(srcId, P25_DENY_RSN_PTT_COLLIDE, (grp) ? TSBK_IOSP_GRP_VCH : TSBK_IOSP_UU_VCH);
|
|
|
|
::ActivityLog("P25", true, "group grant request from %u to TG %u denied", srcId, dstId);
|
|
m_p25->m_rfState = RS_RF_REJECTED;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
if (m_p25->m_netState != RS_NET_IDLE && dstId == m_p25->m_netLastDstId) {
|
|
if (!net) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_VCH (Group Voice Channel Request) denied, traffic in progress, dstId = %u", dstId);
|
|
writeRF_TSDU_Deny(srcId, P25_DENY_RSN_PTT_COLLIDE, (grp) ? TSBK_IOSP_GRP_VCH : TSBK_IOSP_UU_VCH);
|
|
|
|
::ActivityLog("P25", true, "group grant request from %u to TG %u denied", srcId, dstId);
|
|
m_p25->m_rfState = RS_RF_REJECTED;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
// don't transmit grants if the destination ID's don't match and the network TG hang timer is running
|
|
if (m_p25->m_rfLastDstId != 0U) {
|
|
if (m_p25->m_rfLastDstId != dstId && (m_p25->m_rfTGHang.isRunning() && !m_p25->m_rfTGHang.hasExpired())) {
|
|
if (!net) {
|
|
writeRF_TSDU_Deny(srcId, P25_DENY_RSN_PTT_BONK, (grp) ? TSBK_IOSP_GRP_VCH : TSBK_IOSP_UU_VCH);
|
|
m_p25->m_rfState = RS_RF_REJECTED;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
}
|
|
|
|
if (!m_p25->m_affiliations.isGranted(dstId)) {
|
|
if (!m_p25->m_affiliations.isRFChAvailable()) {
|
|
if (grp) {
|
|
if (!net) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_VCH (Group Voice Channel Request) queued, no channels available, dstId = %u", dstId);
|
|
writeRF_TSDU_Queue(srcId, P25_QUE_RSN_CHN_RESOURCE_NOT_AVAIL, TSBK_IOSP_GRP_VCH);
|
|
|
|
::ActivityLog("P25", true, "group grant request from %u to TG %u queued", srcId, dstId);
|
|
m_p25->m_rfState = RS_RF_REJECTED;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
else {
|
|
if (!net) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Request) queued, no channels available, dstId = %u", dstId);
|
|
writeRF_TSDU_Queue(srcId, P25_QUE_RSN_CHN_RESOURCE_NOT_AVAIL, TSBK_IOSP_UU_VCH);
|
|
|
|
::ActivityLog("P25", true, "unit-to-unit grant request from %u to %u queued", srcId, dstId);
|
|
m_p25->m_rfState = RS_RF_REJECTED;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
}
|
|
else {
|
|
if (m_p25->m_affiliations.grantCh(dstId, GRANT_TIMER_TIMEOUT)) {
|
|
chNo = m_p25->m_affiliations.getGrantedCh(dstId);
|
|
m_p25->m_siteData.setChCnt(m_p25->m_affiliations.getRFChCnt() + m_p25->m_affiliations.getGrantedRFChCnt());
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
chNo = m_p25->m_affiliations.getGrantedCh(dstId);
|
|
m_p25->m_affiliations.touchGrant(dstId);
|
|
}
|
|
}
|
|
|
|
if (chNo > 0U) {
|
|
if (grp) {
|
|
if (!net) {
|
|
::ActivityLog("P25", true, "group grant request from %u to TG %u", srcId, dstId);
|
|
}
|
|
|
|
std::unique_ptr<IOSP_GRP_VCH> iosp = new_unique(IOSP_GRP_VCH);
|
|
iosp->setSrcId(srcId);
|
|
iosp->setDstId(dstId);
|
|
iosp->setGrpVchNo(chNo);
|
|
iosp->setEmergency(emergency);
|
|
iosp->setEncrypted(encryption);
|
|
iosp->setPriority(priority);
|
|
|
|
if (m_verbose) {
|
|
LogMessage((net) ? LOG_NET : LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_VCH (Group Voice Channel Grant), emerg = %u, encrypt = %u, prio = %u, chNo = %u, srcId = %u, dstId = %u",
|
|
iosp->getEmergency(), iosp->getEncrypted(), iosp->getPriority(), iosp->getGrpVchNo(), iosp->getSrcId(), iosp->getDstId());
|
|
}
|
|
|
|
// transmit group grant
|
|
// m_p25->m_writeImmediate = true;
|
|
writeRF_TSDU_SBF(iosp.get(), false, true, net);
|
|
}
|
|
else {
|
|
if (!net) {
|
|
::ActivityLog("P25", true, "unit-to-unit grant request from %u to %u", srcId, dstId);
|
|
}
|
|
|
|
std::unique_ptr<IOSP_UU_VCH> iosp = new_unique(IOSP_UU_VCH);
|
|
iosp->setSrcId(srcId);
|
|
iosp->setDstId(dstId);
|
|
iosp->setGrpVchNo(chNo);
|
|
iosp->setEmergency(emergency);
|
|
iosp->setEncrypted(encryption);
|
|
iosp->setPriority(priority);
|
|
|
|
if (m_verbose) {
|
|
LogMessage((net) ? LOG_NET : LOG_RF, P25_TSDU_STR ", TSBK_IOSP_UU_VCH (Unit-to-Unit Voice Channel Grant), emerg = %u, encrypt = %u, prio = %u, chNo = %u, srcId = %u, dstId = %u",
|
|
iosp->getEmergency(), iosp->getEncrypted(), iosp->getPriority(), iosp->getGrpVchNo(), iosp->getSrcId(), iosp->getDstId());
|
|
}
|
|
|
|
// transmit private grant
|
|
// m_p25->m_writeImmediate = true;
|
|
writeRF_TSDU_SBF(iosp.get(), false, true, net);
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a SNDCP grant packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
/// <param name="skip"></param>
|
|
/// <param name="net"></param>
|
|
/// <returns></returns>
|
|
bool Trunk::writeRF_TSDU_SNDCP_Grant(uint32_t srcId, uint32_t dstId, bool skip, bool net)
|
|
{
|
|
std::unique_ptr<OSP_SNDCP_CH_GNT> osp = new_unique(OSP_SNDCP_CH_GNT);
|
|
osp->setSrcId(srcId);
|
|
osp->setDstId(dstId);
|
|
|
|
if (dstId == P25_TGID_ALL) {
|
|
return true; // do not generate grant packets for $FFFF (All Call) TGID
|
|
}
|
|
|
|
// are we skipping checking?
|
|
if (!skip) {
|
|
if (m_p25->m_rfState != RS_RF_LISTENING && m_p25->m_rfState != RS_RF_DATA) {
|
|
if (!net) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_ISP_SNDCP_CH_REQ (SNDCP Data Channel Request) denied, traffic in progress, srcId = %u", srcId);
|
|
writeRF_TSDU_Queue(srcId, P25_QUE_RSN_CHN_RESOURCE_NOT_AVAIL, TSBK_ISP_SNDCP_CH_REQ);
|
|
|
|
::ActivityLog("P25", true, "SNDCP grant request from %u queued", srcId);
|
|
m_p25->m_rfState = RS_RF_REJECTED;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
if (!m_p25->m_affiliations.isGranted(srcId)) {
|
|
if (!m_p25->m_affiliations.isRFChAvailable()) {
|
|
if (!net) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_ISP_SNDCP_CH_REQ (SNDCP Data Channel Request) queued, no channels available, srcId = %u", srcId);
|
|
writeRF_TSDU_Queue(srcId, P25_QUE_RSN_CHN_RESOURCE_NOT_AVAIL, TSBK_ISP_SNDCP_CH_REQ);
|
|
|
|
::ActivityLog("P25", true, "SNDCP grant request from %u queued", srcId);
|
|
m_p25->m_rfState = RS_RF_REJECTED;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
else {
|
|
if (m_p25->m_affiliations.grantCh(srcId, GRANT_TIMER_TIMEOUT)) {
|
|
uint32_t chNo = m_p25->m_affiliations.getGrantedCh(srcId);
|
|
osp->setGrpVchNo(chNo);
|
|
osp->setDataChnNo(chNo);
|
|
m_p25->m_siteData.setChCnt(m_p25->m_affiliations.getRFChCnt() + m_p25->m_affiliations.getGrantedRFChCnt());
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
uint32_t chNo = m_p25->m_affiliations.getGrantedCh(srcId);
|
|
osp->setGrpVchNo(chNo);
|
|
osp->setDataChnNo(chNo);
|
|
|
|
m_p25->m_affiliations.touchGrant(srcId);
|
|
}
|
|
}
|
|
|
|
if (!net) {
|
|
::ActivityLog("P25", true, "SNDCP grant request from %u", srcId);
|
|
}
|
|
|
|
if (m_verbose) {
|
|
LogMessage((net) ? LOG_NET : LOG_RF, P25_TSDU_STR ", TSBK_OSP_SNDCP_CH_GNT (SNDCP Data Channel Grant), chNo = %u, dstId = %u",
|
|
osp->getDataChnNo(), osp->getSrcId());
|
|
}
|
|
|
|
// transmit SNDCP grant
|
|
writeRF_TSDU_SBF(osp.get(), false, true, net);
|
|
return true;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a unit to unit answer request packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
void Trunk::writeRF_TSDU_UU_Ans_Req(uint32_t srcId, uint32_t dstId)
|
|
{
|
|
std::unique_ptr<IOSP_UU_ANS> iosp = new_unique(IOSP_UU_ANS);
|
|
iosp->setSrcId(srcId);
|
|
iosp->setDstId(dstId);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_UU_ANS (Unit-to-Unit Answer Request), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
writeRF_TSDU_SBF(iosp.get(), false);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a acknowledge packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="service"></param>
|
|
/// <param name="noNetwork"></param>
|
|
void Trunk::writeRF_TSDU_ACK_FNE(uint32_t srcId, uint32_t service, bool extended, bool noNetwork)
|
|
{
|
|
std::unique_ptr<IOSP_ACK_RSP> iosp = new_unique(IOSP_ACK_RSP);
|
|
iosp->setSrcId(srcId);
|
|
iosp->setService(service);
|
|
|
|
if (extended) {
|
|
iosp->setAIV(true);
|
|
iosp->setEX(true);
|
|
}
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_ACK_RSP (Acknowledge Response), AIV = %u, EX = %u, serviceType = $%02X, srcId = %u",
|
|
iosp->getAIV(), iosp->getEX(), iosp->getService(), srcId);
|
|
}
|
|
|
|
writeRF_TSDU_SBF(iosp.get(), noNetwork);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a deny packet.
|
|
/// </summary>
|
|
/// <param name="dstId"></param>
|
|
/// <param name="reason"></param>
|
|
/// <param name="service"></param>
|
|
/// <param name="aiv"></param>
|
|
void Trunk::writeRF_TSDU_Deny(uint32_t dstId, uint8_t reason, uint8_t service, bool aiv)
|
|
{
|
|
std::unique_ptr<OSP_DENY_RSP> osp = new_unique(OSP_DENY_RSP);
|
|
osp->setAIV(aiv);
|
|
osp->setSrcId(P25_WUID_FNE);
|
|
osp->setDstId(dstId);
|
|
osp->setService(service);
|
|
osp->setResponse(reason);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_DENY_RSP (Deny Response), AIV = %u, reason = $%02X, srcId = %u, dstId = %u",
|
|
osp->getAIV(), reason, osp->getSrcId(), osp->getDstId());
|
|
}
|
|
|
|
writeRF_TSDU_SBF(osp.get(), false);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a group affiliation response packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
bool Trunk::writeRF_TSDU_Grp_Aff_Rsp(uint32_t srcId, uint32_t dstId)
|
|
{
|
|
bool ret = false;
|
|
|
|
std::unique_ptr<IOSP_GRP_AFF> iosp = new_unique(IOSP_GRP_AFF);
|
|
iosp->setAnnounceGroup(m_patchSuperGroup); // this isn't right...
|
|
iosp->setSrcId(srcId);
|
|
iosp->setDstId(dstId);
|
|
iosp->setResponse(P25_RSP_ACCEPT);
|
|
|
|
// validate the source RID
|
|
if (!acl::AccessControl::validateSrcId(srcId)) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_AFF (Group Affiliation Response) denial, RID rejection, srcId = %u", srcId);
|
|
::ActivityLog("P25", true, "group affiliation request from %u to %s %u denied", srcId, "TG ", dstId);
|
|
iosp->setResponse(P25_RSP_REFUSED);
|
|
}
|
|
|
|
// validate the source RID is registered
|
|
if (!m_p25->m_affiliations.isUnitReg(srcId) && m_verifyReg) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_AFF (Group Affiliation Response) denial, RID not registered, srcId = %u", srcId);
|
|
::ActivityLog("P25", true, "group affiliation request from %u to %s %u denied", srcId, "TG ", dstId);
|
|
iosp->setResponse(P25_RSP_REFUSED);
|
|
}
|
|
|
|
// validate the talkgroup ID
|
|
if (dstId == 0U) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_AFF (Group Affiliation Response), TGID 0, dstId = %u", dstId);
|
|
}
|
|
else {
|
|
if (!acl::AccessControl::validateTGId(dstId)) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_AFF (Group Affiliation Response) denial, TGID rejection, dstId = %u", dstId);
|
|
::ActivityLog("P25", true, "group affiliation request from %u to %s %u denied", srcId, "TG ", dstId);
|
|
iosp->setResponse(P25_RSP_DENY);
|
|
}
|
|
}
|
|
|
|
if (iosp->getResponse() == P25_RSP_ACCEPT) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_GRP_AFF (Group Affiliation Response), anncId = %u, srcId = %u, dstId = %u",
|
|
m_patchSuperGroup, srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "group affiliation request from %u to %s %u", srcId, "TG ", dstId);
|
|
ret = true;
|
|
|
|
// update dynamic affiliation table
|
|
m_p25->m_affiliations.groupAff(srcId, dstId);
|
|
}
|
|
|
|
writeRF_TSDU_SBF(iosp.get(), false);
|
|
return ret;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a unit registration response packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="sysId"></param>
|
|
void Trunk::writeRF_TSDU_U_Reg_Rsp(uint32_t srcId, uint32_t sysId)
|
|
{
|
|
std::unique_ptr<IOSP_U_REG> iosp = new_unique(IOSP_U_REG);
|
|
iosp->setResponse(P25_RSP_ACCEPT);
|
|
iosp->setSrcId(srcId);
|
|
iosp->setDstId(srcId);
|
|
|
|
// validate the system ID
|
|
if (sysId != m_p25->m_siteData.sysId()) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_U_REG (Unit Registration Response) denial, SYSID rejection, sysId = $%03X", sysId);
|
|
::ActivityLog("P25", true, "unit registration request from %u denied", srcId);
|
|
iosp->setResponse(P25_RSP_DENY);
|
|
}
|
|
|
|
// validate the source RID
|
|
if (!acl::AccessControl::validateSrcId(srcId)) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_U_REG (Unit Registration Response) denial, RID rejection, srcId = %u", srcId);
|
|
::ActivityLog("P25", true, "unit registration request from %u denied", srcId);
|
|
iosp->setResponse(P25_RSP_REFUSED);
|
|
}
|
|
|
|
if (iosp->getResponse() == P25_RSP_ACCEPT) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_IOSP_U_REG (Unit Registration Response), srcId = %u, sysId = $%03X", srcId, sysId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "unit registration request from %u", srcId);
|
|
|
|
// update dynamic unit registration table
|
|
if (!m_p25->m_affiliations.isUnitReg(srcId)) {
|
|
m_p25->m_affiliations.unitReg(srcId);
|
|
}
|
|
}
|
|
|
|
writeRF_TSDU_SBF(iosp.get(), true);
|
|
|
|
// validate the source RID
|
|
if (!acl::AccessControl::validateSrcId(srcId)) {
|
|
denialInhibit(srcId); // inhibit source radio automatically
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a unit de-registration acknowledge packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
void Trunk::writeRF_TSDU_U_Dereg_Ack(uint32_t srcId)
|
|
{
|
|
bool dereged = false;
|
|
|
|
// remove dynamic unit registration table entry
|
|
dereged = m_p25->m_affiliations.unitDereg(srcId);
|
|
|
|
if (dereged) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_ISP_U_DEREG_REQ (Unit Deregistration Ack) srcId = %u", srcId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "unit deregistration request from %u", srcId);
|
|
|
|
std::unique_ptr<OSP_U_DEREG_ACK> osp = new_unique(OSP_U_DEREG_ACK);
|
|
osp->setSrcId(P25_WUID_FNE);
|
|
osp->setDstId(srcId);
|
|
|
|
writeRF_TSDU_SBF(osp.get(), false);
|
|
}
|
|
else {
|
|
::ActivityLog("P25", true, "unit deregistration request from %u denied", srcId);
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a queue packet.
|
|
/// </summary>
|
|
/// <param name="dstId"></param>
|
|
/// <param name="reason"></param>
|
|
/// <param name="service"></param>
|
|
/// <param name="aiv"></param>
|
|
void Trunk::writeRF_TSDU_Queue(uint32_t dstId, uint8_t reason, uint8_t service, bool aiv)
|
|
{
|
|
std::unique_ptr<OSP_QUE_RSP> osp = new_unique(OSP_QUE_RSP);
|
|
osp->setAIV(aiv);
|
|
osp->setSrcId(P25_WUID_FNE);
|
|
osp->setDstId(dstId);
|
|
osp->setService(service);
|
|
osp->setResponse(reason);
|
|
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_QUE_RSP (Queue Response), AIV = %u, reason = $%02X, srcId = %u, dstId = %u",
|
|
osp->getAIV(), reason, osp->getSrcId(), osp->getDstId());
|
|
}
|
|
|
|
writeRF_TSDU_SBF(osp.get(), false);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a location registration response packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
/// <param name="group"></param>
|
|
bool Trunk::writeRF_TSDU_Loc_Reg_Rsp(uint32_t srcId, uint32_t dstId, bool grp)
|
|
{
|
|
bool ret = false;
|
|
|
|
std::unique_ptr<OSP_LOC_REG_RSP> osp = new_unique(OSP_LOC_REG_RSP);
|
|
osp->setResponse(P25_RSP_ACCEPT);
|
|
osp->setDstId(dstId);
|
|
osp->setSrcId(srcId);
|
|
|
|
// validate the source RID
|
|
if (!acl::AccessControl::validateSrcId(srcId)) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_OSP_LOC_REG_RSP (Location Registration Response) denial, RID rejection, srcId = %u", srcId);
|
|
::ActivityLog("P25", true, "location registration request from %u denied", srcId);
|
|
osp->setResponse(P25_RSP_REFUSED);
|
|
}
|
|
|
|
// validate the source RID is registered
|
|
if (!m_p25->m_affiliations.isUnitReg(srcId)) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_OSP_LOC_REG_RSP (Location Registration Response) denial, RID not registered, srcId = %u", srcId);
|
|
::ActivityLog("P25", true, "location registration request from %u denied", srcId);
|
|
writeRF_TSDU_U_Reg_Cmd(srcId);
|
|
return false;
|
|
}
|
|
|
|
// validate the talkgroup ID
|
|
if (grp) {
|
|
if (dstId == 0U) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_OSP_LOC_REG_RSP (Location Registration Response), TGID 0, dstId = %u", dstId);
|
|
}
|
|
else {
|
|
if (!acl::AccessControl::validateTGId(dstId)) {
|
|
LogWarning(LOG_RF, P25_TSDU_STR ", TSBK_OSP_LOC_REG_RSP (Location Registration Response) denial, TGID rejection, dstId = %u", dstId);
|
|
::ActivityLog("P25", true, "location registration request from %u to %s %u denied", srcId, "TG ", dstId);
|
|
osp->setResponse(P25_RSP_DENY);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (osp->getResponse() == P25_RSP_ACCEPT) {
|
|
if (m_verbose) {
|
|
LogMessage(LOG_RF, P25_TSDU_STR ", TSBK_OSP_LOC_REG_RSP (Location Registration Response), srcId = %u, dstId = %u", srcId, dstId);
|
|
}
|
|
|
|
::ActivityLog("P25", true, "location registration request from %u", srcId);
|
|
ret = true;
|
|
}
|
|
|
|
writeRF_TSDU_SBF(osp.get(), false);
|
|
return ret;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a call termination packet.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
/// <param name="dstId"></param>
|
|
bool Trunk::writeNet_TSDU_Call_Term(uint32_t srcId, uint32_t dstId)
|
|
{
|
|
std::unique_ptr<OSP_DVM_LC_CALL_TERM> osp = new_unique(OSP_DVM_LC_CALL_TERM);
|
|
osp->setGrpVchId(m_p25->m_siteData.channelId());
|
|
osp->setGrpVchNo(m_p25->m_siteData.channelNo());
|
|
osp->setDstId(dstId);
|
|
osp->setSrcId(srcId);
|
|
|
|
writeRF_TSDU_SBF(osp.get(), false);
|
|
return true;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to write a network TSDU from the RF data queue.
|
|
/// </summary>
|
|
/// <paran name="tsbk"></param>
|
|
/// <param name="data"></param>
|
|
void Trunk::writeNet_TSDU_From_RF(lc::TSBK* tsbk, uint8_t* data)
|
|
{
|
|
assert(tsbk != nullptr);
|
|
assert(data != nullptr);
|
|
|
|
::memset(data, 0x00U, P25_TSDU_FRAME_LENGTH_BYTES);
|
|
|
|
// Generate Sync
|
|
Sync::addP25Sync(data);
|
|
|
|
// Generate NID
|
|
m_p25->m_nid.encode(data, P25_DUID_TSDU);
|
|
|
|
// Regenerate TSDU Data
|
|
tsbk->setLastBlock(true); // always set last block -- this a Single Block TSDU
|
|
tsbk->encode(data);
|
|
|
|
// Add busy bits
|
|
m_p25->addBusyBits(data, P25_TSDU_FRAME_LENGTH_BYTES, true, false);
|
|
|
|
// Set first busy bits to 1,1
|
|
m_p25->setBusyBits(data, P25_SS0_START, true, true);
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to automatically inhibit a source ID on a denial.
|
|
/// </summary>
|
|
/// <param name="srcId"></param>
|
|
void Trunk::denialInhibit(uint32_t srcId)
|
|
{
|
|
if (!m_p25->m_inhibitIllegal) {
|
|
return;
|
|
}
|
|
|
|
// this check should have already been done -- but do it again anyway
|
|
if (!acl::AccessControl::validateSrcId(srcId)) {
|
|
LogWarning(LOG_P25, P25_TSDU_STR ", denial, system auto-inhibit RID, srcId = %u", srcId);
|
|
writeRF_TSDU_Ext_Func(P25_EXT_FNCT_INHIBIT, P25_WUID_FNE, srcId);
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Helper to add the idle status bits on P25 frame data.
|
|
/// </summary>
|
|
/// <param name="data"></param>
|
|
/// <param name="length"></param>
|
|
/// <param name="b1"></param>
|
|
/// <param name="b2"></param>
|
|
void Trunk::addIdleBits(uint8_t* data, uint32_t length, bool b1, bool b2)
|
|
{
|
|
assert(data != nullptr);
|
|
|
|
for (uint32_t ss0Pos = P25_SS0_START; ss0Pos < length; ss0Pos += (P25_SS_INCREMENT * 5U)) {
|
|
uint32_t ss1Pos = ss0Pos + 1U;
|
|
WRITE_BIT(data, ss0Pos, b1);
|
|
WRITE_BIT(data, ss1Pos, b2);
|
|
}
|
|
}
|