srsLTE/srsue/test/ttcn3/hdr/ttcn3_drb_interface.h

/**
 *
 * \section COPYRIGHT
 *
 * Copyright 2013-2020 Software Radio Systems Limited
 *
 * By using this file, you agree to the terms and conditions set
 * forth in the LICENSE file which can be found at the top level of
 * the distribution.
 *
 */

#ifndef SRSUE_TTCN3_DRB_INTERFACE_H
#define SRSUE_TTCN3_DRB_INTERFACE_H

#include "srslte/common/buffer_pool.h"
#include "srslte/common/common.h"
#include "srslte/mac/pdu.h"
#include "ttcn3_interfaces.h"
#include "ttcn3_port_handler.h"
#include <srslte/asn1/asn1_utils.h>
#include <srslte/interfaces/ue_interfaces.h>

using namespace srslte;

// The DRB interface
class ttcn3_drb_interface : public ttcn3_port_handler
{
public:
  ttcn3_drb_interface() : pool(byte_buffer_pool::get_instance()) {}
  ~ttcn3_drb_interface() = default;

  int init(ss_srb_interface* syssim_, srslte::log* log_, std::string net_ip_, uint32_t net_port_)
  {
    syssim      = syssim_;
    log         = log_;
    net_ip      = net_ip_;
    net_port    = net_port_;
    initialized = true;
    log->debug("Initialized.\n");
    return port_listen();
  }

  void tx(const uint8_t* buffer, uint32_t len)
  {
    if (initialized) {
      log->info_hex(buffer, len, "Sending %d B to Titan\n", len);
      send(buffer, len);
    } else {
      log->error("Trying to transmit but port not connected.\n");
    }
  }

private:
  ///< Main message handler
  int handle_message(const unique_byte_array_t& rx_buf, const uint32_t n)
  {
    log->debug_hex(rx_buf->begin(), n, "Received %d B from remote.\n", n);

    // Chop incoming msg, first two bytes are length of the JSON
    // (see IPL4_EUTRA_SYSTEM_Definitions.ttcn
    uint16_t json_len = ((uint16_t)rx_buf->at(0) << 8) | rx_buf->at(1);

    // The data part after the JSON starts right here but handling
    // is done in the respective functions
    uint16_t rx_buf_offset = json_len + 2;

    Document document;
    if (document.Parse((char*)&rx_buf->at(2)).HasParseError() || document.IsObject() == false) {
      log->error_hex((uint8*)&rx_buf->at(2), json_len, "Error parsing incoming data.\n");
      return SRSLTE_ERROR;
    }

    // Pretty-print
    StringBuffer               buffer;
    PrettyWriter<StringBuffer> writer(buffer);
    document.Accept(writer);
    log->info("Received JSON with %d B\n%s\n", json_len, (char*)buffer.GetString());

    // check for common
    assert(document.HasMember("Common"));
    assert(document["Common"].IsObject());

    // Check for user data
    assert(document.HasMember("U_Plane"));
    assert(document["U_Plane"].IsObject());

    // Handle Pdus
    const Value& uplane = document["U_Plane"];
    assert(uplane.HasMember("SubframeDataList"));
    assert(uplane["SubframeDataList"].IsArray());

    uint32_t lcid = document["Common"]["RoutingInfo"]["RadioBearerId"]["Drb"].GetInt() + 2;
    for (Value::ConstValueIterator itr = uplane["SubframeDataList"].Begin(); itr != uplane["SubframeDataList"].End();
         ++itr) {
      assert(itr->HasMember("PduSduList"));
      assert((*itr)["PduSduList"].IsObject());
      if ((*itr)["PduSduList"].HasMember("PdcpSdu")) {
        assert((*itr)["PduSduList"]["PdcpSdu"].IsArray());
        const Value& sdulist = (*itr)["PduSduList"]["PdcpSdu"];
        for (Value::ConstValueIterator sdu_itr = sdulist.Begin(); sdu_itr != sdulist.End(); ++sdu_itr) {
          assert(sdu_itr->IsString());
          string              sdustr = sdu_itr->GetString();
          asn1::dyn_octstring octstr(sdustr.size());
          octstr.from_string(sdustr);
          handle_sdu(document, lcid, octstr.data(), octstr.size(), ttcn3_helpers::get_follow_on_flag(document));
        }
      } else if ((*itr)["PduSduList"].HasMember("MacPdu")) {
        log->warning("Not handling MacPdu type.");
      } else {
        log->warning("Not handling this PduSdu type.\n");
      }
    }

    return SRSLTE_SUCCESS;
  }

  void handle_sdu(Document& document, const uint16_t lcid, const uint8_t* payload, const uint16_t len, bool follow_on)
  {
    log->info_hex(payload, len, "Received DRB PDU (lcid=%d)\n", lcid);

    // pack into byte buffer
    unique_byte_buffer_t pdu = pool_allocate_blocking;
    pdu->N_bytes             = len;
    memcpy(pdu->msg, payload, pdu->N_bytes);

    syssim->add_dcch_pdu(ttcn3_helpers::get_timing_info(document),
                         ttcn3_helpers::get_cell_name(document),
                         lcid,
                         std::move(pdu),
                         follow_on);
  }

  ss_srb_interface* syssim = nullptr;
  byte_buffer_pool* pool   = nullptr;
};

#endif // SRSUE_TTCN3_DRB_INTERFACE_H