|
|
|
/**
|
|
|
|
*
|
|
|
|
* \section COPYRIGHT
|
|
|
|
*
|
|
|
|
* Copyright 2013-2015 Software Radio Systems Limited
|
|
|
|
*
|
|
|
|
* \section LICENSE
|
|
|
|
*
|
|
|
|
* This file is part of the srsUE library.
|
|
|
|
*
|
|
|
|
* srsUE 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.
|
|
|
|
*
|
|
|
|
* srsUE 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 <iostream>
|
|
|
|
#include <assert.h>
|
|
|
|
#include <srsue/hdr/upper/usim_base.h>
|
|
|
|
#include "srsue/hdr/upper/usim.h"
|
|
|
|
#include "srsue/hdr/upper/pcsc_usim.h"
|
|
|
|
#include "srsue/hdr/upper/nas.h"
|
|
|
|
#include "srslte/upper/rlc.h"
|
|
|
|
#include "srsue/hdr/upper/rrc.h"
|
|
|
|
#include "srsue/hdr/mac/mac.h"
|
|
|
|
#include "srslte/common/log_filter.h"
|
|
|
|
#include "srslte/upper/pdcp_entity.h"
|
|
|
|
#include "srslte/upper/pdcp.h"
|
|
|
|
#include "srslte/interfaces/ue_interfaces.h"
|
|
|
|
#include "srslte/common/bcd_helpers.h"
|
|
|
|
|
|
|
|
|
|
|
|
using namespace srsue;
|
|
|
|
|
|
|
|
#define LCID 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, 0x0f, 0x4f, 0xb3, 0xef, 0x01, 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 };
|
|
|
|
|
|
|
|
uint16 mcc = 61441;
|
|
|
|
uint16 mnc = 65281;
|
|
|
|
|
|
|
|
using namespace srslte;
|
|
|
|
|
|
|
|
namespace srslte {
|
|
|
|
|
|
|
|
// fake classes
|
|
|
|
class pdcp_dummy : public rrc_interface_pdcp
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
void write_pdu(uint32_t lcid, byte_buffer_t *pdu) {}
|
|
|
|
void write_pdu_bcch_bch(byte_buffer_t *pdu) {}
|
|
|
|
void write_pdu_bcch_dlsch(byte_buffer_t *pdu) {}
|
|
|
|
void write_pdu_pcch(byte_buffer_t *pdu) {}
|
|
|
|
std::string get_rb_name(uint32_t lcid) { return std::string("lcid"); }
|
|
|
|
};
|
|
|
|
|
|
|
|
class rrc_dummy : public rrc_interface_nas
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
rrc_dummy() : last_sdu_len(0) {
|
|
|
|
plmns.plmn_id.mcc = mcc;
|
|
|
|
plmns.plmn_id.mnc = mnc;
|
|
|
|
plmns.tac = 0xffff;
|
|
|
|
}
|
|
|
|
void write_sdu(uint32_t lcid, 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);
|
|
|
|
byte_buffer_pool::get_instance()->deallocate(sdu);
|
|
|
|
}
|
|
|
|
std::string get_rb_name(uint32_t lcid) { return std::string("lcid"); }
|
|
|
|
uint32_t get_last_sdu_len() { return last_sdu_len; }
|
|
|
|
|
|
|
|
int plmn_search(srsue::rrc_interface_nas::found_plmn_t* found) {
|
|
|
|
memcpy(found, &plmns, sizeof(found_plmn_t));
|
|
|
|
return 1;
|
|
|
|
};
|
|
|
|
void plmn_select(LIBLTE_RRC_PLMN_IDENTITY_STRUCT plmn_id) {};
|
|
|
|
void set_ue_idenity(LIBLTE_RRC_S_TMSI_STRUCT s_tmsi) {}
|
|
|
|
bool connection_request(LIBLTE_RRC_CON_REQ_EST_CAUSE_ENUM cause, srslte::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);
|
|
|
|
byte_buffer_pool::get_instance()->deallocate(sdu);
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
bool is_connected() {return false;}
|
|
|
|
|
|
|
|
uint16_t get_mcc() { return mcc; }
|
|
|
|
uint16_t get_mnc() { return mnc; }
|
|
|
|
void enable_capabilities() {}
|
|
|
|
|
|
|
|
private:
|
|
|
|
uint32_t last_sdu_len;
|
|
|
|
found_plmn_t plmns;
|
|
|
|
};
|
|
|
|
|
|
|
|
class gw_dummy : public gw_interface_nas, public gw_interface_pdcp
|
|
|
|
{
|
|
|
|
error_t setup_if_addr(uint32_t ip_addr, char *err_str) { return ERROR_NONE; }
|
|
|
|
void write_pdu(uint32_t lcid, byte_buffer_t *pdu) {}
|
|
|
|
};
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
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";
|
|
|
|
|
|
|
|
|
|
|
|
// init USIM
|
|
|
|
srsue::usim usim;
|
|
|
|
bool net_valid;
|
|
|
|
uint8_t res[16];
|
|
|
|
usim.init(&args, &usim_log);
|
|
|
|
|
|
|
|
srsue::nas nas;
|
|
|
|
srslte_nas_config_t cfg;
|
|
|
|
nas.init(&usim, &rrc_dummy, &gw, &nas_log, cfg);
|
|
|
|
|
|
|
|
// push auth request PDU to NAS to generate security context
|
|
|
|
byte_buffer_t* tmp = byte_buffer_pool::get_instance()->allocate();
|
|
|
|
memcpy(tmp->msg, auth_request_pdu, sizeof(auth_request_pdu));
|
|
|
|
tmp->N_bytes = sizeof(auth_request_pdu);
|
|
|
|
nas.write_pdu(LCID, tmp);
|
|
|
|
|
|
|
|
// TODO: add check for authentication response
|
|
|
|
|
|
|
|
// reuse buffer for security mode command
|
|
|
|
memcpy(tmp->msg, sec_mode_command_pdu, sizeof(sec_mode_command_pdu));
|
|
|
|
tmp->N_bytes = sizeof(sec_mode_command_pdu);
|
|
|
|
nas.write_pdu(LCID, 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");
|
|
|
|
|
|
|
|
nas_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
|
|
rrc_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
|
|
usim_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);
|
|
|
|
|
|
|
|
rrc_dummy rrc_dummy;
|
|
|
|
gw_dummy gw;
|
|
|
|
srsue::pcsc_usim usim;
|
|
|
|
usim_args_t args;
|
|
|
|
args.mode = "pcsc";
|
|
|
|
args.algo = "xor";
|
|
|
|
args.imei = "353490069873319";
|
|
|
|
args.imsi = "001010123456789";
|
|
|
|
args.k = "00112233445566778899aabbccddeeff";
|
|
|
|
args.op = "63BFA50EE6523365FF14C1F45F88737D";
|
|
|
|
usim.init(&args, &usim_log);
|
|
|
|
|
|
|
|
srslte_nas_config_t nas_cfg;
|
|
|
|
srsue::nas nas;
|
|
|
|
nas.init(&usim, &rrc_dummy, &gw, &nas_log, nas_cfg);
|
|
|
|
|
|
|
|
nas.attach_request();
|
|
|
|
|
|
|
|
// this will time out in the first place
|
|
|
|
|
|
|
|
// finally push attach accept
|
|
|
|
byte_buffer_t* tmp = byte_buffer_pool::get_instance()->allocate();
|
|
|
|
memcpy(tmp->msg, attach_accept_pdu, sizeof(attach_accept_pdu));
|
|
|
|
tmp->N_bytes = sizeof(attach_accept_pdu);
|
|
|
|
nas.write_pdu(LCID, tmp);
|
|
|
|
|
|
|
|
// check length of generated NAS SDU (attach complete)
|
|
|
|
if (rrc_dummy.get_last_sdu_len() > 3) {
|
|
|
|
ret = SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
byte_buffer_pool::get_instance()->cleanup();
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|