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

/*
 * Copyright 2013-2020 Software Radio Systems Limited
 *
 * This file is part of srsLTE.
 *
 * srsLTE 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.
 *
 * srsLTE 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/.
 *
 */

#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(std::string out)
  {
    if (initialized) {
      log->info_hex(
          reinterpret_cast<const uint8_t*>(out.c_str()), out.length(), "Sending %ld B to Titan\n", out.length());
      send(reinterpret_cast<const uint8_t*>(out.c_str()), out.length());
    } 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 (auto& sfdata : uplane["SubframeDataList"].GetArray()) {
      assert(sfdata.HasMember("PduSduList"));
      assert(sfdata["PduSduList"].IsObject());
      assert(sfdata["PduSduList"].HasMember("PdcpSdu"));
      assert(sfdata["PduSduList"]["PdcpSdu"].IsArray());

      const Value& sdulist = sfdata["PduSduList"]["PdcpSdu"];
      for (auto& sdu : sdulist.GetArray()) {
        assert(sdu.IsString());
        string              sdustr = sdu.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));
      }
    }

    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), lcid, std::move(pdu), follow_on);
  }

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

#endif // SRSUE_TTCN3_DRB_INTERFACE_H