mirror of https://github.com/pvnis/srsRAN_4G.git
You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
811 lines
26 KiB
C++
811 lines
26 KiB
C++
/**
|
|
* Copyright 2013-2021 Software Radio Systems Limited
|
|
*
|
|
* This file is part of srsRAN.
|
|
*
|
|
* srsRAN is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Affero General Public License as
|
|
* published by the Free Software Foundation, either version 3 of
|
|
* the License, or (at your option) any later version.
|
|
*
|
|
* srsRAN 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 Affero General Public License for more details.
|
|
*
|
|
* A copy of the GNU Affero General Public License can be found in
|
|
* the LICENSE file in the top-level directory of this distribution
|
|
* and at http://www.gnu.org/licenses/.
|
|
*
|
|
*/
|
|
|
|
#include "srsran/common/mac_pcap.h"
|
|
#include "srsran/common/string_helpers.h"
|
|
#include "srsran/common/test_common.h"
|
|
#include "srsran/config.h"
|
|
#include "srsran/mac/mac_rar_pdu_nr.h"
|
|
#include "srsran/mac/mac_sch_pdu_nr.h"
|
|
|
|
#include <array>
|
|
#include <iostream>
|
|
#include <memory>
|
|
#include <vector>
|
|
|
|
#define PCAP 0
|
|
#define PCAP_CRNTI (0x1001)
|
|
#define PCAP_RAR_RNTI (0x0016)
|
|
#define PCAP_TTI (666)
|
|
|
|
using namespace srsran;
|
|
|
|
static std::unique_ptr<srsran::mac_pcap> pcap_handle = nullptr;
|
|
|
|
int mac_dl_sch_pdu_unpack_and_pack_test1()
|
|
{
|
|
// MAC PDU with DL-SCH subheader with 8-bit length field
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=0| LCID | Octet 1
|
|
// | L | Octet 1
|
|
|
|
// TV1 - MAC PDU with short subheader for CCCH, MAC SDU length is 8 B, total PDU is 10 B
|
|
uint8_t mac_dl_sch_pdu_1[] = {0x00, 0x08, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(mac_dl_sch_pdu_1, sizeof(mac_dl_sch_pdu_1), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu;
|
|
pdu.unpack(mac_dl_sch_pdu_1, sizeof(mac_dl_sch_pdu_1));
|
|
TESTASSERT(pdu.get_num_subpdus() == 1);
|
|
|
|
mac_sch_subpdu_nr subpdu = pdu.get_subpdu(0);
|
|
TESTASSERT(subpdu.get_total_length() == 10);
|
|
TESTASSERT(subpdu.get_sdu_length() == 8);
|
|
TESTASSERT(subpdu.get_lcid() == 0);
|
|
|
|
// pack PDU again
|
|
byte_buffer_t tx_buffer;
|
|
|
|
srsran::mac_sch_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, sizeof(mac_dl_sch_pdu_1));
|
|
|
|
// Add SDU part of TV from above
|
|
tx_pdu.add_sdu(0, &mac_dl_sch_pdu_1[2], 8);
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == 0);
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(mac_dl_sch_pdu_1));
|
|
TESTASSERT(memcmp(tx_buffer.msg, mac_dl_sch_pdu_1, tx_buffer.N_bytes) == 0);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info(tx_buffer.msg, tx_buffer.N_bytes, "Generated MAC PDU (%d B)", tx_buffer.N_bytes);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_dl_sch_pdu_unpack_test2()
|
|
{
|
|
// MAC PDU with DL-SCH subheader with 16-bit length field
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=1| LCID | Octet 1
|
|
// | L | Octet 2
|
|
// | L | Octet 3
|
|
|
|
// Note: Pack test is not working in this case as it would generate a PDU with the short length field only
|
|
|
|
// TV2 - MAC PDU with long subheader for LCID=2, MAC SDU length is 8 B, total PDU is 11 B
|
|
uint8_t mac_dl_sch_pdu_2[] = {0x42, 0x00, 0x08, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(mac_dl_sch_pdu_2, sizeof(mac_dl_sch_pdu_2), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu;
|
|
pdu.unpack(mac_dl_sch_pdu_2, sizeof(mac_dl_sch_pdu_2));
|
|
TESTASSERT(pdu.get_num_subpdus() == 1);
|
|
mac_sch_subpdu_nr subpdu = pdu.get_subpdu(0);
|
|
TESTASSERT(subpdu.get_total_length() == 11);
|
|
TESTASSERT(subpdu.get_sdu_length() == 8);
|
|
TESTASSERT(subpdu.get_lcid() == 2);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_dl_sch_pdu_pack_test3()
|
|
{
|
|
// MAC PDU with DL-SCH subheader with 16-bit length field (512 B SDU + 3 B header)
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=1| LCID | Octet 1
|
|
// | L | Octet 2
|
|
// | L | Octet 3
|
|
|
|
uint8_t sdu[512] = {};
|
|
|
|
// populate SDU payload
|
|
for (uint32_t i = 0; i < 512; i++) {
|
|
sdu[i] = i % 256;
|
|
}
|
|
|
|
// pack buffer
|
|
byte_buffer_t tx_buffer;
|
|
|
|
srsran::mac_sch_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, 1024);
|
|
|
|
// Add SDU
|
|
tx_pdu.add_sdu(4, sdu, sizeof(sdu));
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == 509);
|
|
TESTASSERT(tx_buffer.N_bytes == 515);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info(tx_buffer.msg, tx_buffer.N_bytes, "Generated MAC PDU (%d B)", tx_buffer.N_bytes);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_dl_sch_pdu_pack_test4()
|
|
{
|
|
// MAC PDU with only padding
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R | R | LCID | Octet 1
|
|
// | zeros | Octet ..
|
|
|
|
// TV2 - MAC PDU with a single LCID with padding only
|
|
uint8_t tv[] = {0x3f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
|
|
|
|
const uint32_t pdu_size = 8;
|
|
byte_buffer_t tx_buffer;
|
|
|
|
// modify buffer (to be nulled during PDU packing
|
|
tx_buffer.msg[4] = 0xaa;
|
|
|
|
srsran::mac_sch_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, pdu_size);
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == pdu_size);
|
|
tx_pdu.pack();
|
|
TESTASSERT(tx_buffer.N_bytes == pdu_size);
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(tv));
|
|
|
|
TESTASSERT(memcmp(tx_buffer.msg, tv, tx_buffer.N_bytes) == 0);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info(tx_buffer.msg, tx_buffer.N_bytes, "Generated MAC PDU (%d B)", tx_buffer.N_bytes);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_dl_sch_pdu_pack_test5()
|
|
{
|
|
// MAC PDU with DL-SCH subheader with 8-bit length field and padding after that
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=0| LCID | Octet 1
|
|
// | L | Octet 2
|
|
// | zeros | Octet 3-10
|
|
// | R | R | LCID | Octet 11
|
|
// | zeros | Octet ..
|
|
|
|
// TV2 - MAC PDU with a single LCID with padding only
|
|
uint8_t tv[] = {0x01, 0x08, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x00};
|
|
|
|
const uint32_t pdu_size = 16;
|
|
byte_buffer_t tx_buffer;
|
|
tx_buffer.clear();
|
|
|
|
srsran::mac_sch_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, pdu_size);
|
|
|
|
// Add SDU part of TV from above
|
|
tx_pdu.add_sdu(1, &tv[2], 8);
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == 6);
|
|
|
|
tx_pdu.pack();
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == 0);
|
|
TESTASSERT(tx_buffer.N_bytes == pdu_size);
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(tv));
|
|
TESTASSERT(memcmp(tx_buffer.msg, tv, tx_buffer.N_bytes) == 0);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
// pretty print PDU
|
|
fmt::memory_buffer buff;
|
|
tx_pdu.to_string(buff);
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info(
|
|
tx_buffer.msg, tx_buffer.N_bytes, "Generated MAC PDU (%d B): %s", tx_buffer.N_bytes, srsran::to_c_str(buff));
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_dl_sch_pdu_unpack_test6()
|
|
{
|
|
// MAC PDU with DL-SCH subheader reserved LCID
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=1| LCID | Octet 1
|
|
// | L | Octet 2
|
|
|
|
// TV2 - MAC PDU with reserved LCID (46=0x2e)
|
|
uint8_t mac_dl_sch_pdu_2[] = {0x2e, 0x04, 0x11, 0x22, 0x33, 0x44};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(mac_dl_sch_pdu_2, sizeof(mac_dl_sch_pdu_2), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu;
|
|
pdu.unpack(mac_dl_sch_pdu_2, sizeof(mac_dl_sch_pdu_2));
|
|
TESTASSERT(pdu.get_num_subpdus() == 0);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_rar_pdu_test7()
|
|
{
|
|
// MAC PDU with RAR PDU with single RAPID=0
|
|
// rapid=0
|
|
// ta=180
|
|
// ul_grant:
|
|
// hopping_flag=0
|
|
// riv=0x1
|
|
// time_domain_rsc=1
|
|
// mcs=4
|
|
// tpc_command=3
|
|
// csi_request=0
|
|
// tc-rnti=0x4616
|
|
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |T=1| RAPID=0 | Octet 1
|
|
// | RAR | Octet 2-8
|
|
const uint32_t tv_rapid = 0;
|
|
const uint32_t tv_ta = 180;
|
|
const uint16_t tv_tcrnti = 0x4616;
|
|
const uint8_t tv_msg3_grant[mac_rar_subpdu_nr::UL_GRANT_NBITS] = {
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x01, 0x00, 0x00, 0x00, 0x01, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01, 0x01, 0x00}; // unpacked UL grant
|
|
|
|
uint8_t mac_dl_rar_pdu[] = {0x40, 0x05, 0xa0, 0x00, 0x11, 0x46, 0x46, 0x16, 0x00, 0x00, 0x00};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_ra_rnti_nr(mac_dl_rar_pdu, sizeof(mac_dl_rar_pdu), PCAP_RAR_RNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_rar_pdu_nr pdu;
|
|
TESTASSERT(pdu.unpack(mac_dl_rar_pdu, sizeof(mac_dl_rar_pdu)) == true);
|
|
|
|
fmt::memory_buffer buff;
|
|
pdu.to_string(buff);
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info("Rx PDU: %s", srsran::to_c_str(buff));
|
|
|
|
TESTASSERT(pdu.get_num_subpdus() == 1);
|
|
|
|
mac_rar_subpdu_nr subpdu = pdu.get_subpdu(0);
|
|
TESTASSERT(subpdu.has_rapid() == true);
|
|
TESTASSERT(subpdu.has_backoff() == false);
|
|
TESTASSERT(subpdu.get_temp_crnti() == tv_tcrnti);
|
|
TESTASSERT(subpdu.get_ta() == tv_ta);
|
|
TESTASSERT(subpdu.get_rapid() == tv_rapid);
|
|
|
|
std::array<uint8_t, mac_rar_subpdu_nr::UL_GRANT_NBITS> msg3_grant = subpdu.get_ul_grant();
|
|
TESTASSERT(memcmp(msg3_grant.data(), tv_msg3_grant, msg3_grant.size()) == 0);
|
|
|
|
// pack again
|
|
byte_buffer_t tx_buffer;
|
|
tx_buffer.clear();
|
|
|
|
srsran::mac_rar_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, sizeof(mac_dl_rar_pdu));
|
|
|
|
mac_rar_subpdu_nr& rar_subpdu = tx_pdu.add_subpdu();
|
|
rar_subpdu.set_ta(tv_ta);
|
|
rar_subpdu.set_rapid(tv_rapid);
|
|
rar_subpdu.set_temp_crnti(tv_tcrnti);
|
|
rar_subpdu.set_ul_grant(msg3_grant);
|
|
|
|
TESTASSERT(tx_pdu.pack() == SRSRAN_SUCCESS);
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(mac_dl_rar_pdu));
|
|
TESTASSERT(memcmp(tx_buffer.msg, mac_dl_rar_pdu, tx_buffer.N_bytes) == 0);
|
|
|
|
tx_pdu.to_string(buff);
|
|
mac_logger.info("Tx PDU: %s", srsran::to_c_str(buff));
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_ra_rnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_RAR_RNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_rar_pdu_unpack_test8()
|
|
{
|
|
// Malformed MAC PDU, says it has RAR PDU but is too short to include MAC RAR
|
|
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | E |T=1| RAPID=0 | Octet 1
|
|
// | RAR_fragment | Octet 2
|
|
uint8_t mac_dl_rar_pdu[] = {0x40, 0x05};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_ra_rnti_nr(mac_dl_rar_pdu, sizeof(mac_dl_rar_pdu), 0x0016, true, PCAP_TTI);
|
|
}
|
|
|
|
// unpacking should fail
|
|
srsran::mac_rar_pdu_nr pdu;
|
|
TESTASSERT(pdu.unpack(mac_dl_rar_pdu, sizeof(mac_dl_rar_pdu)) == false);
|
|
TESTASSERT(pdu.get_num_subpdus() == 0);
|
|
|
|
// Malformed PDU with reserved bits set
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | E |T=0| R | R | BI | Octet 1
|
|
uint8_t mac_dl_rar_pdu2[] = {0x10};
|
|
TESTASSERT(pdu.unpack(mac_dl_rar_pdu2, sizeof(mac_dl_rar_pdu2)) == false);
|
|
TESTASSERT(pdu.get_num_subpdus() == 0);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_dl_sch_pdu_unpack_test9()
|
|
{
|
|
// MAC PDU with Timing Advance CE and padding
|
|
uint8_t tv[] = {0x3d, 0x1f, 0x3f, 0x00, 0x00, 0x00};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_dl_crnti_nr(tv, sizeof(tv), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu;
|
|
pdu.unpack(tv, sizeof(tv));
|
|
TESTASSERT(pdu.get_num_subpdus() == 2);
|
|
mac_sch_subpdu_nr subpdu = pdu.get_subpdu(0);
|
|
|
|
TESTASSERT(subpdu.get_ta().tag_id == 0);
|
|
TESTASSERT(subpdu.get_ta().ta_command == 31);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_ul_sch_pdu_unpack_test1()
|
|
{
|
|
// UL-SCH MAC PDU with fixed-size CE and DL-SCH subheader with 16-bit length field
|
|
// Note: this is a malformed UL-SCH PDU has SDU is placed after the CE
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R | R | LCID | Octet 1 (C-RNTI LCID = 0x )
|
|
// | C-RNTI | Octet 2
|
|
// | C-RNTI | Octet 3
|
|
// | R |F=1| LCID | Octet 4
|
|
// | L | Octet 5
|
|
// | L | Octet 6
|
|
// | data | Octet 7-x
|
|
|
|
// TV3 - UL-SCH MAC PDU with long subheader for LCID=2, MAC SDU length is 4 B, total PDU is 9 B
|
|
const uint8_t ul_sch_crnti[] = {0x11, 0x22};
|
|
uint8_t mac_ul_sch_pdu_1[] = {0x3a, 0x11, 0x22, 0x43, 0x00, 0x04, 0x11, 0x22, 0x33, 0x44};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu(true);
|
|
pdu.unpack(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1));
|
|
TESTASSERT(pdu.get_num_subpdus() == 2);
|
|
|
|
// First subpdu is C-RNTI CE
|
|
mac_sch_subpdu_nr subpdu0 = pdu.get_subpdu(0);
|
|
TESTASSERT(subpdu0.get_total_length() == 3);
|
|
TESTASSERT(subpdu0.get_sdu_length() == 2);
|
|
TESTASSERT(subpdu0.get_lcid() == mac_sch_subpdu_nr::CRNTI);
|
|
TESTASSERT(memcmp(subpdu0.get_sdu(), (uint8_t*)&ul_sch_crnti, sizeof(ul_sch_crnti)) == 0);
|
|
|
|
// Second subpdu is UL-SCH
|
|
mac_sch_subpdu_nr subpdu1 = pdu.get_subpdu(1);
|
|
TESTASSERT(subpdu1.get_total_length() == 7);
|
|
TESTASSERT(subpdu1.get_sdu_length() == 4);
|
|
TESTASSERT(subpdu1.get_lcid() == 3);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_ul_sch_pdu_unpack_and_pack_test2()
|
|
{
|
|
// MAC PDU with UL-SCH (for UL-CCCH) subheader
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R | R | LCID | Octet 1
|
|
|
|
// TV1 - MAC PDU with short subheader for CCCH, MAC SDU length is 8 B, total PDU is 10 B
|
|
uint8_t mac_ul_sch_pdu_1[] = {0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu(true);
|
|
pdu.unpack(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1));
|
|
TESTASSERT(pdu.get_num_subpdus() == 1);
|
|
|
|
mac_sch_subpdu_nr subpdu = pdu.get_subpdu(0);
|
|
TESTASSERT(subpdu.get_total_length() == 9);
|
|
TESTASSERT(subpdu.get_sdu_length() == 8);
|
|
TESTASSERT(subpdu.get_lcid() == 0);
|
|
|
|
// pack PDU again
|
|
byte_buffer_t tx_buffer;
|
|
|
|
srsran::mac_sch_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, sizeof(mac_ul_sch_pdu_1), true);
|
|
|
|
// Add SDU part of TV from above
|
|
tx_pdu.add_sdu(0, &mac_ul_sch_pdu_1[1], 8);
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == 0);
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(mac_ul_sch_pdu_1));
|
|
TESTASSERT(memcmp(tx_buffer.msg, mac_ul_sch_pdu_1, tx_buffer.N_bytes) == 0);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info(tx_buffer.msg, tx_buffer.N_bytes, "Generated MAC PDU (%d B)", tx_buffer.N_bytes);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_ul_sch_pdu_unpack_and_pack_test3()
|
|
{
|
|
// MAC PDU with UL-SCH (with normal LCID) subheader for short SDU
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=0| LCID | Octet 1
|
|
// | L | Octet 2
|
|
|
|
// TV1 - MAC PDU with short subheader for CCCH, MAC SDU length is 8 B, total PDU is 10 B
|
|
uint8_t mac_ul_sch_pdu_1[] = {0x02, 0x0a, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88, 0x99, 0xaa};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu(true);
|
|
pdu.unpack(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1));
|
|
TESTASSERT(pdu.get_num_subpdus() == 1);
|
|
|
|
mac_sch_subpdu_nr subpdu = pdu.get_subpdu(0);
|
|
TESTASSERT(subpdu.get_total_length() == 12);
|
|
TESTASSERT(subpdu.get_sdu_length() == 10);
|
|
TESTASSERT(subpdu.get_lcid() == 2);
|
|
|
|
// pack PDU again
|
|
byte_buffer_t tx_buffer;
|
|
|
|
srsran::mac_sch_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, sizeof(mac_ul_sch_pdu_1), true);
|
|
|
|
// Add SDU part of TV from above
|
|
tx_pdu.add_sdu(2, &mac_ul_sch_pdu_1[2], 10);
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == 0);
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(mac_ul_sch_pdu_1));
|
|
TESTASSERT(memcmp(tx_buffer.msg, mac_ul_sch_pdu_1, tx_buffer.N_bytes) == 0);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info(tx_buffer.msg, tx_buffer.N_bytes, "Generated MAC PDU (%d B)", tx_buffer.N_bytes);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_ul_sch_pdu_pack_test4()
|
|
{
|
|
// MAC PDU with UL-SCH (with normal LCID) subheader for long SDU
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=1| LCID | Octet 1
|
|
// | L | Octet 2
|
|
// | L | Octet 3
|
|
|
|
uint8_t sdu[512] = {};
|
|
|
|
// populate SDU payload
|
|
for (uint32_t i = 0; i < 512; i++) {
|
|
sdu[i] = i % 256;
|
|
}
|
|
|
|
// pack PDU again
|
|
byte_buffer_t tx_buffer;
|
|
|
|
srsran::mac_sch_pdu_nr tx_pdu;
|
|
tx_pdu.init_tx(&tx_buffer, sizeof(sdu) + 3, true);
|
|
|
|
// Add SDU part of TV from above
|
|
tx_pdu.add_sdu(2, sdu, sizeof(sdu));
|
|
|
|
TESTASSERT(tx_pdu.get_remaing_len() == 0);
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(sdu) + 3);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info(tx_buffer.msg, tx_buffer.N_bytes, "Generated MAC PDU (%d B)", tx_buffer.N_bytes);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_ul_sch_pdu_unpack_test5()
|
|
{
|
|
// MAC PDU with UL-SCH (with normal LCID) subheader for short SDU but reserved LCID
|
|
// Bit 1-8
|
|
// | | | | | | | | |
|
|
// | R |F=0| LCID | Octet 1
|
|
// | L | Octet 2
|
|
|
|
// TV1 - MAC PDU with short subheader but reserved LCID for UL-SCH (LCID=33)
|
|
uint8_t mac_ul_sch_pdu_1[] = {0x21, 0x0a, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88, 0x99, 0xaa};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu(true);
|
|
pdu.unpack(mac_ul_sch_pdu_1, sizeof(mac_ul_sch_pdu_1));
|
|
TESTASSERT(pdu.get_num_subpdus() == 0);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_dl_sch_pdu_unpack_and_pack_test6()
|
|
{
|
|
// MAC PDU with UL-SCH: CRNTI, SE PHR, SBDR and padding
|
|
|
|
// CRNTI:0x4601 SE PHR:ph=63 pc=52 SBSR: lcg=6 bs=0 PAD: len=0
|
|
uint8_t tv[] = {0x3a, 0x46, 0x01, 0x39, 0x3f, 0x34, 0x3d, 0xc0, 0x3f};
|
|
|
|
const uint16_t TV_CRNTI = 0x4601;
|
|
const uint8_t TV_PHR = 63;
|
|
const uint8_t TV_PC = 52;
|
|
const uint8_t TV_LCG = 6;
|
|
const uint8_t TV_BUFF_SIZE = 0;
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(tv, sizeof(tv), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
// Unpack TV
|
|
{
|
|
srsran::mac_sch_pdu_nr pdu_rx(true);
|
|
pdu_rx.unpack(tv, sizeof(tv));
|
|
TESTASSERT(pdu_rx.get_num_subpdus() == 4);
|
|
|
|
// 1st C-RNTI
|
|
mac_sch_subpdu_nr subpdu = pdu_rx.get_subpdu(0);
|
|
TESTASSERT(subpdu.get_total_length() == 3);
|
|
TESTASSERT(subpdu.get_sdu_length() == 2);
|
|
TESTASSERT(subpdu.get_lcid() == mac_sch_subpdu_nr::CRNTI);
|
|
TESTASSERT(subpdu.get_c_rnti() == TV_CRNTI);
|
|
|
|
// 2nd subPDU is SE PHR
|
|
subpdu = pdu_rx.get_subpdu(1);
|
|
TESTASSERT(subpdu.get_lcid() == mac_sch_subpdu_nr::SE_PHR);
|
|
TESTASSERT(subpdu.get_phr() == TV_PHR);
|
|
TESTASSERT(subpdu.get_pcmax() == TV_PC);
|
|
|
|
// 3rd subPDU is SBSR
|
|
subpdu = pdu_rx.get_subpdu(2);
|
|
TESTASSERT(subpdu.get_lcid() == mac_sch_subpdu_nr::SHORT_BSR);
|
|
mac_sch_subpdu_nr::lcg_bsr_t sbsr = subpdu.get_sbsr();
|
|
TESTASSERT(sbsr.lcg_id == TV_LCG);
|
|
TESTASSERT(sbsr.buffer_size == TV_BUFF_SIZE);
|
|
|
|
// 4th is padding
|
|
subpdu = pdu_rx.get_subpdu(3);
|
|
TESTASSERT(subpdu.get_lcid() == mac_sch_subpdu_nr::PADDING);
|
|
|
|
// pretty print PDU
|
|
fmt::memory_buffer buff;
|
|
pdu_rx.to_string(buff);
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info("Rx PDU: %s", srsran::to_c_str(buff));
|
|
}
|
|
|
|
// Let's pack the entire PDU again
|
|
{
|
|
byte_buffer_t tx_buffer;
|
|
srsran::mac_sch_pdu_nr pdu_tx(true);
|
|
|
|
pdu_tx.init_tx(&tx_buffer, sizeof(tv), true); // same size as TV
|
|
|
|
TESTASSERT(pdu_tx.get_remaing_len() == 9);
|
|
TESTASSERT(pdu_tx.add_crnti_ce(TV_CRNTI) == SRSRAN_SUCCESS);
|
|
|
|
TESTASSERT(pdu_tx.get_remaing_len() == 6);
|
|
TESTASSERT(pdu_tx.add_se_phr_ce(TV_PHR, TV_PC) == SRSRAN_SUCCESS);
|
|
|
|
TESTASSERT(pdu_tx.get_remaing_len() == 3);
|
|
mac_sch_subpdu_nr::lcg_bsr_t sbsr = {};
|
|
sbsr.lcg_id = TV_LCG;
|
|
sbsr.buffer_size = TV_BUFF_SIZE;
|
|
TESTASSERT(pdu_tx.add_sbsr_ce(sbsr) == SRSRAN_SUCCESS);
|
|
TESTASSERT(pdu_tx.get_remaing_len() == 1);
|
|
|
|
// finish PDU packing
|
|
pdu_tx.pack();
|
|
|
|
// pretty print PDU
|
|
fmt::memory_buffer buff;
|
|
pdu_tx.to_string(buff);
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC");
|
|
mac_logger.info("Tx PDU: %s", srsran::to_c_str(buff));
|
|
|
|
// compare PDUs
|
|
TESTASSERT(tx_buffer.N_bytes == sizeof(tv));
|
|
TESTASSERT(memcmp(tx_buffer.msg, tv, tx_buffer.N_bytes) == 0);
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(tx_buffer.msg, tx_buffer.N_bytes, PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
}
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int mac_ul_sch_pdu_unpack_test6()
|
|
{
|
|
// Malformed MAC PDU
|
|
uint8_t tv[] = {0x04, 0xe7, 0x00, 0x80, 0x04, 0x45, 0x00, 0x00, 0xe4, 0x4b, 0x9d, 0x40, 0x00, 0x40, 0x01, 0x69, 0x28,
|
|
0xc0, 0xa8, 0x02, 0x02, 0xc0, 0xa8, 0x02, 0x01, 0x08, 0x00, 0x3a, 0xbc, 0x65, 0x4a, 0x00, 0x01, 0x94,
|
|
0x85, 0x70, 0x60, 0x00, 0x00, 0x00, 0x00, 0xaa, 0x1b, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x11,
|
|
0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f, 0x20, 0x21, 0x22,
|
|
0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f, 0x30, 0x31, 0x32, 0x33,
|
|
0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f, 0x40, 0x41, 0x42, 0x43, 0x44,
|
|
0x45, 0x46, 0x47, 0x48, 0x49, 0x4a, 0x4b, 0x4c, 0x4d, 0x4e, 0x4f, 0x50, 0x51, 0x52, 0x53, 0x54, 0x55,
|
|
0x56, 0x57, 0x58, 0x59, 0x5a, 0x5b, 0x5c, 0x5d, 0x5e, 0x5f, 0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66,
|
|
0x67, 0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f, 0x70, 0x71, 0x72, 0x73, 0x74, 0x75, 0x76, 0x77,
|
|
0x78, 0x79, 0x7a, 0x7b, 0x7c, 0x7d, 0x7e, 0x7f, 0x80, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88,
|
|
0x89, 0x8a, 0x8b, 0x8c, 0x8d, 0x8e, 0x8f, 0x90, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97};
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->write_ul_crnti_nr(tv, sizeof(tv), PCAP_CRNTI, true, PCAP_TTI);
|
|
}
|
|
|
|
srsran::mac_sch_pdu_nr pdu(true);
|
|
TESTASSERT(pdu.unpack(tv, sizeof(tv)) == SRSRAN_ERROR);
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|
|
|
|
int main(int argc, char** argv)
|
|
{
|
|
#if PCAP
|
|
pcap_handle = std::unique_ptr<srsran::mac_pcap>(new srsran::mac_pcap());
|
|
pcap_handle->open("mac_nr_pdu_test.pcap");
|
|
#endif
|
|
|
|
auto& mac_logger = srslog::fetch_basic_logger("MAC", false);
|
|
mac_logger.set_level(srslog::basic_levels::debug);
|
|
mac_logger.set_hex_dump_max_size(-1);
|
|
|
|
srslog::init();
|
|
|
|
if (mac_dl_sch_pdu_unpack_and_pack_test1()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_unpack_and_pack_test1() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_dl_sch_pdu_unpack_test2()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_unpack_test2() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_dl_sch_pdu_pack_test3()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_pack_test3() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_dl_sch_pdu_pack_test4()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_pack_test4() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_dl_sch_pdu_pack_test5()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_pack_test5() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_dl_sch_pdu_unpack_test6()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_unpack_test6() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_rar_pdu_test7()) {
|
|
fprintf(stderr, "mac_rar_pdu_unpack_test7() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_rar_pdu_unpack_test8()) {
|
|
fprintf(stderr, "mac_rar_pdu_unpack_test8() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_dl_sch_pdu_unpack_test9()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_unpack_test9() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_ul_sch_pdu_unpack_test1()) {
|
|
fprintf(stderr, "mac_ul_sch_pdu_unpack_test1() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_ul_sch_pdu_unpack_and_pack_test2()) {
|
|
fprintf(stderr, "mac_ul_sch_pdu_unpack_and_pack_test2() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_ul_sch_pdu_unpack_and_pack_test3()) {
|
|
fprintf(stderr, "mac_ul_sch_pdu_unpack_and_pack_test3() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_ul_sch_pdu_pack_test4()) {
|
|
fprintf(stderr, "mac_ul_sch_pdu_pack_test4() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_ul_sch_pdu_unpack_test5()) {
|
|
fprintf(stderr, "mac_ul_sch_pdu_unpack_test5() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_dl_sch_pdu_unpack_and_pack_test6()) {
|
|
fprintf(stderr, "mac_dl_sch_pdu_unpack_and_pack_test6() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (mac_ul_sch_pdu_unpack_test6()) {
|
|
fprintf(stderr, "mac_ul_sch_pdu_unpack_test6() failed.\n");
|
|
return SRSRAN_ERROR;
|
|
}
|
|
|
|
if (pcap_handle) {
|
|
pcap_handle->close();
|
|
}
|
|
|
|
srslog::flush();
|
|
|
|
return SRSRAN_SUCCESS;
|
|
}
|