MMDVMHost-Private/DMRControl.cpp

139 lines
3.5 KiB
C++
Raw Permalink Normal View History

2016-01-14 18:45:04 +00:00
/*
* Copyright (C) 2015-2019 Jonathan Naylor, G4KLX
2016-01-14 18:45:04 +00:00
*
* 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; version 2 of the License.
*
* 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.
*/
#include "DMRControl.h"
2016-11-10 18:43:54 +00:00
#include "DMRAccessControl.h"
2016-01-14 18:45:04 +00:00
#include "Defines.h"
2016-02-15 18:45:57 +00:00
#include "DMRCSBK.h"
2016-01-14 18:45:04 +00:00
#include "Log.h"
2016-03-07 20:21:55 +00:00
#include <cstdio>
2016-01-14 18:45:04 +00:00
#include <cassert>
#include <algorithm>
2016-01-14 18:45:04 +00:00
2018-02-08 20:25:03 +00:00
CDMRControl::CDMRControl(unsigned int id, unsigned int colorCode, unsigned int callHang, bool selfOnly, bool embeddedLCOnly, bool dumpTAData, const std::vector<unsigned int>& prefixes, const std::vector<unsigned int>& blacklist, const std::vector<unsigned int>& whitelist, const std::vector<unsigned int>& slot1TGWhitelist, const std::vector<unsigned int>& slot2TGWhitelist, unsigned int timeout, CModem* modem, CDMRNetwork* network, CDisplay* display, bool duplex, CDMRLookup* lookup, CRSSIInterpolator* rssi, unsigned int jitter) :
2016-01-14 18:45:04 +00:00
m_colorCode(colorCode),
m_modem(modem),
m_network(network),
m_slot1(1U, timeout),
m_slot2(2U, timeout),
m_lookup(lookup)
2016-01-14 18:45:04 +00:00
{
2016-11-10 18:43:54 +00:00
assert(id != 0U);
2016-01-14 18:45:04 +00:00
assert(modem != NULL);
assert(display != NULL);
assert(lookup != NULL);
assert(rssi != NULL);
2016-01-14 18:45:04 +00:00
2016-11-10 18:43:54 +00:00
// Load black and white lists to DMRAccessControl
2017-01-05 19:15:10 +00:00
CDMRAccessControl::init(blacklist, whitelist, slot1TGWhitelist, slot2TGWhitelist, selfOnly, prefixes, id);
2016-11-10 18:43:54 +00:00
2018-02-08 20:25:03 +00:00
CDMRSlot::init(colorCode, embeddedLCOnly, dumpTAData, callHang, modem, network, display, duplex, m_lookup, rssi, jitter);
2016-01-14 18:45:04 +00:00
}
CDMRControl::~CDMRControl()
{
}
bool CDMRControl::processWakeup(const unsigned char* data)
{
2016-03-07 20:21:55 +00:00
assert(data != NULL);
2016-01-14 18:45:04 +00:00
// Wakeups always come in on slot 1
if (data[0U] != TAG_DATA || data[1U] != (DMR_IDLE_RX | DMR_SYNC_DATA | DT_CSBK))
return false;
CDMRCSBK csbk;
bool valid = csbk.put(data + 2U);
if (!valid)
return false;
2016-01-14 18:45:04 +00:00
CSBKO csbko = csbk.getCSBKO();
if (csbko != CSBKO_BSDWNACT)
return false;
unsigned int srcId = csbk.getSrcId();
std::string src = m_lookup->find(srcId);
2017-01-05 19:15:10 +00:00
bool ret = CDMRAccessControl::validateSrcId(srcId);
2016-11-10 18:43:54 +00:00
if (!ret) {
LogMessage("Invalid Downlink Activate received from %s", src.c_str());
2016-11-10 18:43:54 +00:00
return false;
2016-01-14 18:45:04 +00:00
}
LogMessage("Downlink Activate received from %s", src.c_str());
2016-04-04 18:03:38 +00:00
return true;
2016-01-14 18:45:04 +00:00
}
2017-03-12 19:06:47 +00:00
bool CDMRControl::writeModemSlot1(unsigned char *data, unsigned int len)
2016-01-14 18:45:04 +00:00
{
2016-03-07 20:21:55 +00:00
assert(data != NULL);
2017-03-12 19:06:47 +00:00
return m_slot1.writeModem(data, len);
2016-01-14 18:45:04 +00:00
}
2017-03-12 19:06:47 +00:00
bool CDMRControl::writeModemSlot2(unsigned char *data, unsigned int len)
2016-01-14 18:45:04 +00:00
{
2016-03-07 20:21:55 +00:00
assert(data != NULL);
2017-03-12 19:06:47 +00:00
return m_slot2.writeModem(data, len);
2016-01-14 18:45:04 +00:00
}
unsigned int CDMRControl::readModemSlot1(unsigned char *data)
{
2016-03-07 20:21:55 +00:00
assert(data != NULL);
2016-01-14 18:45:04 +00:00
return m_slot1.readModem(data);
}
unsigned int CDMRControl::readModemSlot2(unsigned char *data)
{
2016-03-07 20:21:55 +00:00
assert(data != NULL);
2016-01-14 18:45:04 +00:00
return m_slot2.readModem(data);
}
void CDMRControl::clock()
2016-01-14 18:45:04 +00:00
{
if (m_network != NULL) {
CDMRData data;
bool ret = m_network->read(data);
if (ret) {
unsigned int slotNo = data.getSlotNo();
switch (slotNo) {
case 1U: m_slot1.writeNetwork(data); break;
case 2U: m_slot2.writeNetwork(data); break;
default: LogError("Invalid slot no %u", slotNo); break;
}
}
}
m_slot1.clock();
m_slot2.clock();
2016-01-14 18:45:04 +00:00
}
bool CDMRControl::isBusy() const
{
if (m_slot1.isBusy())
return true;
return m_slot2.isBusy();
}
void CDMRControl::enable(bool enabled)
{
m_slot1.enable(enabled);
m_slot2.enable(enabled);
}