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.
69 lines
1.7 KiB
69 lines
1.7 KiB
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Digital Voice Modem - Common Library
|
|
* GPLv2 Open Source. Use is subject to license terms.
|
|
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
|
*
|
|
* Copyright (C) 2024 Bryan Biedenkapp, N2PLL
|
|
*
|
|
*/
|
|
#include "common/p25/dfsi/frames/ControlOctet.h"
|
|
#include "common/p25/dfsi/DFSIDefines.h"
|
|
#include "common/Utils.h"
|
|
#include "common/Log.h"
|
|
|
|
#include <cassert>
|
|
#include <cstring>
|
|
|
|
using namespace p25;
|
|
using namespace p25::dfsi;
|
|
using namespace p25::dfsi::frames;
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Public Class Members
|
|
// ---------------------------------------------------------------------------
|
|
|
|
/* Initializes a instance of the ControlOctet class. */
|
|
|
|
ControlOctet::ControlOctet() :
|
|
m_signal(false),
|
|
m_compact(true),
|
|
m_blockHeaderCnt(0U)
|
|
{
|
|
/* stub */
|
|
}
|
|
|
|
/* Initializes a instance of the ControlOctet class. */
|
|
|
|
ControlOctet::ControlOctet(uint8_t* data) :
|
|
m_signal(false),
|
|
m_compact(true),
|
|
m_blockHeaderCnt(0U)
|
|
{
|
|
decode(data);
|
|
}
|
|
|
|
/* Decode a control octet frame. */
|
|
|
|
bool ControlOctet::decode(const uint8_t* data)
|
|
{
|
|
assert(data != nullptr);
|
|
|
|
m_signal = (data[0U] & 0x80U) == 0x80U; // Signal Flag
|
|
m_compact = (data[0U] & 0x40U) == 0x40U; // Compact Flag
|
|
m_blockHeaderCnt = (uint8_t)(data[0U] & 0x3FU); // Block Header Count
|
|
|
|
return true;
|
|
}
|
|
|
|
/* Encode a control octet frame. */
|
|
|
|
void ControlOctet::encode(uint8_t* data)
|
|
{
|
|
assert(data != nullptr);
|
|
|
|
data[0U] = (uint8_t)((m_signal ? 0x80U : 0x00U) + // Signal Flag
|
|
(m_compact ? 0x40U : 0x00U) + // Control Flag
|
|
(m_blockHeaderCnt & 0x3F));
|
|
}
|