dlsim.c 47.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
/*
 * Licensed to the OpenAirInterface (OAI) Software Alliance under one or more
 * contributor license agreements.  See the NOTICE file distributed with
 * this work for additional information regarding copyright ownership.
 * The OpenAirInterface Software Alliance licenses this file to You under
 * the OAI Public License, Version 1.1  (the "License"); you may not use this file
 * except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.openairinterface.org/?page_id=698
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *-------------------------------------------------------------------------------
 * For more information about the OpenAirInterface (OAI) Software Alliance:
 *      contact@openairinterface.org
 */

#include <fcntl.h>
23 24
#include <math.h>
#include <string.h>
25 26
#include <sys/ioctl.h>
#include <sys/mman.h>
27 28
#include <unistd.h>
#include "common/ran_context.h"
29 30
#include "common/config/config_userapi.h"
#include "common/utils/LOG/log.h"
31 32 33
#include "LAYER2/NR_MAC_gNB/nr_mac_gNB.h"
#include "LAYER2/NR_MAC_UE/mac_defs.h"
#include "LAYER2/NR_MAC_UE/mac_extern.h"
34
#include "PHY/defs_gNB.h"
35 36
#include "PHY/defs_nr_common.h"
#include "PHY/defs_nr_UE.h"
37
#include "PHY/phy_vars_nr_ue.h"
38 39
#include "PHY/types.h"
#include "PHY/INIT/phy_init.h"
40
#include "PHY/MODULATION/modulation_eNB.h"
41
#include "PHY/MODULATION/nr_modulation.h"
42
#include "PHY/MODULATION/modulation_UE.h"
43
#include "PHY/NR_REFSIG/refsig_defs_ue.h"
44
#include "PHY/NR_TRANSPORT/nr_dlsch.h"
cig's avatar
cig committed
45
#include "PHY/NR_TRANSPORT/nr_transport_proto.h"
46
#include "PHY/NR_UE_TRANSPORT/nr_transport_proto_ue.h"
47
#include "SCHED_NR/fapi_nr_l1.h"
48
#include "SCHED_NR/sched_nr.h"
49
#include "SCHED_NR_UE/defs.h"
50 51 52 53
#include "SCHED_NR_UE/fapi_nr_ue_l1.h"
#include "NR_PHY_INTERFACE/NR_IF_Module.h"
#include "NR_UE_PHY_INTERFACE/NR_IF_Module.h"

54
#include "LAYER2/NR_MAC_UE/mac_proto.h"
yilmazt's avatar
yilmazt committed
55 56
//#include "LAYER2/NR_MAC_gNB/mac_proto.h"
//#include "openair2/LAYER2/NR_MAC_UE/mac_proto.h"
57
#include "LAYER2/NR_MAC_gNB/mac_proto.h"
58
#include "NR_asn_constant.h"
59
#include "RRC/NR/MESSAGES/asn1_msg.h"
60 61 62
#include "openair1/SIMULATION/RF/rf.h"
#include "openair1/SIMULATION/TOOLS/sim.h"
#include "openair1/SIMULATION/NR_PHY/nr_unitary_defs.h"
Raymond Knopp's avatar
Raymond Knopp committed
63
//#include "openair1/SIMULATION/NR_PHY/nr_dummy_functions.c"
64
#include "PHY/NR_REFSIG/ptrs_nr.h"
Raymond Knopp's avatar
Raymond Knopp committed
65
#include "NR_RRCReconfiguration.h"
66
#define inMicroS(a) (((double)(a))/(get_cpu_freq_GHz()*1000.0))
67 68
#include "SIMULATION/LTE_PHY/common_sim.h"

Laurent's avatar
Laurent committed
69 70
#include <openair2/LAYER2/MAC/mac_vars.h>
#include <openair2/RRC/LTE/rrc_vars.h>
71

72 73
LCHAN_DESC DCCH_LCHAN_DESC,DTCH_DL_LCHAN_DESC,DTCH_UL_LCHAN_DESC;
rlc_info_t Rlc_info_um,Rlc_info_am_config;
Raymond Knopp's avatar
Raymond Knopp committed
74

75 76 77
PHY_VARS_gNB *gNB;
PHY_VARS_NR_UE *UE;
RAN_CONTEXT_t RC;
78 79
int32_t uplink_frequency_offset[MAX_NUM_CCs][4];

80
double cpuf;
81

Laurent THOMAS's avatar
Laurent THOMAS committed
82 83
uint16_t sf_ahead=4 ;
uint16_t sl_ahead=0;
84
//uint8_t nfapi_mode = 0;
85
uint64_t downlink_frequency[MAX_NUM_CCs][4];
86 87 88 89
THREAD_STRUCT thread_struct;
nfapi_ue_release_request_body_t release_rntis;
msc_interface_t msc_interface;

90 91

// dummy functions
Raymond Knopp's avatar
Raymond Knopp committed
92 93
int dummy_nr_ue_ul_indication(nr_uplink_indication_t *ul_info)              { return(0);  }

94 95 96 97 98 99 100 101 102
int8_t nr_mac_rrc_data_ind_ue(const module_id_t module_id,
                              const int CC_id,
                              const uint8_t gNB_index,
                              const frame_t frame,
                              const sub_frame_t sub_frame,
                              const rnti_t rnti,
                              const channel_t channel,
                              const uint8_t* pduP,
                              const sdu_size_t pdu_len)
103 104 105 106
{
  return 0;
}

107 108 109 110 111
void nr_rrc_ue_generate_RRCSetupRequest(module_id_t module_id, const uint8_t gNB_index)
{
  return;
}

112 113 114 115 116 117 118 119 120 121
int8_t nr_mac_rrc_data_req_ue(const module_id_t Mod_idP,
                              const int         CC_id,
                              const uint8_t     gNB_id,
                              const frame_t     frameP,
                              const rb_id_t     Srb_id,
                              uint8_t           *buffer_pP)
{
  return 0;
}

122 123
void
rrc_data_ind(
124
  const protocol_ctxt_t *const ctxt_pP,
125 126 127 128 129 130 131 132 133 134 135 136 137 138 139
  const rb_id_t                Srb_id,
  const sdu_size_t             sdu_sizeP,
  const uint8_t   *const       buffer_pP
)
{
}

int
gtpv1u_create_s1u_tunnel(
  const instance_t                              instanceP,
  const gtpv1u_enb_create_tunnel_req_t *const  create_tunnel_req_pP,
  gtpv1u_enb_create_tunnel_resp_t *const create_tunnel_resp_pP
) {
  return 0;
}
140

141 142 143 144 145 146 147 148
int
rrc_gNB_process_GTPV1U_CREATE_TUNNEL_RESP(
  const protocol_ctxt_t *const ctxt_pP,
  const gtpv1u_enb_create_tunnel_resp_t *const create_tunnel_resp_pP,
  uint8_t                         *inde_list
) {
  return 0;
}
149

heshanyun's avatar
heshanyun committed
150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175
int
gtpv1u_create_ngu_tunnel(
  const instance_t instanceP,
  const gtpv1u_gnb_create_tunnel_req_t *  const create_tunnel_req_pP,
        gtpv1u_gnb_create_tunnel_resp_t * const create_tunnel_resp_pP){
  return 0;
}

int
gtpv1u_update_ngu_tunnel(
  const instance_t                              instanceP,
  const gtpv1u_gnb_create_tunnel_req_t *const  create_tunnel_req_pP,
  const rnti_t                                  prior_rnti
){
  return 0;
}

int
nr_rrc_gNB_process_GTPV1U_CREATE_TUNNEL_RESP(
  const protocol_ctxt_t *const ctxt_pP,
  const gtpv1u_gnb_create_tunnel_resp_t *const create_tunnel_resp_pP,
  uint8_t                         *inde_list
){
  return 0;
}

176 177 178 179 180 181
int nr_derive_key(int alg_type, uint8_t alg_id,
               const uint8_t key[32], uint8_t **out)
{
  return 0;
}

182
void config_common(int Mod_idP,
183
                   int ssb_SubcarrierOffset,
184 185
                   int pdsch_AntennaPorts,
                   int pusch_AntennaPorts,
186
		   NR_ServingCellConfigCommon_t *scc
Raymond Knopp's avatar
Raymond Knopp committed
187
		   );
188

189 190 191 192 193 194 195 196 197
int generate_dlsch_header(unsigned char *mac_header,
                          unsigned char num_sdus,
                          unsigned short *sdu_lengths,
                          unsigned char *sdu_lcids,
                          unsigned char drx_cmd,
                          unsigned short timing_advance_cmd,
                          unsigned char *ue_cont_res_id,
                          unsigned char short_padding,
                          unsigned short post_padding){return 0;}
198

199
// Dummy function to avoid linking error at compilation of nr-dlsim
200 201 202 203 204
int is_x2ap_enabled(void)
{
  return 0;
}

Mahesh's avatar
Mahesh committed
205 206 207 208 209 210 211
//nFAPI P7 dummy functions

int oai_nfapi_dl_tti_req(nfapi_nr_dl_tti_request_t *dl_config_req) { return(0);  }
int oai_nfapi_tx_data_req(nfapi_nr_tx_data_request_t *tx_data_req){ return(0);  }
int oai_nfapi_ul_dci_req(nfapi_nr_ul_dci_request_t *ul_dci_req){ return(0);  }
int oai_nfapi_ul_tti_req(nfapi_nr_ul_tti_request_t *ul_tti_req){ return(0);  }

212
// needed for some functions
213
openair0_config_t openair0_cfg[MAX_CARDS];
214 215
void update_ptrs_config(NR_CellGroupConfig_t *secondaryCellGroup, uint16_t *rbSize, uint8_t *mcsIndex,int8_t *ptrs_arg);
void update_dmrs_config(NR_CellGroupConfig_t *scg,PHY_VARS_NR_UE *ue, int8_t* dmrs_arg);
216
extern void fix_scd(NR_ServingCellConfig_t *scd);// forward declaration 
217

218 219
/* specific dlsim DL preprocessor: uses rbStart/rbSize/mcs from command line of
   dlsim, does not search for CCE/PUCCH occasion but simply sets to 0 */
220
int g_mcsIndex = -1, g_mcsTableIdx = 0, g_rbStart = -1, g_rbSize = -1;
221 222
void nr_dlsim_preprocessor(module_id_t module_id,
                           frame_t frame,
223
                           sub_frame_t slot) {
224 225 226 227 228 229
  NR_UE_info_t *UE_info = &RC.nrmac[module_id]->UE_info;
  AssertFatal(UE_info->num_UEs == 1, "can have only a single UE\n");
  NR_UE_sched_ctrl_t *sched_ctrl = &UE_info->UE_sched_ctrl[0];

  /* manually set free CCE to 0 */
  const int target_ss = NR_SearchSpace__searchSpaceType_PR_ue_Specific;
230 231
  NR_ServingCellConfigCommon_t *scc = RC.nrmac[module_id]->common_channels[0].ServingCellConfigCommon;
  sched_ctrl->search_space = get_searchspace(scc, sched_ctrl->active_bwp, target_ss);
232 233 234 235 236 237 238 239 240 241 242 243
  uint8_t nr_of_candidates;
  find_aggregation_candidates(&sched_ctrl->aggregation_level,
                              &nr_of_candidates,
                              sched_ctrl->search_space);
  sched_ctrl->coreset = get_coreset(
      sched_ctrl->active_bwp, sched_ctrl->search_space, 1 /* dedicated */);
  sched_ctrl->cce_index = 0;

  sched_ctrl->rbStart = g_rbStart;
  sched_ctrl->rbSize = g_rbSize;
  sched_ctrl->mcs = g_mcsIndex;
  sched_ctrl->time_domain_allocation = 2;
244
  sched_ctrl->mcsTableIdx = g_mcsTableIdx;
245 246 247 248 249 250 251 252 253 254 255 256 257 258
  /* the simulator assumes the HARQ PID is equal to the slot number */
  sched_ctrl->dl_harq_pid = slot;
  /* The scheduler uses lists to track whether a HARQ process is
   * free/busy/awaiting retransmission, and updates the HARQ process states.
   * However, in the simulation, we never get ack or nack for any HARQ process,
   * thus the list and HARQ states don't match what the scheduler expects.
   * Therefore, below lines just "repair" everything so that the scheduler
   * won't remark that there is no HARQ feedback */
  sched_ctrl->feedback_dl_harq.head = -1; // always overwrite feedback HARQ process
  if (sched_ctrl->harq_processes[slot].round == 0) // depending on round set in simulation ...
    add_front_nr_list(&sched_ctrl->available_dl_harq, slot); // ... make PID available
  else
    add_front_nr_list(&sched_ctrl->retrans_dl_harq, slot);   // ... make PID retransmission
  sched_ctrl->harq_processes[slot].is_waiting = false;
259 260 261
  AssertFatal(sched_ctrl->rbStart >= 0, "invalid rbStart %d\n", sched_ctrl->rbStart);
  AssertFatal(sched_ctrl->rbSize > 0, "invalid rbSize %d\n", sched_ctrl->rbSize);
  AssertFatal(sched_ctrl->mcs >= 0, "invalid sched_ctrl->mcs %d\n", sched_ctrl->mcs);
262
  AssertFatal(sched_ctrl->mcsTableIdx >= 0 && sched_ctrl->mcsTableIdx <= 2, "invalid sched_ctrl->mcsTableIdx %d\n", sched_ctrl->mcsTableIdx);
263 264
  sched_ctrl->numDmrsCdmGrpsNoData = 1;
}
265 266


267 268 269
int main(int argc, char **argv)
{
  char c;
270
  int i,aa;//,l;
271
  double sigma2, sigma2_dB=10, SNR, snr0=-2.0, snr1=2.0;
272
  uint8_t snr1set=0;
273 274 275 276
  double roundStats[500] = {0};
  double blerStats[500] = {0};
  double berStats[500] = {0};
  double snrStats[500] = {0};
277
  float effRate;
Francesco Mani's avatar
Francesco Mani committed
278
  //float psnr;
279
  float eff_tp_check = 0.7;
280
  uint8_t snrRun;
281
  uint32_t TBS = 0;
282 283
  int **txdata;
  double **s_re,**s_im,**r_re,**r_im;
284 285
  //double iqim = 0.0;
  //unsigned char pbch_pdu[6];
286 287 288
  //  int sync_pos, sync_pos_slot;
  //  FILE *rx_frame_file;
  FILE *output_fd = NULL;
289
  //uint8_t write_output_file=0;
290
  //int result;
291
  //int freq_offset;
292
  //  int subframe_offset;
293
  //  char fname[40], vname[40];
Ahmed Hussein's avatar
Ahmed Hussein committed
294
  int trial, n_trials = 1, n_errors = 0, n_false_positive = 0;
295
  //int n_errors2, n_alamouti;
296
  uint8_t transmission_mode = 1,n_tx=1,n_rx=1;
297 298
  uint8_t round;
  uint8_t num_rounds = 4;
299 300

  channel_desc_t *gNB2UE;
301 302 303
  //uint32_t nsymb,tx_lev,tx_lev1 = 0,tx_lev2 = 0;
  //uint8_t extended_prefix_flag=0;
  //int8_t interf1=-21,interf2=-21;
304 305

  FILE *input_fd=NULL,*pbch_file_fd=NULL;
306
  //char input_val_str[50],input_val_str2[50];
307

308
  //uint8_t frame_mod4,num_pdcch_symbols = 0;
309

310
  SCM_t channel_model = AWGN; // AWGN Rayleigh1 Rayleigh1_anticorr;
311

Laurent's avatar
Laurent committed
312
  NB_UE_INST = 1;
313 314
  //double pbch_sinr;
  //int pbch_tx_ant;
Ahmed Hussein's avatar
Ahmed Hussein committed
315
  int N_RB_DL=106,mu=1;
316

317
  //unsigned char frame_type = 0;
318

319
  int frame=1,slot=1;
320
  int frame_length_complex_samples;
321
  //int frame_length_complex_samples_no_prefix;
322 323 324 325 326
  NR_DL_FRAME_PARMS *frame_parms;
  UE_nr_rxtx_proc_t UE_proc;
  NR_Sched_Rsp_t Sched_INFO;
  gNB_MAC_INST *gNB_mac;
  NR_UE_MAC_INST_t *UE_mac;
327
  int cyclic_prefix_type = NFAPI_CP_NORMAL;
328
  int run_initial_sync=0;
329 330
  int pusch_tgt_snrx10 = 200;
  int pucch_tgt_snrx10 = 200;
Raymond Knopp's avatar
Raymond Knopp committed
331
  int loglvl=OAILOG_INFO;
332

333
  //float target_error_rate = 0.01;
334
  int css_flag=0;
335 336

  cpuf = get_cpu_freq_GHz();
337 338 339 340
  int8_t enable_ptrs = 0;
  int8_t modify_dmrs = 0;

  int8_t dmrs_arg[2] = {-1,-1};// Invalid values
341
  /* L_PTRS = ptrs_arg[0], K_PTRS = ptrs_arg[1] */
342 343
  int8_t ptrs_arg[2] = {-1,-1};// Invalid values

344 345 346 347 348 349
  uint16_t ptrsRePerSymb = 0;
  uint16_t pdu_bit_map = 0x0;
  uint16_t dlPtrsSymPos = 0;
  uint16_t ptrsSymbPerSlot = 0;
  uint16_t rbSize = 106;
  uint8_t  mcsIndex = 9;
350
  uint8_t  dlsch_threads = 0;
351
  if ( load_configmodule(argc,argv,CONFIG_ENABLECMDLINEONLY) == 0) {
yilmazt's avatar
yilmazt committed
352
    exit_fun("[NR_DLSIM] Error, configuration module init failed\n");
353 354 355 356
  }

  randominit(0);

357
  int print_perf             = 0;
358

359 360
  FILE *scg_fd=NULL;
  
361
  while ((c = getopt (argc, argv, "f:hA:pf:g:i:j:n:s:S:t:x:y:z:M:N:F:GR:dPIL:Ea:b:d:e:m:w:T:U:q")) != -1) {
362
    switch (c) {
363 364
    case 'f':
      scg_fd = fopen(optarg,"r");
365

366
      if (scg_fd==NULL) {
367 368 369
        printf("Error opening %s\n",optarg);
        exit(-1);
      }
370
      break;
371

372
    /*case 'd':
373
      frame_type = 1;
374
      break;*/
375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406

    case 'g':
      switch((char)*optarg) {
      case 'A':
        channel_model=SCM_A;
        break;

      case 'B':
        channel_model=SCM_B;
        break;

      case 'C':
        channel_model=SCM_C;
        break;

      case 'D':
        channel_model=SCM_D;
        break;

      case 'E':
        channel_model=EPA;
        break;

      case 'F':
        channel_model=EVA;
        break;

      case 'G':
        channel_model=ETU;
        break;

      default:
407
        printf("Unsupported channel model!\n");
408 409 410 411 412
        exit(-1);
      }

      break;

413
    /*case 'i':
414 415 416 417 418
      interf1=atoi(optarg);
      break;

    case 'j':
      interf2=atoi(optarg);
419
      break;*/
420 421 422 423 424 425 426

    case 'n':
      n_trials = atoi(optarg);
      break;

    case 's':
      snr0 = atof(optarg);
427
      printf("Setting SNR0 to %f\n",snr0);
428 429 430 431 432
      break;

    case 'S':
      snr1 = atof(optarg);
      snr1set=1;
433
      printf("Setting SNR1 to %f\n",snr1);
434 435 436 437 438 439 440
      break;

      /*
      case 't':
      Td= atof(optarg);
      break;
      */
441
    /*case 'p':
442
      extended_prefix_flag=1;
443
      break;*/
444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459

      /*
      case 'r':
      ricean_factor = pow(10,-.1*atof(optarg));
      if (ricean_factor>1) {
        printf("Ricean factor must be between 0 and 1\n");
        exit(-1);
      }
      break;
      */
    case 'x':
      transmission_mode=atoi(optarg);

      if ((transmission_mode!=1) &&
          (transmission_mode!=2) &&
          (transmission_mode!=6)) {
460
        printf("Unsupported transmission mode %d\n",transmission_mode);
461 462 463 464 465 466 467 468
        exit(-1);
      }

      break;

    case 'y':
      n_tx=atoi(optarg);

469
      if ((n_tx==0) || (n_tx>4)) {//extend gNB to support n_tx = 4
470
        printf("Unsupported number of tx antennas %d\n",n_tx);
471 472 473 474 475 476 477 478
        exit(-1);
      }

      break;

    case 'z':
      n_rx=atoi(optarg);

479
      if ((n_rx==0) || (n_rx>4)) {//extend UE to support n_tx = 4
480
        printf("Unsupported number of rx antennas %d\n",n_rx);
481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500
        exit(-1);
      }

      break;

    case 'R':
      N_RB_DL = atoi(optarg);
      break;

    case 'F':
      input_fd = fopen(optarg,"r");

      if (input_fd==NULL) {
        printf("Problem with filename %s\n",optarg);
        exit(-1);
      }

      break;

    case 'P':
501 502
      print_perf=1;
      opp_enabled=1;
503 504 505 506
      break;
      
    case 'I':
      run_initial_sync=1;
507
      //target_error_rate=0.1;
508
      slot = 0;
509 510 511 512 513 514
      break;

    case 'L':
      loglvl = atoi(optarg);
      break;

515

516 517 518
    case 'E':
	css_flag=1;
	break;
519

520

521
    case 'a':
522
      g_rbStart = atoi(optarg);
523 524 525
      break;

    case 'b':
526
      g_rbSize = atoi(optarg);
527
      break;
528 529 530
    case 'd':
      dlsch_threads = atoi(optarg);
      break;    
531
    case 'e':
532
      g_mcsIndex = atoi(optarg);
533 534
      break;

535 536 537 538 539
    case 'q':
      g_mcsTableIdx = 1;
      get_softmodem_params()->use_256qam_table = 1;
      break;

540 541 542
    case 'm':
      mu = atoi(optarg);
      break;
543

544 545 546 547
    case 't':
      eff_tp_check = (float)atoi(optarg)/100;
      break;

548 549 550
    case 'w':
      output_fd = fopen("txdata.dat", "w+");
      break;
Sakthivel Velumani's avatar
Sakthivel Velumani committed
551

552 553 554 555 556 557 558
    case 'T':
      enable_ptrs=1;
      for(i=0; i < atoi(optarg); i++) {
        ptrs_arg[i] = atoi(argv[optind++]);
      }
      break;

559 560
    case 'U':
      modify_dmrs = 1;
561
      for(i=0; i < atoi(optarg); i++) {
562 563 564
        dmrs_arg[i] = atoi(argv[optind++]);
      }
      break;
Sakthivel Velumani's avatar
Sakthivel Velumani committed
565

566 567 568 569 570
    default:
    case 'h':
      printf("%s -h(elp) -p(extended_prefix) -N cell_id -f output_filename -F input_filename -g channel_model -n n_frames -t Delayspread -s snr0 -S snr1 -x transmission_mode -y TXant -z RXant -i Intefrence0 -j Interference1 -A interpolation_file -C(alibration offset dB) -N CellId\n",
             argv[0]);
      printf("-h This message\n");
571 572
      //printf("-p Use extended prefix mode\n");
      //printf("-d Use TDD\n");
573 574 575 576 577
      printf("-n Number of frames to simulate\n");
      printf("-s Starting SNR, runs from SNR0 to SNR0 + 5 dB.  If n_frames is 1 then just SNR is simulated\n");
      printf("-S Ending SNR, runs from SNR0 to SNR1\n");
      printf("-t Delay spread for multipath channel\n");
      printf("-g [A,B,C,D,E,F,G] Use 3GPP SCM (A,B,C,D) or 36-101 (E-EPA,F-EVA,G-ETU) models (ignores delay spread and Ricean factor)\n");
578
      printf("-y Number of TX antennas used in gNB\n");
579
      printf("-z Number of RX antennas used in UE\n");
580 581
      //printf("-i Relative strength of first intefering gNB (in dB) - cell_id mod 3 = 1\n");
      //printf("-j Relative strength of second intefering gNB (in dB) - cell_id mod 3 = 2\n");
582 583 584
      printf("-R N_RB_DL\n");
      printf("-O oversampling factor (1,2,4,8,16)\n");
      printf("-A Interpolation_filname Run with Abstraction to generate Scatter plot using interpolation polynomial in file\n");
585
      //printf("-C Generate Calibration information for Abstraction (effective SNR adjustment to remove Pe bias w.r.t. AWGN)\n");
586
      printf("-f raw file containing RRC configuration (generated by gNB)\n");
587
      printf("-F Input filename (.txt format) for RX conformance testing\n");
588
      printf("-E used CSS scheduler\n");
589
      printf("-o CORESET offset\n");
590 591
      printf("-a Start PRB for PDSCH\n");
      printf("-b Number of PRB for PDSCH\n");
592 593
      printf("-c Start symbol for PDSCH (fixed for now)\n");
      printf("-j Number of symbols for PDSCH (fixed for now)\n");
594
      printf("-e MSC index\n");
595
      printf("-q Use 2nd MCS table (256 QAM table) for PDSCH\n");
596
      printf("-t Acceptable effective throughput (in percentage)\n");
597
      printf("-T Enable PTRS, arguments list L_PTRS{0,1,2} K_PTRS{2,4}, e.g. -T 2 0 2 \n");
598
      printf("-U Change DMRS Config, arguments list DMRS TYPE{0=A,1=B} DMRS AddPos{0:2}, e.g. -U 2 0 2 \n");
599
      printf("-P Print DLSCH performances\n");
Sakthivel Velumani's avatar
Sakthivel Velumani committed
600
      printf("-w Write txdata to binary file (one frame)\n");
601
      printf("-d number of dlsch threads, 0: no dlsch parallelization\n");
602 603 604 605
      exit (-1);
      break;
    }
  }
606

607 608 609
  logInit();
  set_glog(loglvl);
  T_stdout = 1;
610 611
  /* initialize the sin table */
  InitSinLUT();
612

613
  get_softmodem_params()->phy_test = 1;
614 615
  get_softmodem_params()->do_ra = 0;

616 617
  if (snr1set==0)
    snr1 = snr0+10;
618
  init_dlsch_tpool(dlsch_threads);
619 620


621 622 623
  RC.gNB = (PHY_VARS_gNB**) malloc(sizeof(PHY_VARS_gNB *));
  RC.gNB[0] = (PHY_VARS_gNB*) malloc(sizeof(PHY_VARS_gNB ));
  memset(RC.gNB[0],0,sizeof(PHY_VARS_gNB));
Raymond Knopp's avatar
Raymond Knopp committed
624

625
  gNB = RC.gNB[0];
626 627 628 629 630 631
  frame_parms = &gNB->frame_parms; //to be initialized I suppose (maybe not necessary for PBCH)
  frame_parms->nb_antennas_tx = n_tx;
  frame_parms->nb_antennas_rx = n_rx;
  frame_parms->N_RB_DL = N_RB_DL;
  frame_parms->N_RB_UL = N_RB_DL;

Raymond Knopp's avatar
Raymond Knopp committed
632
  RC.nb_nr_macrlc_inst = 1;
cig's avatar
cig committed
633 634 635
  RC.nb_nr_mac_CC = (int*)malloc(RC.nb_nr_macrlc_inst*sizeof(int));
  for (i = 0; i < RC.nb_nr_macrlc_inst; i++)
    RC.nb_nr_mac_CC[i] = 1;
Raymond Knopp's avatar
Raymond Knopp committed
636 637
  mac_top_init_gNB();
  gNB_mac = RC.nrmac[0];
638
  gNB_mac->pre_processor_dl = nr_dlsim_preprocessor;
Raymond Knopp's avatar
Raymond Knopp committed
639
  gNB_RRC_INST rrc;
Raymond Knopp's avatar
Raymond Knopp committed
640
  memset((void*)&rrc,0,sizeof(rrc));
641

642
  /*
Raymond Knopp's avatar
Raymond Knopp committed
643
  // read in SCGroupConfig
Raymond Knopp's avatar
Raymond Knopp committed
644
  AssertFatal(scg_fd != NULL,"no reconfig.raw file\n");
Raymond Knopp's avatar
Raymond Knopp committed
645 646 647 648
  char buffer[1024];
  int msg_len=fread(buffer,1,1024,scg_fd);
  NR_RRCReconfiguration_t *NR_RRCReconfiguration;

Raymond Knopp's avatar
Raymond Knopp committed
649
  printf("Decoding NR_RRCReconfiguration (%d bytes)\n",msg_len);
Raymond Knopp's avatar
Raymond Knopp committed
650 651 652 653 654 655 656 657 658 659 660 661 662 663
  asn_dec_rval_t dec_rval = uper_decode_complete( NULL,
						  &asn_DEF_NR_RRCReconfiguration,
						  (void **)&NR_RRCReconfiguration,
						  (uint8_t *)buffer,
						  msg_len); 
  
  if ((dec_rval.code != RC_OK) && (dec_rval.consumed == 0)) {
    AssertFatal(1==0,"NR_RRCReConfiguration decode error\n");
    // free the memory
    SEQUENCE_free( &asn_DEF_NR_RRCReconfiguration, NR_RRCReconfiguration, 1 );
    exit(-1);
  }      
  fclose(scg_fd);

Raymond Knopp's avatar
Raymond Knopp committed
664 665
  AssertFatal(NR_RRCReconfiguration->criticalExtensions.present == NR_RRCReconfiguration__criticalExtensions_PR_rrcReconfiguration,"wrong NR_RRCReconfiguration->criticalExstions.present type\n");

Raymond Knopp's avatar
Raymond Knopp committed
666 667 668 669 670 671 672 673 674 675 676 677 678 679 680
  NR_RRCReconfiguration_IEs_t *reconfig_ies = NR_RRCReconfiguration->criticalExtensions.choice.rrcReconfiguration;
  NR_CellGroupConfig_t *secondaryCellGroup;
  dec_rval = uper_decode_complete( NULL,
				   &asn_DEF_NR_CellGroupConfig,
				   (void **)&secondaryCellGroup,
				   (uint8_t *)reconfig_ies->secondaryCellGroup->buf,
				   reconfig_ies->secondaryCellGroup->size); 
  
  if ((dec_rval.code != RC_OK) && (dec_rval.consumed == 0)) {
    AssertFatal(1==0,"NR_CellGroupConfig decode error\n");
    // free the memory
    SEQUENCE_free( &asn_DEF_NR_CellGroupConfig, secondaryCellGroup, 1 );
    exit(-1);
  }      
  
681 682
  NR_ServingCellConfigCommon_t *scc = secondaryCellGroup->spCellConfig->reconfigurationWithSync->spCellConfigCommon;
  */
Raymond Knopp's avatar
Raymond Knopp committed
683

684 685 686 687

  rrc.carrier.servingcellconfigcommon = calloc(1,sizeof(*rrc.carrier.servingcellconfigcommon));

  NR_ServingCellConfigCommon_t *scc = rrc.carrier.servingcellconfigcommon;
688
  NR_ServingCellConfig_t *scd = calloc(1,sizeof(NR_ServingCellConfig_t));
689 690
  NR_CellGroupConfig_t *secondaryCellGroup=calloc(1,sizeof(*secondaryCellGroup));
  prepare_scc(rrc.carrier.servingcellconfigcommon);
691
  uint64_t ssb_bitmap = 1;
692
  fill_scc(rrc.carrier.servingcellconfigcommon,&ssb_bitmap,N_RB_DL,N_RB_DL,mu,mu);
693
  ssb_bitmap = 1;// Enable only first SSB with index ssb_indx=0
Francesco Mani's avatar
Francesco Mani committed
694 695
  fix_scc(scc,ssb_bitmap);

696
  prepare_scd(scd);
697 698

  fill_default_secondaryCellGroup(scc,
699 700 701 702 703 704
                                  scd,
                                  secondaryCellGroup,
                                  0,
                                  1,
                                  n_tx,
                                  0);
705

706 707
  /* RRC parameter validation for secondaryCellGroup */
  fix_scd(scd);
708
  /* -U option modify DMRS */
709
  if(modify_dmrs) {
710 711
    update_dmrs_config(secondaryCellGroup, NULL,dmrs_arg);
  }
712
  /* -T option enable PTRS */
713
  if(enable_ptrs) {
714
    update_ptrs_config(secondaryCellGroup, &rbSize, &mcsIndex, ptrs_arg);
715 716
  }

717

718
  //xer_fprint(stdout, &asn_DEF_NR_CellGroupConfig, (const void*)secondaryCellGroup);
Raymond Knopp's avatar
Raymond Knopp committed
719

Raymond Knopp's avatar
Raymond Knopp committed
720 721
  AssertFatal((gNB->if_inst         = NR_IF_Module_init(0))!=NULL,"Cannot register interface");
  gNB->if_inst->NR_PHY_config_req      = nr_phy_config_request;
Raymond Knopp's avatar
Raymond Knopp committed
722
  // common configuration
723
  rrc_mac_config_req_gNB(0,0,n_tx,1,pusch_tgt_snrx10,pucch_tgt_snrx10,scc,0,0,NULL);
Raymond Knopp's avatar
Raymond Knopp committed
724
  // UE dedicated configuration
725
  rrc_mac_config_req_gNB(0,0,n_tx,1,pusch_tgt_snrx10,pucch_tgt_snrx10,NULL,1,secondaryCellGroup->spCellConfig->reconfigurationWithSync->newUE_Identity,secondaryCellGroup);
Raymond Knopp's avatar
Raymond Knopp committed
726
  phy_init_nr_gNB(gNB,0,0);
727
  N_RB_DL = gNB->frame_parms.N_RB_DL;
728 729 730
  NR_UE_info_t *UE_info = &RC.nrmac[0]->UE_info;
  UE_info->num_UEs=1;

Raymond Knopp's avatar
Raymond Knopp committed
731
  // stub to configure frame_parms
Raymond Knopp's avatar
Raymond Knopp committed
732
  //  nr_phy_config_request_sim(gNB,N_RB_DL,N_RB_DL,mu,Nid_cell,SSB_positions);
Raymond Knopp's avatar
Raymond Knopp committed
733 734
  // call MAC to configure common parameters

735 736 737 738 739 740
  /* rrc_mac_config_req_gNB() has created one user, so set the scheduling
   * parameters from command line in global variables that will be picked up by
   * scheduling preprocessor */
  if (g_mcsIndex < 0) g_mcsIndex = 9;
  if (g_rbStart < 0) g_rbStart=0;
  if (g_rbSize < 0) g_rbSize = N_RB_DL - g_rbStart;
Raymond Knopp's avatar
Raymond Knopp committed
741

742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759
  double fs,bw;

  if (mu == 1 && N_RB_DL == 217) { 
    fs = 122.88e6;
    bw = 80e6;
  }					       
  else if (mu == 1 && N_RB_DL == 245) {
    fs = 122.88e6;
    bw = 90e6;
  }
  else if (mu == 1 && N_RB_DL == 273) {
    fs = 122.88e6;
    bw = 100e6;
  }
  else if (mu == 1 && N_RB_DL == 106) { 
    fs = 61.44e6;
    bw = 40e6;
  }
760 761 762 763
  else if (mu == 3 && N_RB_DL == 66) {
    fs = 122.88e6;
    bw = 100e6;
  }
764 765 766 767
  else if (mu == 3 && N_RB_DL == 32) {
    fs = 61.44e6;
    bw = 50e6;
  }
768 769 770 771 772
  else AssertFatal(1==0,"Unsupported numerology for mu %d, N_RB %d\n",mu, N_RB_DL);

  gNB2UE = new_channel_desc_scm(n_tx,
                                n_rx,
                                channel_model,
773
                                fs/1e6,//sampling frequency in MHz
774
				bw,
775
				30e-9,
776 777
                                0,
                                0,
778
                                0, 0);
779 780

  if (gNB2UE==NULL) {
781
    printf("Problem generating channel model. Exiting.\n");
782 783 784 785
    exit(-1);
  }

  frame_length_complex_samples = frame_parms->samples_per_subframe*NR_NUMBER_OF_SUBFRAMES_PER_FRAME;
786
  //frame_length_complex_samples_no_prefix = frame_parms->samples_per_subframe_wCP*NR_NUMBER_OF_SUBFRAMES_PER_FRAME;
787

788 789 790 791 792
  s_re = malloc(n_tx*sizeof(double*));
  s_im = malloc(n_tx*sizeof(double*));
  r_re = malloc(n_rx*sizeof(double*));
  r_im = malloc(n_rx*sizeof(double*));
  txdata = malloc(n_tx*sizeof(int*));
793

794
  for (i=0; i<n_tx; i++) {
795 796 797 798 799
    s_re[i] = malloc(frame_length_complex_samples*sizeof(double));
    bzero(s_re[i],frame_length_complex_samples*sizeof(double));
    s_im[i] = malloc(frame_length_complex_samples*sizeof(double));
    bzero(s_im[i],frame_length_complex_samples*sizeof(double));

800 801 802 803 804 805
    printf("Allocating %d samples for txdata\n",frame_length_complex_samples);
    txdata[i] = malloc(frame_length_complex_samples*sizeof(int));
    bzero(txdata[i],frame_length_complex_samples*sizeof(int));
  }

  for (i=0; i<n_rx; i++) {
806 807 808 809 810 811 812 813 814 815 816 817 818
    r_re[i] = malloc(frame_length_complex_samples*sizeof(double));
    bzero(r_re[i],frame_length_complex_samples*sizeof(double));
    r_im[i] = malloc(frame_length_complex_samples*sizeof(double));
    bzero(r_im[i],frame_length_complex_samples*sizeof(double));
  }

  if (pbch_file_fd!=NULL) {
    load_pbch_desc(pbch_file_fd);
  }


  //configure UE
  UE = malloc(sizeof(PHY_VARS_NR_UE));
Raymond Knopp's avatar
Raymond Knopp committed
819
  memset((void*)UE,0,sizeof(PHY_VARS_NR_UE));
820 821 822 823
  PHY_vars_UE_g = malloc(sizeof(PHY_VARS_NR_UE**));
  PHY_vars_UE_g[0] = malloc(sizeof(PHY_VARS_NR_UE*));
  PHY_vars_UE_g[0][0] = UE;
  memcpy(&UE->frame_parms,frame_parms,sizeof(NR_DL_FRAME_PARMS));
824
  UE->frame_parms.nb_antennas_rx = n_rx;
Raymond Knopp's avatar
Raymond Knopp committed
825

826
  if (run_initial_sync==1)  UE->is_synchronized = 0;
827
  else                      {UE->is_synchronized = 1; UE->UE_mode[0]=PUSCH;}
828 829 830 831 832 833 834 835 836
                      
  UE->perfect_ce = 0;

  if (init_nr_ue_signal(UE, 1, 0) != 0)
  {
    printf("Error at UE NR initialisation\n");
    exit(-1);
  }

837
  if(modify_dmrs) {
838 839
    update_dmrs_config( NULL,UE,dmrs_arg);
  }
840 841
  init_nr_ue_transport(UE,0);

842
  nr_gold_pbch(UE);
francescomani's avatar
francescomani committed
843
  nr_gold_pdcch(UE,0);
844

845
  nr_l2_init_ue(NULL);
846
  UE_mac = get_mac_inst(0);
847

848 849 850
  UE->if_inst = nr_ue_if_module_init(0);
  UE->if_inst->scheduled_response = nr_ue_scheduled_response;
  UE->if_inst->phy_config_request = nr_ue_phy_config_request;
851
  UE->if_inst->dl_indication = nr_ue_dl_indication;
852
  UE->if_inst->ul_indication = dummy_nr_ue_ul_indication;
853

854

855
  UE_mac->if_module = nr_ue_if_module_init(0);
856

857
  unsigned int available_bits=0;
Ahmed Hussein's avatar
Ahmed Hussein committed
858 859 860 861 862
  unsigned char *estimated_output_bit;
  unsigned char *test_input_bit;
  unsigned int errors_bit    = 0;
  uint32_t errors_scrambling = 0;

863

Ahmed Hussein's avatar
Ahmed Hussein committed
864 865
  test_input_bit       = (unsigned char *) malloc16(sizeof(unsigned char) * 16 * 68 * 384);
  estimated_output_bit = (unsigned char *) malloc16(sizeof(unsigned char) * 16 * 68 * 384);
866 867
  
  // generate signal
868 869
  AssertFatal(input_fd==NULL,"Not ready for input signal file\n");
  gNB->pbch_configured = 1;
870 871
  gNB->ssb[0].ssb_pdu.ssb_pdu_rel15.bchPayload=0x001234;
  gNB->ssb[0].ssb_pdu.ssb_pdu_rel15.SsbBlockIndex = 0;
Raymond Knopp's avatar
Raymond Knopp committed
872

873
  //Configure UE
874 875
  rrc.carrier.MIB = (uint8_t*) malloc(4);
  rrc.carrier.sizeof_MIB = do_MIB_NR(&rrc,0);
876

877
  nr_rrc_mac_config_req_ue(0,0,0,rrc.carrier.mib.message.choice.mib,secondaryCellGroup);
878

879 880 881 882 883 884 885 886

  nr_dcireq_t dcireq;
  nr_scheduled_response_t scheduled_response;
  memset((void*)&dcireq,0,sizeof(dcireq));
  memset((void*)&scheduled_response,0,sizeof(scheduled_response));
  dcireq.module_id = 0;
  dcireq.gNB_index = 0;
  dcireq.cc_id     = 0;
887
  
888 889 890 891 892 893 894
  scheduled_response.dl_config = &dcireq.dl_config_req;
  scheduled_response.ul_config = &dcireq.ul_config_req;
  scheduled_response.tx_request = NULL;
  scheduled_response.module_id = 0;
  scheduled_response.CC_id     = 0;
  scheduled_response.frame = frame;
  scheduled_response.slot  = slot;
895
  scheduled_response.thread_id = 0;
Francesco Mani's avatar
Francesco Mani committed
896

897
  nr_ue_phy_config_request(&UE_mac->phy_config);
Francesco Mani's avatar
Francesco Mani committed
898
  //NR_COMMON_channels_t *cc = RC.nrmac[0]->common_channels;
899
  snrRun = 0;
900

901

Ahmed Hussein's avatar
Ahmed Hussein committed
902
  for (SNR = snr0; SNR < snr1; SNR += .2) {
903

904 905 906 907 908 909 910 911 912 913 914
    varArray_t *table_tx=initVarArray(1000,sizeof(double));
    reset_meas(&gNB->phy_proc_tx); // total gNB tx
    reset_meas(&gNB->dlsch_scrambling_stats);
    reset_meas(&gNB->dlsch_interleaving_stats);
    reset_meas(&gNB->dlsch_rate_matching_stats);
    reset_meas(&gNB->dlsch_segmentation_stats);
    reset_meas(&gNB->dlsch_modulation_stats);
    reset_meas(&gNB->dlsch_encoding_stats);
    reset_meas(&gNB->tinput);
    reset_meas(&gNB->tprep);
    reset_meas(&gNB->tparity);
915
    reset_meas(&gNB->toutput);
916

917 918
    clear_pdsch_stats(gNB);

919
    n_errors = 0;
920
    effRate = 0;
921 922
    //n_errors2 = 0;
    //n_alamouti = 0;
923
    errors_scrambling=0;
924
    n_false_positive = 0;
925 926
    if (n_trials== 1) num_rounds = 1;

Ahmed Hussein's avatar
Ahmed Hussein committed
927
    for (trial = 0; trial < n_trials; trial++) {
928

929
      errors_bit = 0;
Ahmed Hussein's avatar
Ahmed Hussein committed
930
      //multipath channel
931
      //multipath_channel(gNB2UE,s_re,s_im,r_re,r_im,frame_length_complex_samples,0);
932

933
      UE->rx_offset=0;
934 935 936
      UE_proc.thread_id  = 0;
      UE_proc.frame_rx   = frame;
      UE_proc.nr_slot_rx = slot;
937 938 939
      
      dcireq.frame     = frame;
      dcireq.slot      = slot;
940

941
      NR_UE_DLSCH_t *dlsch0 = UE->dlsch[UE_proc.thread_id][0][0];
942

943
      int harq_pid = slot;
944 945 946
      NR_DL_UE_HARQ_t *UE_harq_process = dlsch0->harq_processes[harq_pid];

      NR_gNB_DLSCH_t *gNB_dlsch = gNB->dlsch[0][0];
947
      nfapi_nr_dl_tti_pdsch_pdu_rel15_t *rel15 = &gNB_dlsch->harq_process.pdsch_pdu.pdsch_pdu_rel15;
948
      
949 950
      UE_harq_process->harq_ack.ack = 0;
      round = 0;
951 952
      UE_harq_process->round = round;
      UE_harq_process->first_tx = 1;
953 954 955 956
        
      while ((round<num_rounds) && (UE_harq_process->harq_ack.ack==0)) {
        memset(RC.nrmac[0]->cce_list[1][0],0,MAX_NUM_CCE*sizeof(int));
        memset(RC.nrmac[0]->cce_list[1][1],0,MAX_NUM_CCE*sizeof(int));
957
        clear_nr_nfapi_information(RC.nrmac[0], 0, frame, slot);
958

959
        UE_info->UE_sched_ctrl[0].harq_processes[harq_pid].ndi = !(trial&1);
960

961

962
        UE_info->UE_sched_ctrl[0].harq_processes[harq_pid].round = round;
Sakthivel Velumani's avatar
Sakthivel Velumani committed
963
        for (int i=0; i<MAX_NUM_CORESET; i++)
964
          gNB_mac->UE_info.num_pdcch_cand[0][i] = 0;
965
      
966
        if (css_flag == 0) {
967
          nr_schedule_ue_spec(0, frame, slot);
968 969 970
        } else {
          nr_schedule_css_dlsch_phytest(0,frame,slot);
        }
971 972 973 974 975
        Sched_INFO.module_id = 0;
        Sched_INFO.CC_id     = 0;
        Sched_INFO.frame     = frame;
        Sched_INFO.slot      = slot;
        Sched_INFO.DL_req    = &gNB_mac->DL_req[0];
976
        Sched_INFO.UL_tti_req    = gNB_mac->UL_tti_req_ahead[slot];
977 978 979
        Sched_INFO.UL_dci_req  = NULL;
        Sched_INFO.TX_req    = &gNB_mac->TX_req[0];
        nr_schedule_response(&Sched_INFO);
980 981 982 983 984 985

        /* PTRS values for DLSIM calculations   */
        nfapi_nr_dl_tti_request_body_t *dl_req = &gNB_mac->DL_req[Sched_INFO.CC_id].dl_tti_request_body;
        nfapi_nr_dl_tti_request_pdu_t  *dl_tti_pdsch_pdu = &dl_req->dl_tti_pdu_list[1];
        nfapi_nr_dl_tti_pdsch_pdu_rel15_t *pdsch_pdu_rel15 = &dl_tti_pdsch_pdu->pdsch_pdu.pdsch_pdu_rel15;
        pdu_bit_map = pdsch_pdu_rel15->pduBitmap;
986
        if(pdu_bit_map & 0x1) {
987 988 989 990 991 992 993
          set_ptrs_symb_idx(&dlPtrsSymPos,
                            pdsch_pdu_rel15->NrOfSymbols,
                            pdsch_pdu_rel15->StartSymbolIndex,
                            1<<pdsch_pdu_rel15->PTRSTimeDensity,
                            pdsch_pdu_rel15->dlDmrsSymbPos);
          ptrsSymbPerSlot = get_ptrs_symbols_in_slot(dlPtrsSymPos, pdsch_pdu_rel15->StartSymbolIndex, pdsch_pdu_rel15->NrOfSymbols);
          ptrsRePerSymb = ((rel15->rbSize + rel15->PTRSFreqDensity - 1)/rel15->PTRSFreqDensity);
994
          printf("[DLSIM] PTRS Symbols in a slot: %2u, RE per Symbol: %3u, RE in a slot %4d\n", ptrsSymbPerSlot,ptrsRePerSymb, ptrsSymbPerSlot*ptrsRePerSymb );
995
        }
996
        if (run_initial_sync)
997
          nr_common_signal_procedures(gNB,frame,slot,gNB->ssb[0].ssb_pdu);
998
        else
999
          phy_procedures_gNB_TX(gNB,frame,slot,1);
1000 1001 1002 1003
            
        int txdataF_offset = (slot%2) * frame_parms->samples_per_slot_wCP;
        
        if (n_trials==1) {
1004
          LOG_M("txsigF0.m","txsF0=", &gNB->common_vars.txdataF[0][txdataF_offset+2*frame_parms->ofdm_symbol_size],frame_parms->ofdm_symbol_size,1,1);
1005
          if (gNB->frame_parms.nb_antennas_tx>1)
1006
            LOG_M("txsigF1.m","txsF1=", &gNB->common_vars.txdataF[1][txdataF_offset+2*frame_parms->ofdm_symbol_size],frame_parms->ofdm_symbol_size,1,1);
1007 1008
        }
        int tx_offset = frame_parms->get_samples_slot_timestamp(slot,frame_parms,0);
1009
        if (n_trials==1) printf("tx_offset %d, txdataF_offset %d \n", tx_offset,txdataF_offset);
1010

1011 1012 1013
        //TODO: loop over slots
        for (aa=0; aa<gNB->frame_parms.nb_antennas_tx; aa++) {
    
1014 1015 1016 1017 1018 1019 1020
          if (cyclic_prefix_type == 1) {
            PHY_ofdm_mod(&gNB->common_vars.txdataF[aa][txdataF_offset],
                         &txdata[aa][tx_offset],
                         frame_parms->ofdm_symbol_size,
                         12,
                         frame_parms->nb_prefix_samples,
                         CYCLIC_PREFIX);
1021
          } else {
1022 1023 1024 1025 1026
            nr_normal_prefix_mod(&gNB->common_vars.txdataF[aa][txdataF_offset],
                                 &txdata[aa][tx_offset],
                                 14,
                                 frame_parms);
          }
1027 1028 1029
        }
       
        if (n_trials==1) {
1030 1031 1032 1033 1034
          char filename[100];//LOG_M
          for (aa=0;aa<n_tx;aa++) {
            sprintf(filename,"txsig%d.m", aa);//LOG_M
            LOG_M(filename,"txs", &txdata[aa][tx_offset+frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples0],6*(frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples),1,1);
          }
1035
        }
Sakthivel Velumani's avatar
Sakthivel Velumani committed
1036 1037
        if (output_fd) {
          printf("writing txdata to binary file\n");
1038
          fwrite(txdata[0],sizeof(int32_t),frame_length_complex_samples,output_fd);
Sakthivel Velumani's avatar
Sakthivel Velumani committed
1039
        }
1040

1041 1042 1043 1044 1045 1046 1047 1048 1049
        int txlev[n_tx];
        int txlev_sum = 0;
        int l_ofdm = 6;
        for (aa=0; aa<n_tx; aa++) {
          txlev[aa] = signal_energy(&txdata[aa][tx_offset+l_ofdm*frame_parms->ofdm_symbol_size + (l_ofdm-1)*frame_parms->nb_prefix_samples + frame_parms->nb_prefix_samples0],
          frame_parms->ofdm_symbol_size + frame_parms->nb_prefix_samples);
          txlev_sum += txlev[aa];
          if (n_trials==1) printf("txlev[%d] = %d (%f dB) txlev_sum %d\n",aa,txlev[aa],10*log10((double)txlev[aa]),txlev_sum);
        }
1050 1051
        
        for (i=(frame_parms->get_samples_slot_timestamp(slot,frame_parms,0)); 
1052 1053 1054 1055
             i<(frame_parms->get_samples_slot_timestamp(slot+1,frame_parms,0)); 
             i++) {
    
          for (aa=0; aa<frame_parms->nb_antennas_tx; aa++) {
1056 1057
            s_re[aa][i] = ((double)(((short *)txdata[aa]))[(i<<1)]);
            s_im[aa][i] = ((double)(((short *)txdata[aa]))[(i<<1)+1]);
1058
          }
1059
        }
1060

1061
        double ts = 1.0/(frame_parms->subcarrier_spacing * frame_parms->ofdm_symbol_size); 
1062
        //Compute AWGN variance
1063
        sigma2_dB = 10 * log10((double)txlev_sum * ((double)UE->frame_parms.ofdm_symbol_size/(12*rel15->rbSize))) - SNR;
1064
        sigma2    = pow(10, sigma2_dB/10);
1065
        if (n_trials==1) printf("sigma2 %f (%f dB), txlev_sum %f (factor %f)\n",sigma2,sigma2_dB,10*log10((double)txlev_sum),(double)(double)UE->frame_parms.ofdm_symbol_size/(12*rel15->rbSize));
1066

1067 1068 1069 1070
        for (aa=0; aa<n_rx; aa++) {
          bzero(r_re[aa],frame_length_complex_samples*sizeof(double));
          bzero(r_im[aa],frame_length_complex_samples*sizeof(double));
        }
1071
        
1072 1073 1074 1075 1076 1077 1078 1079 1080
        // Apply MIMO Channel
        if (channel_model != AWGN) multipath_tv_channel(gNB2UE,
                             s_re,
                             s_im,
                             r_re,
                             r_im,
                             frame_length_complex_samples,
                             0);

1081
        for (i=frame_parms->get_samples_slot_timestamp(slot,frame_parms,0); 
1082 1083 1084
             i<frame_parms->get_samples_slot_timestamp(slot+1,frame_parms,0);
             i++) {

1085
          for (int aa_rx=0; aa_rx<n_rx; aa_rx++) {
1086 1087 1088 1089 1090 1091 1092 1093 1094

            if (channel_model == AWGN) {
              // sum up signals from different Tx antennas
              r_re[aa_rx][i] = 0;
              r_im[aa_rx][i] = 0;
              for (aa=0; aa<n_tx; aa++) {
                r_re[aa_rx][i] += s_re[aa][i];
                r_im[aa_rx][i] += s_im[aa][i];
              }
1095
            }
1096
            // Add Gaussian noise
1097 1098
            ((short*) UE->common_vars.rxdata[aa_rx])[2*i]   = (short) ((r_re[aa_rx][i] + sqrt(sigma2/2)*gaussdouble(0.0,1.0)));
            ((short*) UE->common_vars.rxdata[aa_rx])[2*i+1] = (short) ((r_im[aa_rx][i] + sqrt(sigma2/2)*gaussdouble(0.0,1.0)));
1099
            /* Add phase noise if enabled */
1100
            if (pdu_bit_map & 0x1) {
1101 1102
              phase_noise(ts, &((short*) UE->common_vars.rxdata[aa_rx])[2*i],
                          &((short*) UE->common_vars.rxdata[aa_rx])[2*i+1]);
1103
            }
1104
          }
1105
        }
1106

1107 1108 1109 1110
        nr_ue_dcireq(&dcireq); //to be replaced with function pointer later
        nr_ue_scheduled_response(&scheduled_response);
        
        phy_procedures_nrUE_RX(UE,
1111 1112
                               &UE_proc,
                               0,
1113
                               dlsch_threads);
1114
        
1115
        //printf("dlsim round %d ends\n",round);
1116 1117
        round++;
      } // round
1118

1119 1120 1121
      //----------------------------------------------------------
      //---------------------- count errors ----------------------
      //----------------------------------------------------------
1122 1123 1124

      if (UE->dlsch[UE_proc.thread_id][0][0]->last_iteration_cnt >=
        UE->dlsch[UE_proc.thread_id][0][0]->max_ldpc_iterations+1)
1125
        n_errors++;
1126 1127

      NR_UE_PDSCH **pdsch_vars = UE->pdsch_vars[UE_proc.thread_id];
1128
      int16_t *UE_llr = pdsch_vars[0]->llr[0];
1129

1130
      TBS                  = UE_harq_process->TBS;//rel15->TBSize[0];
1131
      uint16_t length_dmrs = get_num_dmrs(rel15->dlDmrsSymbPos);
1132 1133 1134 1135
      uint16_t nb_rb       = rel15->rbSize;
      uint8_t  nb_re_dmrs  = rel15->dmrsConfigType == NFAPI_NR_DMRS_TYPE1 ? 6 : 4;
      uint8_t  mod_order   = rel15->qamModOrder[0];
      uint8_t  nb_symb_sch = rel15->NrOfSymbols;
1136

1137
      available_bits = nr_get_G(nb_rb, nb_symb_sch, nb_re_dmrs, length_dmrs, mod_order, rel15->nrOfLayers);
1138
      if(pdu_bit_map & 0x1) {
1139
        available_bits-= (ptrsSymbPerSlot * ptrsRePerSymb *rel15->nrOfLayers* 2);
1140
        printf("[DLSIM][PTRS] Available bits are: %5u, removed PTRS bits are: %5u \n",available_bits, (ptrsSymbPerSlot * ptrsRePerSymb *rel15->nrOfLayers* 2) );
1141
      }
1142

1143
      for (i = 0; i < available_bits; i++) {
1144 1145

	if(((gNB_dlsch->harq_process.f[i] == 0) && (UE_llr[i] <= 0)) ||
1146
	   ((gNB_dlsch->harq_process.f[i] == 1) && (UE_llr[i] >= 0)))
1147 1148 1149 1150
	  {
	    if(errors_scrambling == 0) {
	      LOG_D(PHY,"\n");
	      LOG_D(PHY,"First bit in error in unscrambling = %d\n",i);
Raymond Knopp's avatar
Raymond Knopp committed
1151
	    }
1152
	    errors_scrambling++;
Raymond Knopp's avatar
Raymond Knopp committed
1153
	  }
1154

1155 1156
      }
      for (i = 0; i < TBS; i++) {
1157

1158
	estimated_output_bit[i] = (UE_harq_process->b[i/8] & (1 << (i & 7))) >> (i & 7);
1159
	test_input_bit[i]       = (gNB_dlsch->harq_process.b[i / 8] & (1 << (i & 7))) >> (i & 7); // Further correct for multiple segments
Raymond Knopp's avatar
Raymond Knopp committed
1160
	
1161 1162 1163 1164
	if (estimated_output_bit[i] != test_input_bit[i]) {
	  if(errors_bit == 0)
	    LOG_D(PHY,"First bit in error in decoding = %d (errors scrambling %d)\n",i,errors_scrambling);
	  errors_bit++;
Raymond Knopp's avatar
Raymond Knopp committed
1165 1166
	}
	
1167 1168 1169 1170 1171 1172
      }
      
      ////////////////////////////////////////////////////////////
      
      if (errors_scrambling > 0) {
	if (n_trials == 1)
1173
	  printf("errors_scrambling = %u/%u (trial %d)\n", errors_scrambling, available_bits,trial);
1174 1175 1176 1177 1178 1179 1180
      }
      
      if (errors_bit > 0) {
	n_false_positive++;
	if (n_trials == 1)
	  printf("errors_bit = %u (trial %d)\n", errors_bit, trial);
      }
1181
      roundStats[snrRun]+=((float)round); 
1182
      if (UE_harq_process->harq_ack.ack==1) effRate += ((float)TBS)/round;
Ahmed Hussein's avatar
Ahmed Hussein committed
1183
    } // noise trials
1184

1185
    blerStats[snrRun] = (float) n_errors / (float) n_trials;
1186
    roundStats[snrRun]/=((float)n_trials);
1187
    berStats[snrRun] = (double)errors_scrambling/available_bits/n_trials;
1188
    effRate /= n_trials;
Ahmed Hussein's avatar
Ahmed Hussein committed
1189 1190
    printf("*****************************************\n");
    printf("SNR %f, (false positive %f)\n", SNR,
Sakthivel Velumani's avatar
Sakthivel Velumani committed
1191
           (float) n_errors / (float) n_trials);
Ahmed Hussein's avatar
Ahmed Hussein committed
1192 1193
    printf("*****************************************\n");
    printf("\n");
1194
    dump_pdsch_stats(gNB);
1195
    printf("SNR %f : n_errors (negative CRC) = %d/%d, Avg round %.2f, Channel BER %e, BLER %.2f, Eff Rate %.4f bits/slot, Eff Throughput %.2f, TBS %u bits/slot\n", SNR, n_errors, n_trials,roundStats[snrRun],berStats[snrRun],blerStats[snrRun],effRate,effRate/TBS*100,TBS);
Ahmed Hussein's avatar
Ahmed Hussein committed
1196
    printf("\n");
1197

1198
    if (print_perf==1) {
1199
      printf("\ngNB TX function statistics (per %d us slot, NPRB %d, mcs %d, TBS %d, Kr %d (Zc %d))\n",
1200
	     1000>>*scc->ssbSubcarrierSpacing, g_rbSize, g_mcsIndex,
1201 1202 1203
	     gNB->dlsch[0][0]->harq_process.pdsch_pdu.pdsch_pdu_rel15.TBSize[0]<<3,
	     gNB->dlsch[0][0]->harq_process.K,
	     gNB->dlsch[0][0]->harq_process.K/((gNB->dlsch[0][0]->harq_process.pdsch_pdu.pdsch_pdu_rel15.TBSize[0]<<3)>3824?22:10));
1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231
      printDistribution(&gNB->phy_proc_tx,table_tx,"PHY proc tx");
      printStatIndent2(&gNB->dlsch_encoding_stats,"DLSCH encoding time");
      printStatIndent3(&gNB->dlsch_segmentation_stats,"DLSCH segmentation time");
      printStatIndent3(&gNB->tinput,"DLSCH LDPC input processing time");
      printStatIndent3(&gNB->tprep,"DLSCH LDPC input preparation time");
      printStatIndent3(&gNB->tparity,"DLSCH LDPC parity generation time");
      printStatIndent3(&gNB->toutput,"DLSCH LDPC output generation time");
      printStatIndent3(&gNB->dlsch_rate_matching_stats,"DLSCH Rate Mataching time");
      printStatIndent3(&gNB->dlsch_interleaving_stats,  "DLSCH Interleaving time");
      printStatIndent2(&gNB->dlsch_modulation_stats,"DLSCH modulation time");
      printStatIndent2(&gNB->dlsch_scrambling_stats,  "DLSCH scrambling time");


      printf("\nUE RX function statistics (per %d us slot)\n",1000>>*scc->ssbSubcarrierSpacing);
      /*
      printDistribution(&phy_proc_rx_tot, table_rx,"Total PHY proc rx");
      printStatIndent(&ue_front_end_tot,"Front end processing");
      printStatIndent(&dlsch_llr_tot,"rx_pdsch processing");
      printStatIndent2(&pdsch_procedures_tot,"pdsch processing");
      printStatIndent2(&dlsch_procedures_tot,"dlsch processing");
      printStatIndent2(&UE->crnti_procedures_stats,"C-RNTI processing");
      printStatIndent(&UE->ofdm_demod_stats,"ofdm demodulation");
      printStatIndent(&UE->dlsch_channel_estimation_stats,"DLSCH channel estimation time");
      printStatIndent(&UE->dlsch_freq_offset_estimation_stats,"DLSCH frequency offset estimation time");
      printStatIndent(&dlsch_decoding_tot, "DLSCH Decoding time ");
      printStatIndent(&UE->dlsch_unscrambling_stats,"DLSCH unscrambling time");
      printStatIndent(&UE->dlsch_rate_unmatching_stats,"DLSCH Rate Unmatching");
      printf("|__ DLSCH Turbo Decoding(%d bits), avg iterations: %.1f       %.2f us (%d cycles, %d trials)\n",
1232 1233 1234
	     UE->dlsch[UE_proc.thread_id][0][0]->harq_processes[0]->Cminus ?
	     UE->dlsch[UE_proc.thread_id][0][0]->harq_processes[0]->Kminus :
	     UE->dlsch[UE_proc.thread_id][0][0]->harq_processes[0]->Kplus,
1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247
	     UE->dlsch_tc_intl1_stats.trials/(double)UE->dlsch_tc_init_stats.trials,
	     (double)UE->dlsch_turbo_decoding_stats.diff/UE->dlsch_turbo_decoding_stats.trials*timeBase,
	     (int)((double)UE->dlsch_turbo_decoding_stats.diff/UE->dlsch_turbo_decoding_stats.trials),
	     UE->dlsch_turbo_decoding_stats.trials);
      printStatIndent2(&UE->dlsch_tc_init_stats,"init");
      printStatIndent2(&UE->dlsch_tc_alpha_stats,"alpha");
      printStatIndent2(&UE->dlsch_tc_beta_stats,"beta");
      printStatIndent2(&UE->dlsch_tc_gamma_stats,"gamma");
      printStatIndent2(&UE->dlsch_tc_ext_stats,"ext");
      printStatIndent2(&UE->dlsch_tc_intl1_stats,"turbo internal interleaver");
      printStatIndent2(&UE->dlsch_tc_intl2_stats,"intl2+HardDecode+CRC");
      */
    }
1248 1249 1250 1251 1252 1253 1254 1255

    if (n_trials == 1) {
      
      LOG_M("rxsig0.m","rxs0", UE->common_vars.rxdata[0], frame_length_complex_samples, 1, 1);
      if (UE->frame_parms.nb_antennas_rx>1)
	LOG_M("rxsig1.m","rxs1", UE->common_vars.rxdata[1], frame_length_complex_samples, 1, 1);
      LOG_M("chestF0.m","chF0",UE->pdsch_vars[0][0]->dl_ch_estimates_ext,N_RB_DL*12*14,1,1);
      write_output("rxF_comp.m","rxFc",&UE->pdsch_vars[0][0]->rxdataF_comp0[0][0],N_RB_DL*12*14,1,1);
1256
      LOG_M("rxF_llr.m","rxFllr",UE->pdsch_vars[UE_proc.thread_id][0]->llr[0],available_bits,1,0);
1257 1258 1259
      break;
    }

1260
    if (effRate > (eff_tp_check*TBS)) {
1261 1262 1263 1264
      printf("PDSCH test OK\n");
      break;
    }

1265
    snrStats[snrRun] = SNR;
1266
    snrRun++;
1267 1268
  } // NSR

1269 1270 1271 1272
  LOG_M("dlsimStats.m","SNR",snrStats,snrRun,1,7);
  LOG_MM("dlsimStats.m","BLER",blerStats,snrRun,1,7);
  LOG_MM("dlsimStats.m","BER",berStats,snrRun,1,7);
  LOG_MM("dlsimStats.m","rounds",roundStats,snrRun,1,7);
1273
  /*if (n_trials>1) {
1274 1275 1276 1277 1278 1279
    printf("HARQ stats:\nSNR\tRounds\n");
    psnr = snr0;
    for (uint8_t i=0; i<snrRun; i++) {
      printf("%.1f\t%.2f\n",psnr,roundStats[i]);
      psnr+=0.2;
    }
1280
  }*/
1281

1282 1283
  free_channel_desc_scm(gNB2UE);

1284
  for (i = 0; i < n_tx; i++) {
1285 1286
    free(s_re[i]);
    free(s_im[i]);
1287 1288 1289
    free(txdata[i]);
  }
  for (i = 0; i < n_rx; i++) {
1290 1291 1292 1293 1294 1295 1296 1297 1298
    free(r_re[i]);
    free(r_im[i]);
  }

  free(s_re);
  free(s_im);
  free(r_re);
  free(r_im);
  free(txdata);
Ahmed Hussein's avatar
Ahmed Hussein committed
1299 1300 1301
  free(test_input_bit);
  free(estimated_output_bit);
  
1302 1303 1304 1305 1306 1307
  if (output_fd)
    fclose(output_fd);

  if (input_fd)
    fclose(input_fd);

1308 1309
  if (scg_fd)
    fclose(scg_fd);
1310
  return(n_errors);
Raymond Knopp's avatar
Raymond Knopp committed
1311
  
1312
}
1313 1314


1315
void update_ptrs_config(NR_CellGroupConfig_t *secondaryCellGroup, uint16_t *rbSize, uint8_t *mcsIndex, int8_t *ptrs_arg)
1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328
{
  NR_BWP_Downlink_t *bwp=secondaryCellGroup->spCellConfig->spCellConfigDedicated->downlinkBWP_ToAddModList->list.array[0];
  int *ptrsFreqDenst = calloc(2, sizeof(long));
  ptrsFreqDenst[0]= 25;
  ptrsFreqDenst[1]= 115;
  int *ptrsTimeDenst = calloc(3, sizeof(long));
  ptrsTimeDenst[0]= 2;
  ptrsTimeDenst[1]= 4;
  ptrsTimeDenst[2]= 10;

  int epre_Ratio = 0;
  int reOffset = 0;

1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340
  if(ptrs_arg[0] ==0) {
    ptrsTimeDenst[2]= *mcsIndex -1;
  }
  else if(ptrs_arg[0] == 1) {
    ptrsTimeDenst[1]= *mcsIndex - 1;
    ptrsTimeDenst[2]= *mcsIndex + 1;
  }
  else if(ptrs_arg[0] ==2) {
    ptrsTimeDenst[0]= *mcsIndex - 1;
    ptrsTimeDenst[1]= *mcsIndex + 1;
  }
  else {
1341 1342 1343
    printf("[DLSIM] Wrong L_PTRS value, using default values 1\n");
  }
  /* L = 4 if Imcs < MCS4 */
1344 1345 1346 1347 1348 1349 1350 1351 1352 1353
  if(ptrs_arg[1] ==2) {
    ptrsFreqDenst[0]= *rbSize - 1;
    ptrsFreqDenst[1]= *rbSize + 1;
  }
  else if(ptrs_arg[1] == 4) {
    ptrsFreqDenst[1]= *rbSize - 1;
  }
  else {
    printf("[DLSIM] Wrong K_PTRS value, using default values 2\n");
  }
1354
  printf("[DLSIM] PTRS Enabled with L %d, K %d \n", 1<<ptrs_arg[0], ptrs_arg[1] );
1355 1356 1357 1358
  /* overwrite the values */
  rrc_config_dl_ptrs_params(bwp, ptrsFreqDenst, ptrsTimeDenst, &epre_Ratio, &reOffset);
}

1359 1360 1361 1362
void update_dmrs_config(NR_CellGroupConfig_t *scg,PHY_VARS_NR_UE *ue, int8_t* dmrs_arg)
{
  int8_t  mapping_type = typeA;//default value
  int8_t  add_pos = pdsch_dmrs_pos0;//default value
1363
  if(dmrs_arg[0] == 0) {
1364 1365
    mapping_type = typeA;
  }
1366
  else if (dmrs_arg[0] == 1) {
1367 1368 1369
    mapping_type = typeB;
  }
  /* Additional DMRS positions 0 ,1 and 2 */
1370
  if(dmrs_arg[1] >= 0 && dmrs_arg[1] <3 ) {
1371 1372
    add_pos = dmrs_arg[1];
  }
1373

1374
  if(scg != NULL) {
1375 1376
    NR_BWP_Downlink_t *bwp = scg->spCellConfig->spCellConfigDedicated->downlinkBWP_ToAddModList->list.array[0];
    *bwp->bwp_Dedicated->pdsch_Config->choice.setup->dmrs_DownlinkForPDSCH_MappingTypeA->choice.setup->dmrs_AdditionalPosition = add_pos;
1377
    for (int i=0;i<bwp->bwp_Common->pdsch_ConfigCommon->choice.setup->pdsch_TimeDomainAllocationList->list.count;i++) {
1378 1379 1380
      bwp->bwp_Common->pdsch_ConfigCommon->choice.setup->pdsch_TimeDomainAllocationList->list.array[i]->mappingType = mapping_type; 
    }
  }
1381 1382
  if(ue != NULL) {
    for (int i=0;i<MAX_NR_OF_DL_ALLOCATIONS;i++) {
1383 1384 1385 1386 1387 1388
      ue->PDSCH_Config.pdsch_TimeDomainResourceAllocation[i]->mappingType = mapping_type;
    }
    ue->dmrs_DownlinkConfig.pdsch_dmrs_AdditionalPosition = add_pos;
  }
  printf("[DLSIM] DMRS Config is modified with Mapping Type %d, Additional Positions %d \n", dmrs_arg[0], dmrs_arg[1] );
}