/* * Copyright (C) 2015,2016 Jonathan Naylor, G4KLX * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; 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" #include "Defines.h" #include "CSBK.h" #include "Log.h" #include CDMRControl::CDMRControl(unsigned int id, unsigned int colorCode, unsigned int timeout, CModem* modem, CHomebrewDMRIPSC* network, IDisplay* display) : m_id(id), m_colorCode(colorCode), m_modem(modem), m_network(network), m_slot1(1U, timeout), m_slot2(2U, timeout) { assert(modem != NULL); assert(display != NULL); CDMRSlot::init(colorCode, modem, network, display); } CDMRControl::~CDMRControl() { } bool CDMRControl::processWakeup(const unsigned char* data) { // Wakeups always come in on slot 1 if (data[0U] != TAG_DATA || data[1U] != (DMR_IDLE_RX | DMR_SYNC_DATA | DT_CSBK)) return false; CCSBK csbk(data + 2U); CSBKO csbko = csbk.getCSBKO(); if (csbko != CSBKO_BSDWNACT) return false; unsigned int bsId = csbk.getBSId(); if (bsId == 0xFFFFFFU) { LogMessage("CSBK BS_Dwn_Act for any received from %u", csbk.getSrcId()); return true; } else if (bsId == m_id) { LogMessage("CSBK BS_Dwn_Act for %u received from %u", bsId, csbk.getSrcId()); return true; } return false; } void CDMRControl::writeModemSlot1(unsigned char *data) { m_slot1.writeModem(data); } void CDMRControl::writeModemSlot2(unsigned char *data) { m_slot2.writeModem(data); } unsigned int CDMRControl::readModemSlot1(unsigned char *data) { return m_slot1.readModem(data); } unsigned int CDMRControl::readModemSlot2(unsigned char *data) { return m_slot2.readModem(data); } void CDMRControl::clock(unsigned int ms) { 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_network->clock(ms); } m_slot1.clock(ms); m_slot2.clock(ms); }