|
|
|
/**
|
|
|
|
*
|
|
|
|
* \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 <unistd.h>
|
|
|
|
#include <signal.h>
|
|
|
|
|
|
|
|
#include "srslte/asn1/liblte_rrc.h"
|
|
|
|
#include "srslte/radio/radio_multi.h"
|
|
|
|
#include "phy/phy.h"
|
|
|
|
#include "srslte/interfaces/ue_interfaces.h"
|
|
|
|
#include "srslte/common/log_filter.h"
|
|
|
|
#include "mac/mac.h"
|
|
|
|
#include "srslte/common/mac_pcap.h"
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**********************************************************************
|
|
|
|
* Program arguments processing
|
|
|
|
***********************************************************************/
|
|
|
|
typedef struct {
|
|
|
|
float rf_rx_freq;
|
|
|
|
float rf_tx_freq;
|
|
|
|
float rf_rx_gain;
|
|
|
|
float rf_tx_gain;
|
|
|
|
int verbose;
|
|
|
|
bool do_trace;
|
|
|
|
bool do_pcap;
|
|
|
|
}prog_args_t;
|
|
|
|
|
|
|
|
void args_default(prog_args_t *args) {
|
|
|
|
args->rf_rx_freq = -1.0;
|
|
|
|
args->rf_tx_freq = -1.0;
|
|
|
|
args->rf_rx_gain = -1; // set to autogain
|
|
|
|
args->rf_tx_gain = -1;
|
|
|
|
args->verbose = 0;
|
|
|
|
args->do_trace = false;
|
|
|
|
args->do_pcap = false;
|
|
|
|
}
|
|
|
|
|
|
|
|
void usage(prog_args_t *args, char *prog) {
|
|
|
|
printf("Usage: %s [gGtpv] -f rx_frequency (in Hz) -F tx_frequency (in Hz)\n", prog);
|
|
|
|
printf("\t-g RF RX gain [Default AGC]\n");
|
|
|
|
printf("\t-G RF TX gain [Default same as RX gain (AGC)]\n");
|
|
|
|
printf("\t-t Enable trace [Default disabled]\n");
|
|
|
|
printf("\t-p Enable PCAP capture [Default disabled]\n");
|
|
|
|
printf("\t-v [increase verbosity, default none]\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
void parse_args(prog_args_t *args, int argc, char **argv) {
|
|
|
|
int opt;
|
|
|
|
args_default(args);
|
|
|
|
while ((opt = getopt(argc, argv, "gGftpFv")) != -1) {
|
|
|
|
switch (opt) {
|
|
|
|
case 'g':
|
|
|
|
args->rf_rx_gain = atof(argv[optind]);
|
|
|
|
break;
|
|
|
|
case 'G':
|
|
|
|
args->rf_tx_gain = atof(argv[optind]);
|
|
|
|
break;
|
|
|
|
case 'f':
|
|
|
|
args->rf_rx_freq = atof(argv[optind]);
|
|
|
|
break;
|
|
|
|
case 'F':
|
|
|
|
args->rf_tx_freq = atof(argv[optind]);
|
|
|
|
break;
|
|
|
|
case 't':
|
|
|
|
args->do_trace = true;
|
|
|
|
break;
|
|
|
|
case 'p':
|
|
|
|
args->do_pcap = true;
|
|
|
|
break;
|
|
|
|
case 'v':
|
|
|
|
args->verbose++;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
usage(args, argv[0]);
|
|
|
|
exit(-1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (args->rf_rx_freq < 0 || args->rf_tx_freq < 0) {
|
|
|
|
usage(args, argv[0]);
|
|
|
|
exit(-1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// Determine SI messages scheduling as in 36.331 5.2.3 Acquisition of an SI message
|
|
|
|
uint32_t sib_start_tti(uint32_t tti, uint32_t period, uint32_t x) {
|
|
|
|
return (period*10*(1+tti/(period*10))+x)%10240; // the 1 means next opportunity
|
|
|
|
}
|
|
|
|
|
|
|
|
void setup_mac_phy_sib2(LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_2_STRUCT *sib2, srsue::mac *mac, srsue::phy *phy) {
|
|
|
|
|
|
|
|
// Apply RACH configuration
|
|
|
|
srsue::mac_interface_rrc::mac_cfg_t mac_cfg;
|
|
|
|
mac->get_config(&mac_cfg);
|
|
|
|
memcpy(&mac_cfg.rach, &sib2->rr_config_common_sib.rach_cnfg, sizeof(LIBLTE_RRC_RACH_CONFIG_COMMON_STRUCT));
|
|
|
|
mac->set_config(&mac_cfg);
|
|
|
|
|
|
|
|
printf("Set RACH ConfigCommon: NofPreambles=%d, ResponseWindow=%d, ContentionResolutionTimer=%d ms, MaxTrials=%d\n",
|
|
|
|
liblte_rrc_number_of_ra_preambles_num[sib2->rr_config_common_sib.rach_cnfg.num_ra_preambles],
|
|
|
|
liblte_rrc_ra_response_window_size_num[sib2->rr_config_common_sib.rach_cnfg.ra_resp_win_size],
|
|
|
|
liblte_rrc_mac_contention_resolution_timer_num[sib2->rr_config_common_sib.rach_cnfg.mac_con_res_timer],
|
|
|
|
liblte_rrc_preamble_trans_max_num[sib2->rr_config_common_sib.rach_cnfg.preamble_trans_max]);
|
|
|
|
|
|
|
|
// Apply PHY RR Config Common
|
|
|
|
srsue::phy_interface_rrc::phy_cfg_common_t common;
|
|
|
|
memcpy(&common.pdsch_cnfg, &sib2->rr_config_common_sib.pdsch_cnfg, sizeof(LIBLTE_RRC_PDSCH_CONFIG_COMMON_STRUCT));
|
|
|
|
memcpy(&common.pusch_cnfg, &sib2->rr_config_common_sib.pusch_cnfg, sizeof(LIBLTE_RRC_PUSCH_CONFIG_COMMON_STRUCT));
|
|
|
|
memcpy(&common.pucch_cnfg, &sib2->rr_config_common_sib.pucch_cnfg, sizeof(LIBLTE_RRC_PUCCH_CONFIG_COMMON_STRUCT));
|
|
|
|
memcpy(&common.ul_pwr_ctrl, &sib2->rr_config_common_sib.ul_pwr_ctrl, sizeof(LIBLTE_RRC_UL_POWER_CONTROL_COMMON_STRUCT));
|
|
|
|
memcpy(&common.prach_cnfg, &sib2->rr_config_common_sib.prach_cnfg, sizeof(LIBLTE_RRC_PRACH_CONFIG_STRUCT));
|
|
|
|
if (sib2->rr_config_common_sib.srs_ul_cnfg.present) {
|
|
|
|
memcpy(&common.srs_ul_cnfg, &sib2->rr_config_common_sib.srs_ul_cnfg, sizeof(LIBLTE_RRC_SRS_UL_CONFIG_COMMON_STRUCT));
|
|
|
|
} else {
|
|
|
|
// default is release
|
|
|
|
common.srs_ul_cnfg.present = false;
|
|
|
|
}
|
|
|
|
phy->set_config_common(&common);
|
|
|
|
phy->configure_ul_params();
|
|
|
|
|
|
|
|
printf("Set PUSCH ConfigCommon: HopOffset=%d, RSGroup=%d, RSNcs=%d, N_sb=%d\n",
|
|
|
|
sib2->rr_config_common_sib.pusch_cnfg.pusch_hopping_offset,
|
|
|
|
sib2->rr_config_common_sib.pusch_cnfg.ul_rs.group_assignment_pusch,
|
|
|
|
sib2->rr_config_common_sib.pusch_cnfg.ul_rs.cyclic_shift,
|
|
|
|
sib2->rr_config_common_sib.pusch_cnfg.n_sb);
|
|
|
|
|
|
|
|
printf("Set PUCCH ConfigCommon: DeltaShift=%d, CyclicShift=%d, N1=%d, NRB=%d\n",
|
|
|
|
liblte_rrc_delta_pucch_shift_num[sib2->rr_config_common_sib.pucch_cnfg.delta_pucch_shift],
|
|
|
|
sib2->rr_config_common_sib.pucch_cnfg.n_cs_an,
|
|
|
|
sib2->rr_config_common_sib.pucch_cnfg.n1_pucch_an,
|
|
|
|
sib2->rr_config_common_sib.pucch_cnfg.n_rb_cqi);
|
|
|
|
|
|
|
|
printf("Set PRACH ConfigCommon: SeqIdx=%d, HS=%d, FreqOffset=%d, ZC=%d, ConfigIndex=%d\n",
|
|
|
|
sib2->rr_config_common_sib.prach_cnfg.root_sequence_index,
|
|
|
|
sib2->rr_config_common_sib.prach_cnfg.prach_cnfg_info.high_speed_flag?1:0,
|
|
|
|
sib2->rr_config_common_sib.prach_cnfg.prach_cnfg_info.prach_freq_offset,
|
|
|
|
sib2->rr_config_common_sib.prach_cnfg.prach_cnfg_info.zero_correlation_zone_config,
|
|
|
|
sib2->rr_config_common_sib.prach_cnfg.prach_cnfg_info.prach_config_index);
|
|
|
|
|
|
|
|
printf("Set SRS ConfigCommon: BW-Configuration=%d, SF-Configuration=%d, ACKNACK=%d\n",
|
|
|
|
sib2->rr_config_common_sib.srs_ul_cnfg.bw_cnfg,
|
|
|
|
sib2->rr_config_common_sib.srs_ul_cnfg.subfr_cnfg,
|
|
|
|
sib2->rr_config_common_sib.srs_ul_cnfg.ack_nack_simul_tx);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
void process_connsetup(LIBLTE_RRC_CONNECTION_SETUP_STRUCT *msg, srsue::mac *mac, srsue::phy *phy) {
|
|
|
|
|
|
|
|
// FIXME: There's an error parsing the connectionSetup message. This value is hard-coded:
|
|
|
|
|
|
|
|
if (msg->rr_cnfg.phy_cnfg_ded_present) {
|
|
|
|
phy->set_config_dedicated(&msg->rr_cnfg.phy_cnfg_ded);
|
|
|
|
}
|
|
|
|
printf("Set PHY configuration: SR-n_pucch=%d, SR-ConfigIndex=%d, SRS-ConfigIndex=%d, SRS-bw=%d, SRS-Nrcc=%d, SRS-hop=%d, SRS-Ncs=%d\n",
|
|
|
|
msg->rr_cnfg.phy_cnfg_ded.sched_request_cnfg.sr_pucch_resource_idx,
|
|
|
|
msg->rr_cnfg.phy_cnfg_ded.sched_request_cnfg.sr_cnfg_idx,
|
|
|
|
msg->rr_cnfg.phy_cnfg_ded.srs_ul_cnfg_ded.srs_cnfg_idx,
|
|
|
|
msg->rr_cnfg.phy_cnfg_ded.srs_ul_cnfg_ded.srs_bandwidth,
|
|
|
|
msg->rr_cnfg.phy_cnfg_ded.srs_ul_cnfg_ded.freq_domain_pos,
|
|
|
|
msg->rr_cnfg.phy_cnfg_ded.srs_ul_cnfg_ded.srs_hopping_bandwidth,
|
|
|
|
msg->rr_cnfg.phy_cnfg_ded.srs_ul_cnfg_ded.cyclic_shift);
|
|
|
|
|
|
|
|
srsue::mac_interface_rrc::mac_cfg_t mac_set;
|
|
|
|
mac->get_config(&mac_set);
|
|
|
|
memcpy(&mac_set.main, &msg->rr_cnfg.mac_main_cnfg, sizeof(LIBLTE_RRC_MAC_MAIN_CONFIG_STRUCT));
|
|
|
|
// SR is a PHY config but is needed by SR procedure in 36.321 5.4.4
|
|
|
|
memcpy(&mac_set.sr, &msg->rr_cnfg.phy_cnfg_ded.sched_request_cnfg, sizeof(LIBLTE_RRC_SCHEDULING_REQUEST_CONFIG_STRUCT));
|
|
|
|
mac->set_config(&mac_set);
|
|
|
|
|
|
|
|
printf("Set MAC configuration: dsr-TransMAX: %d, harq-MaxReTX=%d, bsr-TimerReTX=%d, bsr-TimerPeriodic=%d\n",
|
|
|
|
liblte_rrc_dsr_trans_max_num[msg->rr_cnfg.phy_cnfg_ded.sched_request_cnfg.dsr_trans_max],
|
|
|
|
liblte_rrc_max_harq_tx_num[msg->rr_cnfg.mac_main_cnfg.explicit_value.ulsch_cnfg.max_harq_tx],
|
|
|
|
liblte_rrc_retransmission_bsr_timer_num[msg->rr_cnfg.mac_main_cnfg.explicit_value.ulsch_cnfg.retx_bsr_timer],
|
|
|
|
liblte_rrc_periodic_bsr_timer_num[msg->rr_cnfg.mac_main_cnfg.explicit_value.ulsch_cnfg.periodic_bsr_timer]);
|
|
|
|
|
|
|
|
phy->configure_ul_params();
|
|
|
|
|
|
|
|
// Setup radio bearers
|
|
|
|
for (uint32_t i=0;i<msg->rr_cnfg.srb_to_add_mod_list_size;i++) {
|
|
|
|
if (msg->rr_cnfg.srb_to_add_mod_list[i].lc_default_cnfg_present) {
|
|
|
|
printf("Setting up Default Configuration for SRB%d \n", msg->rr_cnfg.srb_to_add_mod_list[i].srb_id);
|
|
|
|
switch(msg->rr_cnfg.srb_to_add_mod_list[i].srb_id) {
|
|
|
|
case 1:
|
|
|
|
mac->setup_lcid(1, 0, 1, -1, -1);
|
|
|
|
break;
|
|
|
|
case 2:
|
|
|
|
mac->setup_lcid(2, 0, 3, -1, -1);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
// for (int i=0;i<msg->rr_cnfg.drb_to_add_mod_list_size;i++) {
|
|
|
|
// printf("Setting up DRB%d\n", msg->rr_cnfg.drb_to_add_mod_list[i].drb_id);
|
|
|
|
// // todo
|
|
|
|
// }
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// Hex bytes for the connection setup complete packet
|
|
|
|
// Got hex bytes from http://www.sharetechnote.com/html/RACH_LTE.html
|
|
|
|
uint8_t setupComplete_segm[2][41] ={ {
|
|
|
|
0x88, 0x00, 0x00, 0x20, 0x21, 0x90, 0xa0, 0x12, 0x00, 0x00, 0x80, 0xf0, 0x5e, 0x3b, 0xf1, 0x04,
|
|
|
|
0x64, 0x04, 0x1d, 0x20, 0x44, 0x2f, 0xd8, 0x4b, 0xd1, 0x02, 0x00, 0x00, 0x83, 0x03, 0x41, 0xb0,
|
|
|
|
0xe5, 0x60, 0x13, 0x81, 0x83},
|
|
|
|
|
|
|
|
{0xb0, 0x01, 0x01, 0x01, 0x48, 0x4b, 0xd1, 0x00, 0x7d, 0x21, 0x70, 0x28, 0x01, 0x5c, 0x08, 0x80,
|
|
|
|
0x00, 0xc4, 0x0f, 0x97, 0x80, 0xd0, 0x4c, 0x4b, 0xd1, 0x00, 0xc0, 0x58, 0x44, 0x0d, 0x5d, 0x62,
|
|
|
|
0x99, 0x74, 0x04, 0x03, 0x80, 0x00, 0x00, 0x00, 0x00}
|
|
|
|
};
|
|
|
|
uint8_t setupComplete[80] = {
|
|
|
|
0x88, 0x00, 0x00, 0x20, 0x21, 0x90, 0xa0, 0x12, 0x00, 0x00, 0x80, 0xf0, 0x5e, 0x3b, 0xf1, 0x04,
|
|
|
|
0x64, 0x04, 0x1d, 0x20, 0x44, 0x2f, 0xd8, 0x4b, 0xd1, 0x02, 0x00, 0x00, 0x83, 0x03, 0x41, 0xb0,
|
|
|
|
0xe5, 0x60, 0x13, 0x81, 0x83, 0x48, 0x4b, 0xd1, 0x00, 0x7d, 0x21, 0x70, 0x28, 0x01, 0x5c, 0x08, 0x80,
|
|
|
|
0x00, 0xc4, 0x0f, 0x97, 0x80, 0xd0, 0x4c, 0x4b, 0xd1, 0x00, 0xc0, 0x58, 0x44, 0x0d, 0x5d, 0x62,
|
|
|
|
0x99, 0x74, 0x04, 0x03, 0x80, 0x00, 0x00, 0x00, 0x00};
|
|
|
|
|
|
|
|
uint32_t lengths[2] = {37, 41};
|
|
|
|
uint8_t reply[2] = {0x00, 0x04};
|
|
|
|
|
|
|
|
|
|
|
|
srslte::radio_multi radio;
|
|
|
|
srsue::phy phy;
|
|
|
|
srsue::mac mac;
|
|
|
|
srslte::mac_pcap mac_pcap;
|
|
|
|
|
|
|
|
prog_args_t prog_args;
|
|
|
|
|
|
|
|
void sig_int_handler(int signo)
|
|
|
|
{
|
|
|
|
if (prog_args.do_trace) {
|
|
|
|
//radio.write_trace("radio");
|
|
|
|
phy.write_trace("phy");
|
|
|
|
}
|
|
|
|
if (prog_args.do_pcap) {
|
|
|
|
mac_pcap.close();
|
|
|
|
}
|
|
|
|
mac.stop();
|
|
|
|
exit(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
class rlctest : public srsue::rlc_interface_mac {
|
|
|
|
public:
|
|
|
|
bool mib_decoded;
|
|
|
|
bool sib1_decoded;
|
|
|
|
bool sib2_decoded;
|
|
|
|
bool connsetup_decoded;
|
|
|
|
int nsegm_dcch;
|
|
|
|
int send_ack;
|
|
|
|
uint8_t si_window_len, sib2_period;
|
|
|
|
|
|
|
|
rlctest() {
|
|
|
|
mib_decoded = false;
|
|
|
|
sib1_decoded = false;
|
|
|
|
sib2_decoded = false;
|
|
|
|
connsetup_decoded = false;
|
|
|
|
nsegm_dcch = 0;
|
|
|
|
si_window_len = 0;
|
|
|
|
sib2_period = 0;
|
|
|
|
send_ack = 0;
|
|
|
|
}
|
|
|
|
uint32_t get_total_buffer_state(uint32_t lcid) {
|
|
|
|
return get_buffer_state(lcid);
|
|
|
|
}
|
|
|
|
uint32_t get_buffer_state(uint32_t lcid) {
|
|
|
|
if (lcid == 0) {
|
|
|
|
if (sib2_decoded && !connsetup_decoded) {
|
|
|
|
return 6;
|
|
|
|
}
|
|
|
|
} else if (lcid == 1) {
|
|
|
|
if (connsetup_decoded && nsegm_dcch < 2) {
|
|
|
|
return lengths[nsegm_dcch];
|
|
|
|
} else if (send_ack == 1) {
|
|
|
|
return 2;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int read_pdu(uint32_t lcid, uint8_t *payload, uint32_t nof_bytes)
|
|
|
|
{
|
|
|
|
if (lcid == 0) {
|
|
|
|
LIBLTE_RRC_UL_CCCH_MSG_STRUCT ul_ccch_msg;
|
|
|
|
// Prepare ConnectionRequest packet
|
|
|
|
ul_ccch_msg.msg_type = LIBLTE_RRC_UL_CCCH_MSG_TYPE_RRC_CON_REQ;
|
|
|
|
ul_ccch_msg.msg.rrc_con_req.ue_id_type = LIBLTE_RRC_CON_REQ_UE_ID_TYPE_RANDOM_VALUE;
|
|
|
|
ul_ccch_msg.msg.rrc_con_req.ue_id.random = 1000;
|
|
|
|
ul_ccch_msg.msg.rrc_con_req.cause = LIBLTE_RRC_CON_REQ_EST_CAUSE_MO_SIGNALLING;
|
|
|
|
liblte_rrc_pack_ul_ccch_msg(&ul_ccch_msg, &bit_msg);
|
|
|
|
|
|
|
|
uint64_t uecri=0;
|
|
|
|
uint8_t *ue_cri_ptr = (uint8_t*) &uecri;
|
|
|
|
uint32_t nbytes = bit_msg.N_bits/8;
|
|
|
|
uint8_t *ptr = bit_msg.msg;
|
|
|
|
for (uint32_t i=0;i<nbytes;i++) {
|
|
|
|
ue_cri_ptr[nbytes-i-1] = (uint8_t) srslte_bit_pack(&ptr, 8);
|
|
|
|
}
|
|
|
|
printf("Setting UE contention resolution ID: %lu\n", uecri);
|
|
|
|
mac.set_contention_id(uecri);
|
|
|
|
|
|
|
|
// Send ConnectionRequest Packet
|
|
|
|
printf("Send ConnectionRequest %d/%d bytes\n", nbytes, nof_bytes);
|
|
|
|
srslte_bit_pack_vector(bit_msg.msg, payload, nbytes*8);
|
|
|
|
bzero(&payload[nbytes], (nof_bytes-nbytes)*sizeof(uint8_t));
|
|
|
|
return nof_bytes;
|
|
|
|
} else if (lcid == 1) {
|
|
|
|
if (nsegm_dcch < 2) {
|
|
|
|
if (nof_bytes >= 80) {
|
|
|
|
printf("Sending Connection Setup Complete length 80\n");
|
|
|
|
memcpy(payload, setupComplete, 80);
|
|
|
|
return 80;
|
|
|
|
} else {
|
|
|
|
uint32_t r = 0;
|
|
|
|
if (nof_bytes >= lengths[nsegm_dcch]) {
|
|
|
|
printf("Sending Connection Setup Complete %d/2 length %d\n", nsegm_dcch, lengths[nsegm_dcch]);
|
|
|
|
memcpy(payload, setupComplete_segm[nsegm_dcch], lengths[nsegm_dcch]);
|
|
|
|
r = lengths[nsegm_dcch];
|
|
|
|
nsegm_dcch++;
|
|
|
|
} else {
|
|
|
|
r = 0;
|
|
|
|
}
|
|
|
|
return r;
|
|
|
|
}
|
|
|
|
} else if (send_ack == 1) {
|
|
|
|
printf("Send RLC ACK\n");
|
|
|
|
memcpy(payload, reply, 2*sizeof(uint8_t));
|
|
|
|
send_ack = 2;
|
|
|
|
return 2;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void write_pdu(uint32_t lcid, uint8_t *payload, uint32_t nof_bytes) {
|
|
|
|
if (lcid == 0) {
|
|
|
|
LIBLTE_RRC_DL_CCCH_MSG_STRUCT dl_ccch_msg;
|
|
|
|
printf("ConnSetup received %d bytes\n", nof_bytes);
|
|
|
|
srslte_vec_fprint_byte(stdout, payload, nof_bytes);
|
|
|
|
srslte_bit_unpack_vector(payload, bit_msg.msg, nof_bytes*8);
|
|
|
|
bit_msg.N_bits = nof_bytes*8;
|
|
|
|
liblte_rrc_unpack_dl_ccch_msg(&bit_msg, &dl_ccch_msg);
|
|
|
|
printf("Response: %s\n", liblte_rrc_dl_ccch_msg_type_text[dl_ccch_msg.msg_type]);
|
|
|
|
switch (dl_ccch_msg.msg_type) {
|
|
|
|
case LIBLTE_RRC_DL_CCCH_MSG_TYPE_RRC_CON_SETUP:
|
|
|
|
// Process ConnectionSetup
|
|
|
|
process_connsetup(&dl_ccch_msg.msg.rrc_con_setup, &mac, &phy);
|
|
|
|
connsetup_decoded = true;
|
|
|
|
break;
|
|
|
|
case LIBLTE_RRC_DL_CCCH_MSG_TYPE_RRC_CON_REJ:
|
|
|
|
case LIBLTE_RRC_DL_CCCH_MSG_TYPE_RRC_CON_REEST:
|
|
|
|
case LIBLTE_RRC_DL_CCCH_MSG_TYPE_RRC_CON_REEST_REJ:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
} else if (lcid == 1) {
|
|
|
|
printf("Received on DCCH0 %d bytes\n", nof_bytes);
|
|
|
|
if (send_ack == 0) {
|
|
|
|
send_ack = 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void write_pdu_bcch_bch(uint8_t *payload, uint32_t nof_bytes)
|
|
|
|
{
|
|
|
|
LIBLTE_RRC_MIB_STRUCT mib;
|
|
|
|
srslte_vec_fprint_byte(stdout, payload, nof_bytes);
|
|
|
|
srslte_bit_unpack_vector(payload, bit_msg.msg, nof_bytes*8);
|
|
|
|
bit_msg.N_bits = nof_bytes*8;
|
|
|
|
liblte_rrc_unpack_bcch_bch_msg(&bit_msg, &mib);
|
|
|
|
printf("MIB received %d bytes, BW=%s MHz\n", nof_bytes, liblte_rrc_dl_bandwidth_text[mib.dl_bw]);
|
|
|
|
mib_decoded = true;
|
|
|
|
}
|
|
|
|
|
|
|
|
void write_pdu_bcch_dlsch(uint8_t *payload, uint32_t nof_bytes)
|
|
|
|
{
|
|
|
|
LIBLTE_RRC_BCCH_DLSCH_MSG_STRUCT dlsch_msg;
|
|
|
|
srslte_bit_unpack_vector(payload, bit_msg.msg, nof_bytes*8);
|
|
|
|
bit_msg.N_bits = nof_bytes*8;
|
|
|
|
liblte_rrc_unpack_bcch_dlsch_msg(&bit_msg, &dlsch_msg);
|
|
|
|
if (dlsch_msg.N_sibs > 0) {
|
|
|
|
if (dlsch_msg.sibs[0].sib_type == LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_1 && !sib1_decoded) {
|
|
|
|
si_window_len = liblte_rrc_si_window_length_num[dlsch_msg.sibs[0].sib.sib1.si_window_length];
|
|
|
|
sib2_period = liblte_rrc_si_periodicity_num[dlsch_msg.sibs[0].sib.sib1.sched_info[0].si_periodicity];
|
|
|
|
printf("SIB1 received %d bytes, CellID=%d, si_window=%d, sib2_period=%d\n",
|
|
|
|
nof_bytes, dlsch_msg.sibs[0].sib.sib1.cell_id&0xfff, si_window_len, sib2_period);
|
|
|
|
sib1_decoded = true;
|
|
|
|
mac.bcch_stop_rx();
|
|
|
|
} else if (dlsch_msg.sibs[0].sib_type == LIBLTE_RRC_SYS_INFO_BLOCK_TYPE_2) {
|
|
|
|
|
|
|
|
printf("SIB2 received %d bytes\n", nof_bytes);
|
|
|
|
setup_mac_phy_sib2(&dlsch_msg.sibs[0].sib.sib2, &mac, &phy);
|
|
|
|
sib2_decoded = true;
|
|
|
|
mac.bcch_stop_rx();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void write_pdu_pcch(uint8_t *payload, uint32_t nof_bytes) {}
|
|
|
|
|
|
|
|
private:
|
|
|
|
LIBLTE_BIT_MSG_STRUCT bit_msg;
|
|
|
|
LIBLTE_BYTE_MSG_STRUCT byte_msg;
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
int main(int argc, char *argv[])
|
|
|
|
{
|
|
|
|
srslte::log_filter mac_log("MAC"), phy_log("PHY");
|
|
|
|
rlctest my_rlc;
|
|
|
|
parse_args(&prog_args, argc, argv);
|
|
|
|
|
|
|
|
switch (prog_args.verbose) {
|
|
|
|
case 1:
|
|
|
|
mac_log.set_level(srslte::LOG_LEVEL_INFO);
|
|
|
|
phy_log.set_level(srslte::LOG_LEVEL_INFO);
|
|
|
|
break;
|
|
|
|
case 2:
|
|
|
|
mac_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
|
|
phy_log.set_level(srslte::LOG_LEVEL_DEBUG);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Capture SIGINT to write traces
|
|
|
|
if (prog_args.do_trace) {
|
|
|
|
signal(SIGINT, sig_int_handler);
|
|
|
|
//radio.start_trace();
|
|
|
|
phy.start_trace();
|
|
|
|
}
|
|
|
|
|
|
|
|
if (prog_args.do_pcap) {
|
|
|
|
if (!prog_args.do_trace) {
|
|
|
|
signal(SIGINT, sig_int_handler);
|
|
|
|
}
|
|
|
|
mac_pcap.open("/tmp/ue_mac.pcap");
|
|
|
|
mac.start_pcap(&mac_pcap);
|
|
|
|
}
|
|
|
|
|
|
|
|
// Init Radio and PHY
|
|
|
|
radio.init();
|
|
|
|
phy.init(&radio, &mac, NULL, &phy_log);
|
|
|
|
if (prog_args.rf_rx_gain > 0 && prog_args.rf_tx_gain > 0) {
|
|
|
|
radio.set_rx_gain(prog_args.rf_rx_gain);
|
|
|
|
radio.set_tx_gain(prog_args.rf_tx_gain);
|
|
|
|
} else {
|
|
|
|
radio.start_agc(false);
|
|
|
|
radio.set_tx_rx_gain_offset(10);
|
|
|
|
phy.set_agc_enable(true);
|
|
|
|
}
|
|
|
|
// Init MAC
|
|
|
|
mac.init(&phy, &my_rlc, NULL, &mac_log);
|
|
|
|
|
|
|
|
// Set RX freq
|
|
|
|
radio.set_rx_freq(prog_args.rf_rx_freq);
|
|
|
|
radio.set_tx_freq(prog_args.rf_tx_freq);
|
|
|
|
|
|
|
|
|
|
|
|
while(1) {
|
|
|
|
uint32_t tti;
|
|
|
|
if (my_rlc.mib_decoded && mac.get_current_tti()) {
|
|
|
|
if (!my_rlc.sib1_decoded) {
|
|
|
|
usleep(10000);
|
|
|
|
tti = mac.get_current_tti();
|
|
|
|
mac.bcch_start_rx(sib_start_tti(tti, 2, 5), 1);
|
|
|
|
} else if (!my_rlc.sib2_decoded) {
|
|
|
|
usleep(10000);
|
|
|
|
tti = mac.get_current_tti();
|
|
|
|
mac.bcch_start_rx(sib_start_tti(tti, my_rlc.sib2_period, 0), my_rlc.si_window_len);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
usleep(50000);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|