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.
511 lines
16 KiB
C++
511 lines
16 KiB
C++
/*
|
|
* Copyright 2013-2019 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/.
|
|
*
|
|
*/
|
|
|
|
#include "srslte/common/bcd_helpers.h"
|
|
#include "srslte/common/log_filter.h"
|
|
#include "srslte/interfaces/ue_interfaces.h"
|
|
#include "srslte/upper/pdcp.h"
|
|
#include "srslte/upper/pdcp_entity_lte.h"
|
|
#include "srslte/upper/rlc.h"
|
|
#include "srsue/hdr/stack/mac/mac.h"
|
|
#include "srsue/hdr/stack/rrc/rrc.h"
|
|
#include "srsue/hdr/stack/upper/gw.h"
|
|
#include "srsue/hdr/stack/upper/nas.h"
|
|
#include "srsue/hdr/stack/upper/usim.h"
|
|
#include "srsue/hdr/stack/upper/usim_base.h"
|
|
#include <assert.h>
|
|
#include <iostream>
|
|
|
|
using namespace srsue;
|
|
using namespace asn1::rrc;
|
|
|
|
#define LCID 1
|
|
|
|
#define TESTASSERT(cond) \
|
|
{ \
|
|
if (!(cond)) { \
|
|
std::cout << "[" << __FUNCTION__ << "][Line " << __LINE__ << "]: FAIL at " << (#cond) << std::endl; \
|
|
return -1; \
|
|
} \
|
|
}
|
|
|
|
uint8_t auth_request_pdu[] = { 0x07, 0x52, 0x01, 0x0c, 0x63, 0xa8, 0x54, 0x13, 0xe6, 0xa4,
|
|
0xce, 0xd9, 0x86, 0xfb, 0xe5, 0xce, 0x9b, 0x62, 0x5e, 0x10,
|
|
0x67, 0x57, 0xb3, 0xc2, 0xb9, 0x70, 0x90, 0x01, 0x0c, 0x72,
|
|
0x8a, 0x67, 0x57, 0x92, 0x52, 0xb8 };
|
|
|
|
uint8_t sec_mode_command_pdu[] = { 0x37, 0x37, 0xc7, 0x67, 0xae, 0x00, 0x07, 0x5d, 0x02, 0x01,
|
|
0x02, 0xe0, 0x60, 0xc1 };
|
|
|
|
uint8_t attach_accept_pdu[] = { 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x07, 0x42, 0x01, 0x3e,
|
|
0x06, 0x00, 0x00, 0xf1, 0x10, 0x00, 0x01, 0x00, 0x2a, 0x52,
|
|
0x01, 0xc1, 0x01, 0x04, 0x1b, 0x07, 0x74, 0x65, 0x73, 0x74,
|
|
0x31, 0x32, 0x33, 0x06, 0x6d, 0x6e, 0x63, 0x30, 0x30, 0x31,
|
|
0x06, 0x6d, 0x63, 0x63, 0x30, 0x30, 0x31, 0x04, 0x67, 0x70,
|
|
0x72, 0x73, 0x05, 0x01, 0xc0, 0xa8, 0x05, 0x02, 0x27, 0x01,
|
|
0x80, 0x50, 0x0b, 0xf6, 0x00, 0xf1, 0x10, 0x80, 0x01, 0x01,
|
|
0x35, 0x16, 0x6d, 0xbc, 0x64, 0x01, 0x00 };
|
|
|
|
uint8_t esm_info_req_pdu[] = { 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x5a, 0xd9 };
|
|
|
|
uint8_t activate_dedicated_eps_bearer_pdu[] = {0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x62, 0x00, 0xc5, 0x05,
|
|
0x01, 0x01, 0x07, 0x21, 0x31, 0x00, 0x03, 0x40, 0x08, 0xae,
|
|
0x5d, 0x02, 0x00, 0xc2, 0x81, 0x34, 0x01, 0x4d};
|
|
|
|
uint8_t deactivate_eps_bearer_pdu[] = {0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x62, 0x00, 0xcd, 0x24};
|
|
|
|
uint16 mcc = 61441;
|
|
uint16 mnc = 65281;
|
|
|
|
using namespace srslte;
|
|
|
|
namespace srslte {
|
|
|
|
// fake classes
|
|
class pdcp_dummy : public rrc_interface_pdcp, public pdcp_interface_gw
|
|
{
|
|
public:
|
|
void write_pdu(uint32_t lcid, unique_byte_buffer_t pdu) {}
|
|
void write_pdu_bcch_bch(unique_byte_buffer_t pdu) {}
|
|
void write_pdu_bcch_dlsch(unique_byte_buffer_t pdu) {}
|
|
void write_pdu_pcch(unique_byte_buffer_t pdu) {}
|
|
void write_pdu_mch(uint32_t lcid, srslte::unique_byte_buffer_t sdu) {}
|
|
std::string get_rb_name(uint32_t lcid) { return std::string("lcid"); }
|
|
void write_sdu(uint32_t lcid, srslte::unique_byte_buffer_t sdu, bool blocking) {}
|
|
bool is_lcid_enabled(uint32_t lcid) { return false; }
|
|
};
|
|
|
|
class rrc_dummy : public rrc_interface_nas
|
|
{
|
|
public:
|
|
rrc_dummy() : last_sdu_len(0) {
|
|
plmns.plmn_id.from_number(mcc, mnc);
|
|
plmns.tac = 0xffff;
|
|
}
|
|
void init(nas* nas_) { nas_ptr = nas_; }
|
|
void write_sdu(unique_byte_buffer_t sdu)
|
|
{
|
|
last_sdu_len = sdu->N_bytes;
|
|
//printf("NAS generated SDU (len=%d):\n", sdu->N_bytes);
|
|
//srslte_vec_fprint_byte(stdout, sdu->msg, sdu->N_bytes);
|
|
}
|
|
std::string get_rb_name(uint32_t lcid) { return std::string("lcid"); }
|
|
uint32_t get_last_sdu_len() { return last_sdu_len; }
|
|
void reset() { last_sdu_len = 0; }
|
|
|
|
bool plmn_search()
|
|
{
|
|
nas_ptr->plmn_search_completed(&plmns, 1);
|
|
return true;
|
|
}
|
|
void plmn_select(srslte::plmn_id_t plmn_id){};
|
|
void set_ue_identity(srslte::s_tmsi_t s_tmsi) {}
|
|
bool connection_request(srslte::establishment_cause_t cause, srslte::unique_byte_buffer_t sdu)
|
|
{
|
|
printf("NAS generated SDU (len=%d):\n", sdu->N_bytes);
|
|
last_sdu_len = sdu->N_bytes;
|
|
srslte_vec_fprint_byte(stdout, sdu->msg, sdu->N_bytes);
|
|
nas_ptr->connection_request_completed(true);
|
|
return true;
|
|
}
|
|
bool is_connected() {return false;}
|
|
|
|
uint16_t get_mcc() { return mcc; }
|
|
uint16_t get_mnc() { return mnc; }
|
|
void enable_capabilities() {}
|
|
uint32_t get_lcid_for_eps_bearer(const uint32_t& eps_bearer_id) { return 0; }
|
|
void paging_completed(bool outcome) {}
|
|
|
|
private:
|
|
nas* nas_ptr;
|
|
uint32_t last_sdu_len;
|
|
found_plmn_t plmns;
|
|
};
|
|
|
|
class stack_dummy : public stack_interface_gw, public thread
|
|
{
|
|
public:
|
|
stack_dummy(pdcp_interface_gw* pdcp_, srsue::nas* nas_) : pdcp(pdcp_), nas(nas_), thread("DUMMY STACK") {}
|
|
void init() { start(-1); }
|
|
bool switch_on() final
|
|
{
|
|
proc_state_t proc_result = proc_state_t::on_going;
|
|
nas->start_attach_request(&proc_result);
|
|
while (proc_result == proc_state_t::on_going) {
|
|
usleep(1000);
|
|
}
|
|
return proc_result == proc_state_t::success;
|
|
}
|
|
void write_sdu(uint32_t lcid, srslte::unique_byte_buffer_t sdu, bool blocking)
|
|
{
|
|
pdcp->write_sdu(lcid, std::move(sdu), blocking);
|
|
}
|
|
bool is_lcid_enabled(uint32_t lcid) { return pdcp->is_lcid_enabled(lcid); }
|
|
void run_thread()
|
|
{
|
|
running = true;
|
|
uint32_t counter = 0;
|
|
while (running) {
|
|
nas->run_tti(counter++);
|
|
}
|
|
}
|
|
void stop()
|
|
{
|
|
running = false;
|
|
wait_thread_finish();
|
|
}
|
|
pdcp_interface_gw* pdcp = nullptr;
|
|
srsue::nas* nas = nullptr;
|
|
bool running = false;
|
|
};
|
|
|
|
class gw_dummy : public gw_interface_nas, public gw_interface_pdcp
|
|
{
|
|
int setup_if_addr(uint32_t lcid, uint8_t pdn_type, uint32_t ip_addr, uint8_t* ipv6_if_id, char* err_str)
|
|
{
|
|
return SRSLTE_SUCCESS;
|
|
}
|
|
int apply_traffic_flow_template(const uint8_t& eps_bearer_id,
|
|
const uint8_t& lcid,
|
|
const LIBLTE_MME_TRAFFIC_FLOW_TEMPLATE_STRUCT* tft)
|
|
{
|
|
return SRSLTE_SUCCESS;
|
|
}
|
|
void write_pdu(uint32_t lcid, unique_byte_buffer_t pdu) {}
|
|
void write_pdu_mch(uint32_t lcid, srslte::unique_byte_buffer_t sdu) {}
|
|
};
|
|
|
|
}
|
|
|
|
int security_command_test()
|
|
{
|
|
int ret = SRSLTE_ERROR;
|
|
srslte::log_filter nas_log("NAS");
|
|
srslte::log_filter rrc_log("RRC");
|
|
srslte::log_filter mac_log("MAC");
|
|
srslte::log_filter usim_log("USIM");
|
|
|
|
nas_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
rrc_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
nas_log.set_hex_limit(100000);
|
|
rrc_log.set_hex_limit(100000);
|
|
|
|
rrc_dummy rrc_dummy;
|
|
gw_dummy gw;
|
|
|
|
usim_args_t args;
|
|
args.algo = "xor";
|
|
args.imei = "353490069873319";
|
|
args.imsi = "001010123456789";
|
|
args.k = "00112233445566778899aabbccddeeff";
|
|
args.op = "63BFA50EE6523365FF14C1F45F88737D";
|
|
args.using_op = true;
|
|
|
|
// init USIM
|
|
srsue::usim usim(&usim_log);
|
|
bool net_valid;
|
|
uint8_t res[16];
|
|
usim.init(&args);
|
|
|
|
{
|
|
srsue::nas nas(&nas_log);
|
|
nas_args_t cfg;
|
|
cfg.eia = "1,2";
|
|
cfg.eea = "0,1,2";
|
|
nas.init(&usim, &rrc_dummy, &gw, cfg);
|
|
rrc_dummy.init(&nas);
|
|
|
|
// push auth request PDU to NAS to generate security context
|
|
byte_buffer_pool* pool = byte_buffer_pool::get_instance();
|
|
unique_byte_buffer_t tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, auth_request_pdu, sizeof(auth_request_pdu));
|
|
tmp->N_bytes = sizeof(auth_request_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
|
|
// TODO: add check for authentication response
|
|
rrc_dummy.reset();
|
|
|
|
// reuse buffer for security mode command
|
|
tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, sec_mode_command_pdu, sizeof(sec_mode_command_pdu));
|
|
tmp->N_bytes = sizeof(sec_mode_command_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
|
|
// check length of generated NAS SDU
|
|
if (rrc_dummy.get_last_sdu_len() > 3) {
|
|
ret = SRSLTE_SUCCESS;
|
|
}
|
|
}
|
|
|
|
byte_buffer_pool::get_instance()->cleanup();
|
|
|
|
return ret;
|
|
}
|
|
|
|
int mme_attach_request_test()
|
|
{
|
|
int ret = SRSLTE_ERROR;
|
|
srslte::log_filter nas_log("NAS");
|
|
srslte::log_filter rrc_log("RRC");
|
|
srslte::log_filter mac_log("MAC");
|
|
srslte::log_filter usim_log("USIM");
|
|
srslte::log_filter gw_log("GW");
|
|
|
|
nas_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
rrc_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
usim_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
gw_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
nas_log.set_hex_limit(100000);
|
|
rrc_log.set_hex_limit(100000);
|
|
usim_log.set_hex_limit(100000);
|
|
gw_log.set_hex_limit(100000);
|
|
|
|
rrc_dummy rrc_dummy;
|
|
pdcp_dummy pdcp_dummy;
|
|
|
|
srsue::usim usim(&usim_log);
|
|
usim_args_t args;
|
|
args.mode = "soft";
|
|
args.algo = "xor";
|
|
args.imei = "353490069873319";
|
|
args.imsi = "001010123456789";
|
|
args.k = "00112233445566778899aabbccddeeff";
|
|
args.op = "63BFA50EE6523365FF14C1F45F88737D";
|
|
usim.init(&args);
|
|
|
|
{
|
|
nas_args_t nas_cfg;
|
|
nas_cfg.force_imsi_attach = true;
|
|
nas_cfg.apn_name = "test123";
|
|
srsue::nas nas(&nas_log);
|
|
srsue::gw gw;
|
|
stack_dummy stack(&pdcp_dummy, &nas);
|
|
|
|
nas.init(&usim, &rrc_dummy, &gw, nas_cfg);
|
|
rrc_dummy.init(&nas);
|
|
|
|
gw_args_t gw_args;
|
|
gw_args.tun_dev_name = "tun0";
|
|
gw_args.log.gw_level = "debug";
|
|
gw_args.log.gw_hex_limit = 100000;
|
|
srslte::logger_stdout def_logstdout;
|
|
srslte::logger* logger = &def_logstdout;
|
|
gw.init(gw_args, logger, &stack);
|
|
|
|
stack.init();
|
|
// trigger test
|
|
stack.switch_on();
|
|
stack.stop();
|
|
|
|
// this will time out in the first place
|
|
|
|
// reset length of last received NAS PDU
|
|
rrc_dummy.reset();
|
|
|
|
// finally push attach accept
|
|
byte_buffer_pool* pool = byte_buffer_pool::get_instance();
|
|
unique_byte_buffer_t tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, attach_accept_pdu, sizeof(attach_accept_pdu));
|
|
tmp->N_bytes = sizeof(attach_accept_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
|
|
nas_metrics_t metrics;
|
|
nas.get_metrics(&metrics);
|
|
TESTASSERT(metrics.nof_active_eps_bearer == 1);
|
|
|
|
// check length of generated NAS SDU (attach complete)
|
|
if (rrc_dummy.get_last_sdu_len() > 3) {
|
|
ret = SRSLTE_SUCCESS;
|
|
}
|
|
// ensure buffers are deleted before pool cleanup
|
|
}
|
|
|
|
byte_buffer_pool::get_instance()->cleanup();
|
|
|
|
return ret;
|
|
}
|
|
|
|
int esm_info_request_test()
|
|
{
|
|
int ret = SRSLTE_ERROR;
|
|
srslte::log_filter nas_log("NAS");
|
|
srslte::log_filter rrc_log("RRC");
|
|
srslte::log_filter mac_log("MAC");
|
|
srslte::log_filter usim_log("USIM");
|
|
|
|
nas_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
rrc_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
nas_log.set_hex_limit(100000);
|
|
rrc_log.set_hex_limit(100000);
|
|
|
|
rrc_dummy rrc_dummy;
|
|
gw_dummy gw;
|
|
|
|
usim_args_t args;
|
|
args.algo = "xor";
|
|
args.imei = "353490069873319";
|
|
args.imsi = "001010123456789";
|
|
args.k = "00112233445566778899aabbccddeeff";
|
|
args.op = "63BFA50EE6523365FF14C1F45F88737D";
|
|
|
|
// init USIM
|
|
srsue::usim usim(&usim_log);
|
|
bool net_valid;
|
|
uint8_t res[16];
|
|
usim.init(&args);
|
|
|
|
srslte::byte_buffer_pool *pool;
|
|
pool = byte_buffer_pool::get_instance();
|
|
|
|
{
|
|
srsue::nas nas(&nas_log);
|
|
nas_args_t cfg;
|
|
cfg.apn_name = "srslte";
|
|
cfg.apn_user = "srsuser";
|
|
cfg.apn_pass = "srspass";
|
|
cfg.force_imsi_attach = true;
|
|
nas.init(&usim, &rrc_dummy, &gw, cfg);
|
|
|
|
// push ESM info request PDU to NAS to generate response
|
|
unique_byte_buffer_t tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, esm_info_req_pdu, sizeof(esm_info_req_pdu));
|
|
tmp->N_bytes = sizeof(esm_info_req_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
|
|
// check length of generated NAS SDU
|
|
if (rrc_dummy.get_last_sdu_len() > 3) {
|
|
ret = SRSLTE_SUCCESS;
|
|
}
|
|
}
|
|
|
|
pool->cleanup();
|
|
|
|
return ret;
|
|
}
|
|
|
|
int dedicated_eps_bearer_test()
|
|
{
|
|
srslte::log_filter nas_log("NAS");
|
|
srslte::log_filter rrc_log("RRC");
|
|
srslte::log_filter mac_log("MAC");
|
|
srslte::log_filter usim_log("USIM");
|
|
|
|
nas_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
rrc_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
nas_log.set_hex_limit(100000);
|
|
rrc_log.set_hex_limit(100000);
|
|
|
|
rrc_dummy rrc_dummy;
|
|
gw_dummy gw;
|
|
|
|
usim_args_t args;
|
|
args.algo = "xor";
|
|
args.imei = "353490069873319";
|
|
args.imsi = "001010123456789";
|
|
args.k = "00112233445566778899aabbccddeeff";
|
|
args.op = "63BFA50EE6523365FF14C1F45F88737D";
|
|
|
|
// init USIM
|
|
srsue::usim usim(&usim_log);
|
|
usim.init(&args);
|
|
|
|
srslte::byte_buffer_pool* pool = byte_buffer_pool::get_instance();
|
|
|
|
srsue::nas nas(&nas_log);
|
|
nas_args_t cfg = {};
|
|
cfg.force_imsi_attach = true; // make sure we get a fresh security context
|
|
nas.init(&usim, &rrc_dummy, &gw, cfg);
|
|
|
|
// push dedicated EPS bearer PDU to NAS
|
|
unique_byte_buffer_t tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, activate_dedicated_eps_bearer_pdu, sizeof(activate_dedicated_eps_bearer_pdu));
|
|
tmp->N_bytes = sizeof(activate_dedicated_eps_bearer_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
|
|
// This should fail since no default bearer has been created yet
|
|
nas_metrics_t metrics;
|
|
nas.get_metrics(&metrics);
|
|
TESTASSERT(metrics.nof_active_eps_bearer == 0);
|
|
|
|
// add default EPS beaerer
|
|
unique_byte_buffer_t attach_with_default_bearer = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(attach_with_default_bearer->msg, attach_accept_pdu, sizeof(attach_accept_pdu));
|
|
attach_with_default_bearer->N_bytes = sizeof(attach_accept_pdu);
|
|
nas.write_pdu(LCID, std::move(attach_with_default_bearer));
|
|
|
|
// This should fail since no default bearer has been created yet
|
|
nas.get_metrics(&metrics);
|
|
TESTASSERT(metrics.nof_active_eps_bearer == 1);
|
|
|
|
// push dedicated bearer activation and check that it was added
|
|
tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, activate_dedicated_eps_bearer_pdu, sizeof(activate_dedicated_eps_bearer_pdu));
|
|
tmp->N_bytes = sizeof(activate_dedicated_eps_bearer_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
nas.get_metrics(&metrics);
|
|
TESTASSERT(metrics.nof_active_eps_bearer == 2);
|
|
|
|
// tear-down dedicated bearer
|
|
tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, deactivate_eps_bearer_pdu, sizeof(deactivate_eps_bearer_pdu));
|
|
tmp->N_bytes = sizeof(deactivate_eps_bearer_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
nas.get_metrics(&metrics);
|
|
TESTASSERT(metrics.nof_active_eps_bearer == 1);
|
|
|
|
// try to tear-down dedicated bearer again
|
|
tmp = srslte::allocate_unique_buffer(*pool, true);
|
|
memcpy(tmp->msg, deactivate_eps_bearer_pdu, sizeof(deactivate_eps_bearer_pdu));
|
|
tmp->N_bytes = sizeof(deactivate_eps_bearer_pdu);
|
|
nas.write_pdu(LCID, std::move(tmp));
|
|
nas.get_metrics(&metrics);
|
|
TESTASSERT(metrics.nof_active_eps_bearer == 1);
|
|
|
|
pool->cleanup();
|
|
|
|
return SRSLTE_SUCCESS;
|
|
}
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
if (security_command_test()) {
|
|
printf("Security command test failed.\n");
|
|
return -1;
|
|
}
|
|
|
|
if (mme_attach_request_test()) {
|
|
printf("Attach request test failed.\n");
|
|
return -1;
|
|
}
|
|
|
|
if (esm_info_request_test()) {
|
|
printf("ESM info request test failed.\n");
|
|
return -1;
|
|
}
|
|
|
|
if (dedicated_eps_bearer_test()) {
|
|
printf("Dedicated EPS bearer test failed.\n");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|