/** * * \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 #include #include "srslte/asn1/liblte_rrc.h" #include "srslte/radio/radio_multi.h" #include "phy/phy.h" #include "srslte/common/mac_interface.h" #include "srslte/common/log_stdout.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;irr_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;irr_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= 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_stdout 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); } }