pbchsim.c 21.6 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 23 24 25 26 27
/*
 * 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 <string.h>
#include <math.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
28 29 30
#include "common/config/config_userapi.h"
#include "common/utils/LOG/log.h"
#include "common/ran_context.h" 
31 32 33 34
#include "PHY/types.h"
#include "PHY/defs_nr_common.h"
#include "PHY/defs_nr_UE.h"
#include "PHY/defs_gNB.h"
35
#include "PHY/NR_REFSIG/refsig_defs_ue.h"
36
#include "PHY/NR_REFSIG/nr_mod_table.h"
37 38
#include "PHY/MODULATION/modulation_eNB.h"
#include "PHY/MODULATION/modulation_UE.h"
39
#include "PHY/INIT/phy_init.h"
40 41
#include "PHY/NR_TRANSPORT/nr_transport.h"
#include "PHY/NR_UE_TRANSPORT/nr_transport_proto_ue.h"
42
#include "PHY/NR_UE_ESTIMATION/nr_estimation.h"
43
#include "PHY/phy_vars.h"
44
#include "SCHED_NR/sched_nr.h"
45 46 47 48
#include "openair1/SIMULATION/TOOLS/sim.h"
#include "openair1/SIMULATION/RF/rf.h"
#include "openair1/SIMULATION/NR_PHY/nr_unitary_defs.h"
#include "openair1/SIMULATION/NR_PHY/nr_dummy_functions.c"
49

50
//#define DEBUG_NR_PBCHSIM
51 52 53 54

PHY_VARS_gNB *gNB;
PHY_VARS_NR_UE *UE;
RAN_CONTEXT_t RC;
55 56
int32_t uplink_frequency_offset[MAX_NUM_CCs][4];

57
double cpuf;
58
uint8_t nfapi_mode = 0;
yilmazt's avatar
yilmazt committed
59
uint16_t NB_UE_INST = 1;
60

61
// needed for some functions
62
openair0_config_t openair0_cfg[MAX_CARDS];
63
uint64_t get_softmodem_optmask(void) {return 0;}
64

Sakthivel Velumani's avatar
Sakthivel Velumani committed
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
void nr_phy_config_request_sim_pbchsim(PHY_VARS_gNB *gNB,
                               int N_RB_DL,
                               int N_RB_UL,
                               int mu,
                               int Nid_cell,
                               uint64_t position_in_burst)
{
  NR_DL_FRAME_PARMS *fp                                   = &gNB->frame_parms;
  nfapi_nr_config_request_scf_t *gNB_config               = &gNB->gNB_config;
  //overwrite for new NR parameters

  uint64_t rev_burst=0;
  for (int i=0; i<64; i++)
    rev_burst |= (((position_in_burst>>(63-i))&0x01)<<i);

  gNB_config->cell_config.phy_cell_id.value             = Nid_cell;
  gNB_config->ssb_config.scs_common.value               = mu;
  gNB_config->ssb_table.ssb_subcarrier_offset.value     = 0;
  gNB_config->ssb_table.ssb_offset_point_a.value        = (N_RB_DL-20)>>1;
  gNB_config->ssb_table.ssb_mask_list[1].ssb_mask.value = (rev_burst)&(0xFFFFFFFF);
  gNB_config->ssb_table.ssb_mask_list[0].ssb_mask.value = (rev_burst>>32)&(0xFFFFFFFF);
  gNB_config->cell_config.frame_duplex_type.value       = TDD;
  gNB_config->ssb_table.ssb_period.value		= 1; //10ms
  gNB_config->carrier_config.dl_grid_size[mu].value     = N_RB_DL;
  gNB_config->carrier_config.ul_grid_size[mu].value     = N_RB_UL;
  gNB_config->carrier_config.num_tx_ant.value           = fp->nb_antennas_tx;
  gNB_config->carrier_config.num_rx_ant.value           = fp->nb_antennas_rx;

  gNB_config->tdd_table.tdd_period.value = 0;
  //gNB_config->subframe_config.dl_cyclic_prefix_type.value = (fp->Ncp == NORMAL) ? NFAPI_CP_NORMAL : NFAPI_CP_EXTENDED;

  gNB->mac_enabled   = 1;
  fp->dl_CarrierFreq = 3500000000;//from_nrarfcn(gNB_config->nfapi_config.rf_bands.rf_band[0],gNB_config->nfapi_config.nrarfcn.value);
  fp->ul_CarrierFreq = 3500000000;//fp->dl_CarrierFreq - (get_uldl_offset(gNB_config->nfapi_config.rf_bands.rf_band[0])*100000);
  if (mu>2) fp->nr_band = 257;
  else fp->nr_band = 78;
  fp->threequarter_fs= 0;

  gNB_config->carrier_config.dl_bandwidth.value = config_bandwidth(mu, N_RB_DL, fp->nr_band);

  nr_init_frame_parms(gNB_config, fp);
  gNB->configured    = 1;
  LOG_I(PHY,"gNB configured\n");
}
109 110 111
int main(int argc, char **argv)
{
  char c;
yilmazt's avatar
yilmazt committed
112
  int i,aa;//,l;
113
  double sigma2, sigma2_dB=10,SNR,snr0=-2.0,snr1=2.0;
Francesco Mani's avatar
Francesco Mani committed
114
  double cfo=0;
115
  uint8_t snr1set=0;
116 117
  int **txdata;
  double **s_re,**s_im,**r_re,**r_im;
118
  //double iqim = 0.0;
Francesco Mani's avatar
Francesco Mani committed
119
  double ip =0.0;
120
  //unsigned char pbch_pdu[6];
121 122 123
  //  int sync_pos, sync_pos_slot;
  //  FILE *rx_frame_file;
  FILE *output_fd = NULL;
124
  //uint8_t write_output_file=0;
125
  //int result;
yilmazt's avatar
yilmazt committed
126
  //int freq_offset;
127 128
  //  int subframe_offset;
  //  char fname[40], vname[40];
yilmazt's avatar
yilmazt committed
129
  int trial,n_trials=1,n_errors=0,n_errors_payload=0;
130 131
  uint8_t transmission_mode = 1,n_tx=1,n_rx=1;
  uint16_t Nid_cell=0;
132
  uint64_t SSB_positions=0x01;
133 134

  channel_desc_t *gNB2UE;
yilmazt's avatar
yilmazt committed
135

136 137
  //uint8_t extended_prefix_flag=0;
  //int8_t interf1=-21,interf2=-21;
138 139

  FILE *input_fd=NULL,*pbch_file_fd=NULL;
140

yilmazt's avatar
yilmazt committed
141 142 143 144 145
  //uint32_t nsymb,tx_lev,tx_lev1 = 0,tx_lev2 = 0;
  //char input_val_str[50],input_val_str2[50];
  //uint8_t frame_mod4,num_pdcch_symbols = 0;
  //double pbch_sinr;
  //int pbch_tx_ant;
146 147 148

  SCM_t channel_model=AWGN;//Rayleigh1_anticorr;

yilmazt's avatar
yilmazt committed
149

150
  int N_RB_DL=273,mu=1;
151

152
  //unsigned char frame_type = 0;
153 154
  unsigned char pbch_phase = 0;

155
  int frame=0;
156 157 158
  int frame_length_complex_samples;
  int frame_length_complex_samples_no_prefix;
  NR_DL_FRAME_PARMS *frame_parms;
159

Guy De Souza's avatar
Guy De Souza committed
160
  int ret, payload_ret=0;
161 162
  int run_initial_sync=0;

163 164
  int loglvl=OAILOG_WARNING;

165 166
  float target_error_rate = 0.01;

167 168
  cpuf = get_cpu_freq_GHz();

169
  if ( load_configmodule(argc,argv,CONFIG_ENABLECMDLINEONLY) == 0) {
yilmazt's avatar
yilmazt committed
170
    exit_fun("[NR_PBCHSIM] Error, configuration module init failed\n");
171 172
  }

173
  randominit(0);
174

Sakthivel Velumani's avatar
Sakthivel Velumani committed
175
  while ((c = getopt (argc, argv, "f:hA:pf:g:i:j:n:o:s:S:t:x:y:z:M:N:F:GR:dP:IL:m:")) != -1) {
176
    switch (c) {
177
    /*case 'f':
178 179 180 181 182 183 184 185
      write_output_file=1;
      output_fd = fopen(optarg,"w");

      if (output_fd==NULL) {
        printf("Error opening %s\n",optarg);
        exit(-1);
      }

186
      break;*/
187

188
    /*case 'd':
189
      frame_type = 1;
190
      break;*/
191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222

    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:
223
        printf("Unsupported channel model! Exiting.\n");
224 225 226 227 228
        exit(-1);
      }

      break;

229
    /*case 'i':
230 231 232 233 234
      interf1=atoi(optarg);
      break;

    case 'j':
      interf2=atoi(optarg);
235
      break;*/
236 237

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

Francesco Mani's avatar
Francesco Mani committed
241 242
    case 'o':
      cfo = atof(optarg);
243 244 245
#ifdef DEBUG_NR_PBCHSIM
      printf("Setting CFO to %f Hz\n",cfo);
#endif
Francesco Mani's avatar
Francesco Mani committed
246 247
      break;

248 249
    case 's':
      snr0 = atof(optarg);
250 251 252
#ifdef DEBUG_NR_PBCHSIM
      printf("Setting SNR0 to %f\n",snr0);
#endif
253 254 255 256 257
      break;

    case 'S':
      snr1 = atof(optarg);
      snr1set=1;
258 259 260
#ifdef DEBUG_NR_PBCHSIM
      printf("Setting SNR1 to %f\n",snr1);
#endif
261 262 263 264 265 266 267
      break;

      /*
      case 't':
      Td= atof(optarg);
      break;
      */
268
    /*case 'p':
269
      extended_prefix_flag=1;
270
      break;*/
271 272 273 274 275 276 277 278 279 280 281 282 283

      /*
      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);

284 285
      if ((transmission_mode!=1) && (transmission_mode!=2) && (transmission_mode!=6)) {
        printf("Unsupported transmission mode %d. Exiting.\n",transmission_mode);
286 287 288 289 290 291 292 293 294
        exit(-1);
      }

      break;

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

      if ((n_tx==0) || (n_tx>2)) {
295
    	printf("Unsupported number of TX antennas %d. Exiting.\n", n_tx);
296 297 298 299 300 301 302 303 304
        exit(-1);
      }

      break;

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

      if ((n_rx==0) || (n_rx>2)) {
305
    	printf("Unsupported number of RX antennas %d. Exiting.\n", n_rx);
306 307 308 309 310
        exit(-1);
      }

      break;

311 312 313 314
    case 'M':
      SSB_positions = atoi(optarg);
      break;

315 316 317 318 319 320 321 322 323 324 325 326
    case 'N':
      Nid_cell = atoi(optarg);
      break;

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

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

      if (input_fd==NULL) {
327
        printf("Problem with filename %s. Exiting.\n", optarg);
328 329 330 331 332 333 334 335 336 337 338 339
        exit(-1);
      }

      break;

    case 'P':
      pbch_phase = atoi(optarg);

      if (pbch_phase>3)
        printf("Illegal PBCH phase (0-3) got %d\n",pbch_phase);

      break;
340 341 342
      
    case 'I':
      run_initial_sync=1;
343
      target_error_rate=0.1;
344
      break;
345 346 347 348 349

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

Sakthivel Velumani's avatar
Sakthivel Velumani committed
350 351 352 353
    case 'm':
      mu = atoi(optarg);
      break;

354 355 356 357 358
    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");
359 360
      //printf("-p Use extended prefix mode\n");
      //printf("-d Use TDD\n");
361
      printf("-n Number of frames to simulate\n");
Sakthivel Velumani's avatar
Sakthivel Velumani committed
362
      printf("-m Numerology index\n");
363 364 365 366 367 368 369
      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");
      printf("-x Transmission mode (1,2,6 for the moment)\n");
      printf("-y Number of TX antennas used in eNB\n");
      printf("-z Number of RX antennas used in UE\n");
370 371
      //printf("-i Relative strength of first intefering eNB (in dB) - cell_id mod 3 = 1\n");
      //printf("-j Relative strength of second intefering eNB (in dB) - cell_id mod 3 = 2\n");
Francesco Mani's avatar
Francesco Mani committed
372
      printf("-o Carrier frequency offset in Hz\n");
373
      printf("-M Multiple SSB positions in burst\n");
374 375 376 377
      printf("-N Nid_cell\n");
      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");
378 379
      //printf("-C Generate Calibration information for Abstraction (effective SNR adjustment to remove Pe bias w.r.t. AWGN)\n");
      //printf("-f Output filename (.txt format) for Pe/SNR results\n");
380 381 382 383 384 385
      printf("-F Input filename (.txt format) for RX conformance testing\n");
      exit (-1);
      break;
    }
  }

386 387 388 389
  logInit();
  set_glog(loglvl);
  T_stdout = 1;

390 391 392
  if (snr1set==0)
    snr1 = snr0+10;

Raymond Knopp's avatar
Raymond Knopp committed
393
  printf("Initializing gNodeB for mu %d, N_RB_DL %d\n",mu,N_RB_DL);
394

395 396 397
  RC.gNB = (PHY_VARS_gNB**) malloc(sizeof(PHY_VARS_gNB *));
  RC.gNB[0] = malloc(sizeof(PHY_VARS_gNB));
  gNB = RC.gNB[0];
398
  frame_parms = &gNB->frame_parms; //to be initialized I suppose (maybe not necessary for PBCH)
399 400 401
  frame_parms->nb_antennas_tx = n_tx;
  frame_parms->nb_antennas_rx = n_rx;
  frame_parms->N_RB_DL = N_RB_DL;
402
  frame_parms->Nid_cell = Nid_cell;
Francesco Mani's avatar
Francesco Mani committed
403 404
  frame_parms->nushift = Nid_cell%4;
  frame_parms->ssb_type = nr_ssb_type_C;
405

Sakthivel Velumani's avatar
Sakthivel Velumani committed
406
  nr_phy_config_request_sim_pbchsim(gNB,N_RB_DL,N_RB_DL,mu,Nid_cell,SSB_positions);
407
  phy_init_nr_gNB(gNB,0,0);
408
  nr_set_ssb_first_subcarrier(&gNB->gNB_config,frame_parms);
409

410 411
  uint8_t n_hf = 0;
  int cyclic_prefix_type = NFAPI_CP_NORMAL;
412

Francesco Mani's avatar
Francesco Mani committed
413
  double fs,bw,scs,eps;
414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436
  
  switch (mu) {
    case 1:
	scs = 30000;
	if (N_RB_DL == 217) { 
	    fs = 122.88e6;
	    bw = 80e6;
	    
	}					       
	else if (N_RB_DL == 245) {
	    fs = 122.88e6;
	    bw = 90e6;
	}
	else if (N_RB_DL == 273) {
	    fs = 122.88e6;
	    bw = 100e6;
	}
	else if (N_RB_DL == 106) { 
	    fs = 61.44e6;
	    bw = 40e6;
	}
	else AssertFatal(1==0,"Unsupported numerology for mu %d, N_RB %d\n",mu, N_RB_DL);
	break;
Sakthivel Velumani's avatar
Sakthivel Velumani committed
437
  
Raymond Knopp's avatar
Raymond Knopp committed
438

Sakthivel Velumani's avatar
Sakthivel Velumani committed
439 440 441 442 443 444 445 446 447
    case 3:
      scs = 120000;
      if (N_RB_DL == 66) {
        fs = 122.88e6;
        bw = 100e6;
      }
      else AssertFatal(1==0,"Unsupported numerology for mu %d, N_RB %d\n",mu, N_RB_DL);
      break;
  }
Francesco Mani's avatar
Francesco Mani committed
448 449 450
  // cfo with respect to sub-carrier spacing
  eps = cfo/scs;

451 452
  // computation of integer and fractional FO to compare with estimation results
  int IFO;
Francesco Mani's avatar
Francesco Mani committed
453 454 455 456 457 458 459 460 461
  if(eps!=0.0){
	printf("Introducing a CFO of %lf relative to SCS of %d kHz\n",eps,(int)(scs/1000));
	if (eps>0)	
  	  IFO=(int)(eps+0.5);
	else
	  IFO=(int)(eps-0.5);
	printf("FFO = %lf; IFO = %d\n",eps-IFO,IFO);
  }

Raymond Knopp's avatar
Raymond Knopp committed
462 463 464 465 466 467 468 469 470 471
  gNB2UE = new_channel_desc_scm(n_tx,
                                n_rx,
                                channel_model,
 				fs, 
				bw, 
                                0,
                                0,
                                0);

  if (gNB2UE==NULL) {
472
	printf("Problem generating channel model. Exiting.\n");
Raymond Knopp's avatar
Raymond Knopp committed
473 474 475
    exit(-1);
  }

476
  frame_length_complex_samples = frame_parms->samples_per_subframe*NR_NUMBER_OF_SUBFRAMES_PER_FRAME;
477 478
  frame_length_complex_samples_no_prefix = frame_parms->samples_per_subframe_wCP;

479 480 481 482 483 484
  s_re = malloc(2*sizeof(double*));
  s_im = malloc(2*sizeof(double*));
  r_re = malloc(2*sizeof(double*));
  r_im = malloc(2*sizeof(double*));
  txdata = malloc(2*sizeof(int*));

485 486 487 488 489 490 491 492 493 494 495 496
  for (i=0; i<2; i++) {

    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));

    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));

Raymond Knopp's avatar
Raymond Knopp committed
497
    printf("Allocating %d samples for txdata\n",frame_length_complex_samples);
498 499 500 501
    txdata[i] = malloc(frame_length_complex_samples*sizeof(int));
    bzero(r_re[i],frame_length_complex_samples*sizeof(int));
  
  }
502 503 504 505 506

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

507 508 509 510

  //configure UE
  UE = malloc(sizeof(PHY_VARS_NR_UE));
  memcpy(&UE->frame_parms,frame_parms,sizeof(NR_DL_FRAME_PARMS));
511
  //phy_init_nr_top(UE); //called from init_nr_ue_signal
512 513 514
  if (run_initial_sync==1)  UE->is_synchronized = 0;
  else                      UE->is_synchronized = 1;
                      
Raymond Knopp's avatar
Raymond Knopp committed
515 516
  UE->perfect_ce = 0;

517 518 519
  if(eps!=0.0)
	UE->UE_fo_compensation = 1; // if a frequency offset is set then perform fo estimation and compensation

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

525
  nr_gold_pbch(UE);
526
  // generate signal
527
  if (input_fd==NULL) {
Raymond Knopp's avatar
Raymond Knopp committed
528
    gNB->pbch_configured = 1;
529
 
530
    gNB->ssb_pdu.ssb_pdu_rel15.bchPayload = 0;
531

532
    for (int slot=0;slot<frame_parms->slots_per_frame;slot++) {
533 534
    	for (aa=0; aa<gNB->frame_parms.nb_antennas_tx; aa++)
    		memset(gNB->common_vars.txdataF[aa],0,frame_parms->samples_per_slot_wCP*sizeof(int32_t));
535
      
536
    	nr_common_signal_procedures (gNB,frame,slot);
Francesco Mani's avatar
Francesco Mani committed
537

538
    	for (aa=0; aa<gNB->frame_parms.nb_antennas_tx; aa++) {
539
    		if (cyclic_prefix_type == 1) {
540
    			PHY_ofdm_mod(gNB->common_vars.txdataF[aa],
541
    			             &txdata[aa][frame_parms->get_samples_slot_timestamp(slot,frame_parms,0)],
542 543 544 545
				     frame_parms->ofdm_symbol_size,
				     12,
				     frame_parms->nb_prefix_samples,
				     CYCLIC_PREFIX);
546 547
    		} else {
    			nr_normal_prefix_mod(gNB->common_vars.txdataF[aa],
548
    			                     &txdata[aa][frame_parms->get_samples_slot_timestamp(slot,frame_parms,0)],
549 550
			                     14,
			                     frame_parms);
551 552
    		}
    	}
553
    }
554 555 556 557 558

    LOG_M("txsigF0.m","txsF0", gNB->common_vars.txdataF[0],frame_length_complex_samples_no_prefix,1,1);
    if (gNB->frame_parms.nb_antennas_tx>1)
      LOG_M("txsigF1.m","txsF1", gNB->common_vars.txdataF[1],frame_length_complex_samples_no_prefix,1,1);

559 560
  } else {
    printf("Reading %d samples from file to antenna buffer %d\n",frame_length_complex_samples,0);
Francesco Mani's avatar
Francesco Mani committed
561
    UE->UE_fo_compensation = 1; // perform fo compensation when samples from file are used
562 563 564 565 566
    if (fread(txdata[0],
	      sizeof(int32_t),
	      frame_length_complex_samples,
	      input_fd) != frame_length_complex_samples) {
      printf("error reading from file\n");
567
      //exit(-1);
568 569
    }
  }
570

571 572 573
  LOG_M("txsig0.m","txs0", txdata[0],frame_length_complex_samples,1,1);
  if (gNB->frame_parms.nb_antennas_tx>1)
    LOG_M("txsig1.m","txs1", txdata[1],frame_length_complex_samples,1,1);
574

575 576 577
  if (output_fd) 
    fwrite(txdata[0],sizeof(int32_t),frame_length_complex_samples,output_fd);

578 579 580
  /*int txlev = signal_energy(&txdata[0][5*frame_parms->ofdm_symbol_size + 4*frame_parms->nb_prefix_samples + frame_parms->nb_prefix_samples0],
		  	  	  	  	    frame_parms->ofdm_symbol_size + frame_parms->nb_prefix_samples);
  printf("txlev %d (%f)\n",txlev,10*log10(txlev));*/
581

Francesco Mani's avatar
Francesco Mani committed
582

583 584
  for (i=0; i<frame_length_complex_samples; i++) {
    for (aa=0; aa<frame_parms->nb_antennas_tx; aa++) {
585 586
      r_re[aa][i] = ((double)(((short *)txdata[aa]))[(i<<1)]);
      r_im[aa][i] = ((double)(((short *)txdata[aa]))[(i<<1)+1]);
587
    }
Raymond Knopp's avatar
Raymond Knopp committed
588
  }
589 590 591 592
  
  for (SNR=snr0; SNR<snr1; SNR+=.2) {

    n_errors = 0;
593
    n_errors_payload = 0;
594 595

    for (trial=0; trial<n_trials; trial++) {
596 597
      // multipath channel
      //multipath_channel(gNB2UE,s_re,s_im,r_re,r_im,frame_length_complex_samples,0);
598 599
      
      //AWGN
600
      sigma2_dB = 20*log10((double)AMP/4)-SNR;
601
      sigma2 = pow(10,sigma2_dB/10);
602
      //printf("sigma2 %f (%f dB), tx_lev %f (%f dB)\n",sigma2,sigma2_dB,txlev,10*log10((double)txlev));
Raymond Knopp's avatar
Raymond Knopp committed
603

Francesco Mani's avatar
Francesco Mani committed
604 605 606 607 608 609 610 611
      if(eps!=0.0)
        rf_rx(r_re,  // real part of txdata
           r_im,  // imag part of txdata
           NULL,  // interference real part
           NULL, // interference imag part
           0,  // interference power
           frame_parms->nb_antennas_rx,  // number of rx antennas
           frame_length_complex_samples,  // number of samples in frame
612
           1.0e9/fs,   //sampling time (ns)
Francesco Mani's avatar
Francesco Mani committed
613 614 615 616 617 618 619 620 621 622 623 624
           cfo,	// frequency offset in Hz
           0.0, // drift (not implemented)
           0.0, // noise figure (not implemented)
           0.0, // rx gain in dB ?
           200, // 3rd order non-linearity in dB ?
           &ip, // initial phase
           30.0e3,  // phase noise cutoff in kHz
           -500.0, // phase noise amplitude in dBc
           0.0,  // IQ imbalance (dB),
	   0.0); // IQ phase imbalance (rad)

   
625 626 627
      for (i=0; i<frame_length_complex_samples; i++) {
	for (aa=0; aa<frame_parms->nb_antennas_rx; aa++) {
	  
628 629
	  ((short*) UE->common_vars.rxdata[aa])[2*i]   = (short) ((r_re[aa][i] + sqrt(sigma2/2)*gaussdouble(0.0,1.0)));
	  ((short*) UE->common_vars.rxdata[aa])[2*i+1] = (short) ((r_im[aa][i] + sqrt(sigma2/2)*gaussdouble(0.0,1.0)));
630 631
	}
      }
632 633

      if (n_trials==1) {
634
	LOG_M("rxsig0.m","rxs0", UE->common_vars.rxdata[0],frame_parms->samples_per_frame,1,1);
635
	if (gNB->frame_parms.nb_antennas_tx>1)
636
	  LOG_M("rxsig1.m","rxs1", UE->common_vars.rxdata[1],frame_parms->samples_per_frame,1,1);
637
      }
638
      if (UE->is_synchronized == 0) {
laurent's avatar
fixes  
laurent committed
639
	UE_nr_rxtx_proc_t proc={0};
640
	ret = nr_initial_sync(&proc, UE, normal_txrx,1);
641 642 643 644 645
	printf("nr_initial_sync1 returns %d\n",ret);
	if (ret<0) n_errors++;
      }
      else {
	UE->rx_offset=0;
646 647
	uint8_t ssb_index = 0;
        while (!((SSB_positions >> ssb_index) & 0x01)) ssb_index++;  // to select the first transmitted ssb
648 649
        frame_parms->ssb_index = ssb_index;
	UE->symbol_offset = nr_get_ssb_start_symbol(frame_parms);
650 651

        int ssb_slot = (ssb_index>>1)+(n_hf*frame_parms->slots_per_frame);
652
	for (int i=UE->symbol_offset+1; i<UE->symbol_offset+4; i++) {
653
	  nr_slot_fep(UE,
654 655
	  	      i%frame_parms->symbols_per_slot,
		      ssb_slot,
656
		      0,
Florian Kaltenberger's avatar
Florian Kaltenberger committed
657
		      0);
658

659
          nr_pbch_channel_estimation(UE,0,ssb_slot,i%frame_parms->symbols_per_slot,i-(UE->symbol_offset+1),ssb_index%8,n_hf);
660

661
        }
laurent's avatar
fixes  
laurent committed
662
	UE_nr_rxtx_proc_t proc={0};
Francesco Mani's avatar
Francesco Mani committed
663

664
        ret = nr_rx_pbch(UE,
laurent's avatar
fixes  
laurent committed
665
	                 &proc,
666 667 668 669 670 671
		         UE->pbch_vars[0],
		         frame_parms,
		         0,
		         ssb_index%8,
                         SISO,
                         UE->high_speed_flag);
Florian Kaltenberger's avatar
WIP  
Florian Kaltenberger committed
672

673 674 675
	if (ret==0) {
	  //UE->rx_ind.rx_indication_body->mib_pdu.ssb_index;  //not yet detected automatically
	  //UE->rx_ind.rx_indication_body->mib_pdu.ssb_length; //Lmax, not yet detected automatically
676 677 678
	  uint8_t gNB_xtra_byte=0;
	  for (int i=0; i<8; i++)
	    gNB_xtra_byte |= ((gNB->pbch.pbch_a>>(31-i))&1)<<(7-i);
Francesco Mani's avatar
Francesco Mani committed
679
 
Florian Kaltenberger's avatar
Florian Kaltenberger committed
680
	  payload_ret = (UE->pbch_vars[0]->xtra_byte == gNB_xtra_byte);
Guy De Souza's avatar
Guy De Souza committed
681
	  for (i=0;i<3;i++){
682
	    payload_ret += (UE->pbch_vars[0]->decoded_output[i] == (gNB->ssb_pdu.ssb_pdu_rel15.bchPayload>>(8*i)));
683
	  } 
Guy De Souza's avatar
Guy De Souza committed
684
	  //printf("xtra byte gNB: 0x%02x UE: 0x%02x\n",gNB_xtra_byte, UE->rx_ind.rx_indication_body->mib_pdu.additional_bits);
685
	  //printf("ret %d\n", payload_ret);
686 687
	  if (payload_ret!=4) 
	    n_errors_payload++;
688 689
	}

690
	if (ret!=0) n_errors++;
691
      }
692
    } //noise trials
693
    printf("SNR %f: trials %d, n_errors_crc = %d, n_errors_payload %d\n", SNR,n_trials,n_errors,n_errors_payload);
694

695
    if (((float)n_errors/(float)n_trials <= target_error_rate) && (n_errors_payload==0)) {
696 697 698 699
      printf("PBCH test OK\n");
      break;
    }
      
700 701 702
    if (n_trials==1)
      break;

703 704 705 706 707 708 709
  } // NSR

  for (i=0; i<2; i++) {
    free(s_re[i]);
    free(s_im[i]);
    free(r_re[i]);
    free(r_im[i]);
710
    free(txdata[i]);
711 712 713 714 715 716
  }

  free(s_re);
  free(s_im);
  free(r_re);
  free(r_im);
717
  free(txdata);
718

719
  if (output_fd)
720 721
    fclose(output_fd);

722 723 724
  if (input_fd)
    fclose(input_fd);

725 726 727
  return(n_errors);

}