nr_init_ue.c 27.3 KB
Newer Older
Hongzhi Wang's avatar
Hongzhi Wang committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
 * 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 "phy_init.h"
#include "SCHED_UE/sched_UE.h"
#include "PHY/phy_extern_nr_ue.h"
25
//#include "SIMULATION/TOOLS/sim.h"
26
/*#include "RadioResourceConfigCommonSIB.h"
Hongzhi Wang's avatar
Hongzhi Wang committed
27 28
#include "RadioResourceConfigDedicated.h"
#include "TDD-Config.h"
29 30
#include "MBSFN-SubframeConfigList.h"*/
#include "openair1/PHY/defs_RU.h"
31
#include "openair1/PHY/impl_defs_nr.h"
32
#include "common/utils/LOG/vcd_signal_dumper.h"
Hongzhi Wang's avatar
Hongzhi Wang committed
33 34 35 36
#include "assertions.h"
#include <math.h>
#include "PHY/NR_UE_TRANSPORT/nr_transport_ue.h"
#include "PHY/NR_UE_TRANSPORT/nr_transport_proto_ue.h"
Hongzhi Wang's avatar
Hongzhi Wang committed
37
//#include "PHY/LTE_REFSIG/lte_refsig.h"
Hongzhi Wang's avatar
Hongzhi Wang committed
38
#include "PHY/CODING/nrPolar_tools/nr_polar_pbch_defs.h"
hongzhi wang's avatar
hongzhi wang committed
39 40
#include "PHY/INIT/phy_init.h"
#include "PHY/NR_REFSIG/pss_nr.h"
41 42
#include "PHY/NR_REFSIG/ul_ref_seq_nr.h"
#include "PHY/NR_REFSIG/refsig_defs_ue.h"
Sakthivel Velumani's avatar
Sakthivel Velumani committed
43
#include "PHY/NR_REFSIG/nr_refsig.h"
44
#include <openair1/PHY/MODULATION/nr_modulation.h>
Hongzhi Wang's avatar
Hongzhi Wang committed
45

46
#if 0
47
void phy_config_harq_ue(module_id_t Mod_id,
48
                        int CC_id,
49
                        uint8_t gNB_id,
50
                        uint16_t max_harq_tx) {
51
  int num_of_threads,num_of_code_words;
hongzhi wang's avatar
hongzhi wang committed
52
  PHY_VARS_NR_UE *phy_vars_ue = PHY_vars_UE_g[Mod_id][CC_id];
53

54 55
  for (num_of_threads=0; num_of_threads<RX_NB_TH_MAX; num_of_threads++)
    for (num_of_code_words=0; num_of_code_words<NR_MAX_NB_CODEWORDS; num_of_code_words++)
56
      phy_vars_ue->ulsch[num_of_threads][gNB_id][num_of_code_words]->Mlimit = max_harq_tx;
Hongzhi Wang's avatar
Hongzhi Wang committed
57
}
58
#endif
Hongzhi Wang's avatar
Hongzhi Wang committed
59 60 61 62 63 64 65 66

extern uint16_t beta_cqi[16];

/*! \brief Helper function to allocate memory for DLSCH data structures.
 * \param[out] pdsch Pointer to the LTE_UE_PDSCH structure to initialize.
 * \param[in] frame_parms LTE_DL_FRAME_PARMS structure.
 * \note This function is optimistic in that it expects malloc() to succeed.
 */
67 68
void phy_init_nr_ue__PDSCH(NR_UE_PDSCH *const pdsch,
                           const NR_DL_FRAME_PARMS *const fp) {
Hongzhi Wang's avatar
Hongzhi Wang committed
69
  AssertFatal( pdsch, "pdsch==0" );
70 71 72 73
  pdsch->pmi_ext = (uint8_t *)malloc16_clear( fp->N_RB_DL );
  pdsch->llr[0] = (int16_t *)malloc16_clear( (8*(3*8*6144))*sizeof(int16_t) );
  pdsch->layer_llr[0] = (int16_t *)malloc16_clear( (8*(3*8*6144))*sizeof(int16_t) );
  pdsch->llr128 = (int16_t **)malloc16_clear( sizeof(int16_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
74 75
  // FIXME! no further allocation for (int16_t*)pdsch->llr128 !!! expect SIGSEGV
  // FK, 11-3-2015: this is only as a temporary pointer, no memory is stored there
76 77 78
  pdsch->rxdataF_ext            = (int32_t **)malloc16_clear( fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->rxdataF_uespec_pilots  = (int32_t **)malloc16_clear( fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->rxdataF_comp0          = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
79
  pdsch->rho                    = (int32_t ***)malloc16_clear( fp->nb_antennas_rx*sizeof(int32_t **) );
80 81 82 83
  pdsch->dl_ch_estimates        = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->dl_ch_estimates_ext    = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->dl_bf_ch_estimates     = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->dl_bf_ch_estimates_ext = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
84 85
  //pdsch->dl_ch_rho_ext          = (int32_t**)malloc16_clear( 8*sizeof(int32_t*) );
  //pdsch->dl_ch_rho2_ext         = (int32_t**)malloc16_clear( 8*sizeof(int32_t*) );
86 87 88 89 90 91
  pdsch->dl_ch_mag0             = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->dl_ch_magb0            = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->dl_ch_magr0            = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->ptrs_phase_per_slot    = (int32_t **)malloc16_clear( fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->ptrs_re_per_slot       = (int32_t **)malloc16_clear( fp->nb_antennas_rx*sizeof(int32_t *) );
  pdsch->dl_ch_ptrs_estimates_ext = (int32_t **)malloc16_clear( fp->nb_antennas_rx*sizeof(int32_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
92
  // the allocated memory size is fixed:
93
  AssertFatal( fp->nb_antennas_rx <= 4, "nb_antennas_rx > 4" );//Extend the max number of UE Rx antennas to 4
Hongzhi Wang's avatar
Hongzhi Wang committed
94

95
  const size_t num = 7*2*fp->N_RB_DL*12;
Hongzhi Wang's avatar
Hongzhi Wang committed
96
  for (int i=0; i<fp->nb_antennas_rx; i++) {
97 98 99 100 101 102
    pdsch->rxdataF_ext[i]              = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
    pdsch->rxdataF_uespec_pilots[i]    = (int32_t *)malloc16_clear( sizeof(int32_t) * fp->N_RB_DL*12);
    pdsch->ptrs_phase_per_slot[i]      = (int32_t *)malloc16_clear( sizeof(int32_t) * 14 );
    pdsch->ptrs_re_per_slot[i]         = (int32_t *)malloc16_clear( sizeof(int32_t) * 14);
    pdsch->dl_ch_ptrs_estimates_ext[i] = (int32_t *)malloc16_clear( sizeof(int32_t) * num);
    pdsch->rho[i]                      = (int32_t **)malloc16_clear( NR_MAX_NB_LAYERS*NR_MAX_NB_LAYERS*sizeof(int32_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
103

104
    for (int j=0; j<NR_MAX_NB_LAYERS; j++) {
105
      const int idx = (j*fp->nb_antennas_rx)+i;
106
      for (int k=0; k<NR_MAX_NB_LAYERS; k++) {
107
        pdsch->rho[i][j*NR_MAX_NB_LAYERS+k] = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
108
      }
109 110 111 112 113
      pdsch->rxdataF_comp0[idx]           = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
      pdsch->dl_ch_estimates[idx]         = (int32_t *)malloc16_clear( sizeof(int32_t) * fp->ofdm_symbol_size*7*2);
      pdsch->dl_ch_estimates_ext[idx]     = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
      pdsch->dl_bf_ch_estimates[idx]      = (int32_t *)malloc16_clear( sizeof(int32_t) * fp->ofdm_symbol_size*7*2);
      pdsch->dl_bf_ch_estimates_ext[idx]  = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
Hongzhi Wang's avatar
Hongzhi Wang committed
114 115
      //pdsch->dl_ch_rho_ext[idx]           = (int32_t*)malloc16_clear( sizeof(int32_t) * num );
      //pdsch->dl_ch_rho2_ext[idx]          = (int32_t*)malloc16_clear( sizeof(int32_t) * num );
116 117
      pdsch->dl_ch_mag0[idx]              = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
      pdsch->dl_ch_magb0[idx]             = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
118
      pdsch->dl_ch_magr0[idx]             = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
Hongzhi Wang's avatar
Hongzhi Wang committed
119 120 121 122
    }
  }
}

123 124
void phy_init_nr_ue_PUSCH(NR_UE_PUSCH *const pusch,
                          const NR_DL_FRAME_PARMS *const fp) {
125 126
  AssertFatal( pusch, "pusch==0" );

127
  for (int i=0; i<NR_MAX_NB_LAYERS; i++) {
128
    pusch->txdataF_layers[i] = (int32_t *)malloc16_clear(NR_MAX_PUSCH_ENCODED_LENGTH*sizeof(int32_t));
129
  }
130 131
}

Hongzhi Wang's avatar
Hongzhi Wang committed
132
int init_nr_ue_signal(PHY_VARS_NR_UE *ue,
133
                      int nb_connected_gNB,
134
                      uint8_t abstraction_flag) {
Hongzhi Wang's avatar
Hongzhi Wang committed
135
  // create shortcuts
136 137 138 139
  NR_DL_FRAME_PARMS *const fp            = &ue->frame_parms;
  NR_UE_COMMON *const common_vars        = &ue->common_vars;
  NR_UE_PBCH  **const pbch_vars          = ue->pbch_vars;
  NR_UE_PRACH **const prach_vars         = ue->prach_vars;
140
  int i,j,k,l,slot,symb;
141
  int gNB_id;
Hongzhi Wang's avatar
Hongzhi Wang committed
142
  int th_id;
143
  uint16_t N_n_scid[2] = {0,1}; // [HOTFIX] This is a temporary implementation of scramblingID0 and scramblingID1 which are given by DMRS-UplinkConfig
144
  int n_scid;
Hongzhi Wang's avatar
Hongzhi Wang committed
145
  abstraction_flag = 0;
cig's avatar
cig committed
146
  LOG_I(PHY, "Initializing UE vars (abstraction %u) for gNB TXant %u, UE RXant %u\n", abstraction_flag, fp->nb_antennas_tx, fp->nb_antennas_rx);
147
  //LOG_D(PHY,"[MSC_NEW][FRAME 00000][PHY_UE][MOD %02u][]\n", ue->Mod_id+NB_gNB_INST);
hongzhi wang's avatar
hongzhi wang committed
148
  phy_init_nr_top(ue);
Hongzhi Wang's avatar
Hongzhi Wang committed
149
  // many memory allocation sizes are hard coded
150 151
  AssertFatal( fp->nb_antennas_rx <= 4, "hard coded allocation for ue_common_vars->dl_ch_estimates[gNB_id]" );
  AssertFatal( nb_connected_gNB <= NUMBER_OF_CONNECTED_gNB_MAX, "n_connected_gNB is too large" );
Hongzhi Wang's avatar
Hongzhi Wang committed
152 153 154 155 156 157 158 159
  // init phy_vars_ue

  for (i=0; i<4; i++) {
    ue->rx_gain_max[i] = 135;
    ue->rx_gain_med[i] = 128;
    ue->rx_gain_byp[i] = 120;
  }

160
  ue->n_connected_gNB = nb_connected_gNB;
Hongzhi Wang's avatar
Hongzhi Wang committed
161

162 163 164 165 166
  for(gNB_id = 0; gNB_id < ue->n_connected_gNB; gNB_id++) {
    ue->total_TBS[gNB_id] = 0;
    ue->total_TBS_last[gNB_id] = 0;
    ue->bitrate[gNB_id] = 0;
    ue->total_received_bits[gNB_id] = 0;
167

168 169 170
    ue->ul_time_alignment[gNB_id].apply_ta = 0;
    ue->ul_time_alignment[gNB_id].ta_frame = -1;
    ue->ul_time_alignment[gNB_id].ta_slot  = -1;
Hongzhi Wang's avatar
Hongzhi Wang committed
171
  }
Sakthivel Velumani's avatar
Sakthivel Velumani committed
172 173
  // init NR modulation lookup tables
  nr_generate_modulation_table();
Hongzhi Wang's avatar
Hongzhi Wang committed
174

175 176 177
  /////////////////////////PUSCH init/////////////////////////
  ///////////
  for (th_id = 0; th_id < RX_NB_TH_MAX; th_id++) {
178 179 180
    for (gNB_id = 0; gNB_id < ue->n_connected_gNB; gNB_id++) {
      ue->pusch_vars[th_id][gNB_id] = (NR_UE_PUSCH *)malloc16(sizeof(NR_UE_PUSCH));
      phy_init_nr_ue_PUSCH( ue->pusch_vars[th_id][gNB_id], fp );
181 182 183
    }
  }

184 185 186 187 188 189 190 191 192 193
  /////////////////////////PUCCH init/////////////////////////
  ///////////
  for (th_id = 0; th_id < RX_NB_TH_MAX; th_id++) {
    for (gNB_id = 0; gNB_id < ue->n_connected_gNB; gNB_id++) {
      ue->pucch_vars[th_id][gNB_id] = (NR_UE_PUCCH *)malloc16(sizeof(NR_UE_PUCCH));
      for (i=0; i<2; i++)
        ue->pucch_vars[th_id][gNB_id]->active[i] = false;
    }
  }

194 195
  ///////////
  ////////////////////////////////////////////////////////////////////////////////////////////
196

197 198
  /////////////////////////PUSCH DMRS init/////////////////////////
  ///////////
199 200 201 202 203 204

  // ceil(((NB_RB*6(k)*2(QPSK)/32) // 3 RE *2(QPSK)
  int pusch_dmrs_init_length =  ((fp->N_RB_UL*12)>>5)+1;

  ue->nr_gold_pusch_dmrs = (uint32_t ***)malloc16(fp->slots_per_frame*sizeof(uint32_t **));
  uint32_t ***pusch_dmrs = ue->nr_gold_pusch_dmrs;
205
  n_scid = 0; // This quantity is indicated by higher layer parameter dmrs-SeqInitialization
206

207
  for (slot=0; slot<fp->slots_per_frame; slot++) {
208
    pusch_dmrs[slot] = (uint32_t **)malloc16(fp->symbols_per_slot*sizeof(uint32_t *));
209
    AssertFatal(pusch_dmrs[slot]!=NULL, "init_nr_ue_signal: pusch_dmrs for slot %d - malloc failed\n", slot);
210 211

    for (symb=0; symb<fp->symbols_per_slot; symb++) {
212
      pusch_dmrs[slot][symb] = (uint32_t *)malloc16(pusch_dmrs_init_length*sizeof(uint32_t));
213
      AssertFatal(pusch_dmrs[slot][symb]!=NULL, "init_nr_ue_signal: pusch_dmrs for slot %d symbol %d - malloc failed\n", slot, symb);
214

215 216 217 218
    }
  }

  nr_init_pusch_dmrs(ue, N_n_scid, n_scid);
219 220
  ///////////
  ////////////////////////////////////////////////////////////////////////////////////////////
221

222 223 224 225
  /////////////////////////PUSCH PTRS init/////////////////////////
  ///////////

  //------------- config PTRS parameters--------------//
226 227 228 229 230 231
  // ptrs_Uplink_Config->timeDensity.ptrs_mcs1 = 2; // setting MCS values to 0 indicate abscence of time_density field in the configuration
  // ptrs_Uplink_Config->timeDensity.ptrs_mcs2 = 4;
  // ptrs_Uplink_Config->timeDensity.ptrs_mcs3 = 10;
  // ptrs_Uplink_Config->frequencyDensity.n_rb0 = 25;     // setting N_RB values to 0 indicate abscence of frequency_density field in the configuration
  // ptrs_Uplink_Config->frequencyDensity.n_rb1 = 75;
  // ptrs_Uplink_Config->resourceElementOffset = 0;
232 233 234 235 236
  //-------------------------------------------------//

  ///////////
  ////////////////////////////////////////////////////////////////////////////////////////////

237
  for (i=0; i<10; i++)
Hongzhi Wang's avatar
Hongzhi Wang committed
238 239 240 241
    ue->tx_power_dBm[i]=-127;

  if (abstraction_flag == 0) {
    // init TX buffers
242 243
    common_vars->txdata  = (int32_t **)malloc16( fp->nb_antennas_tx*sizeof(int32_t *) );
    common_vars->txdataF = (int32_t **)malloc16( fp->nb_antennas_tx*sizeof(int32_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
244 245

    for (i=0; i<fp->nb_antennas_tx; i++) {
246
      common_vars->txdata[i]  = (int32_t *)malloc16_clear( fp->samples_per_subframe*10*sizeof(int32_t) );
247
      common_vars->txdataF[i] = (int32_t *)malloc16_clear( fp->samples_per_slot_wCP*sizeof(int32_t) );
Hongzhi Wang's avatar
Hongzhi Wang committed
248 249 250
    }

    // init RX buffers
251 252
    common_vars->rxdata   = (int32_t **)malloc16( fp->nb_antennas_rx*sizeof(int32_t *) );

Hongzhi Wang's avatar
Hongzhi Wang committed
253
    for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
254
      common_vars->common_vars_rx_data_per_thread[th_id].rxdataF  = (int32_t **)malloc16( fp->nb_antennas_rx*sizeof(int32_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
255 256 257
    }

    for (i=0; i<fp->nb_antennas_rx; i++) {
258 259
      common_vars->rxdata[i] = (int32_t *) malloc16_clear( (2*(fp->samples_per_frame)+2048)*sizeof(int32_t) );

Hongzhi Wang's avatar
Hongzhi Wang committed
260
      for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
261
        common_vars->common_vars_rx_data_per_thread[th_id].rxdataF[i] = (int32_t *)malloc16_clear( sizeof(int32_t)*(fp->samples_per_slot_wCP) );
Hongzhi Wang's avatar
Hongzhi Wang committed
262 263 264 265
      }
    }
  }

266 267
  // ceil(((NB_RB<<1)*3)/32) // 3 RE *2(QPSK)
  int pdcch_dmrs_init_length =  (((fp->N_RB_DL<<1)*3)>>5)+1;
268
  //PDCCH DMRS init (gNB offset = 0)
269 270 271 272 273 274 275 276 277
  ue->nr_gold_pdcch[0] = (uint32_t ***)malloc16(fp->slots_per_frame*sizeof(uint32_t **));
  uint32_t ***pdcch_dmrs = ue->nr_gold_pdcch[0];
  AssertFatal(pdcch_dmrs!=NULL, "NR init: pdcch_dmrs malloc failed\n");

  for (int slot=0; slot<fp->slots_per_frame; slot++) {
    pdcch_dmrs[slot] = (uint32_t **)malloc16(fp->symbols_per_slot*sizeof(uint32_t *));
    AssertFatal(pdcch_dmrs[slot]!=NULL, "NR init: pdcch_dmrs for slot %d - malloc failed\n", slot);

    for (int symb=0; symb<fp->symbols_per_slot; symb++) {
278
      pdcch_dmrs[slot][symb] = (uint32_t *)malloc16(pdcch_dmrs_init_length*sizeof(uint32_t));
279 280 281 282
      AssertFatal(pdcch_dmrs[slot][symb]!=NULL, "NR init: pdcch_dmrs for slot %d symbol %d - malloc failed\n", slot, symb);
    }
  }

283 284 285
  ue->scramblingID_pdcch = fp->Nid_cell;
  nr_gold_pdcch(ue,fp->Nid_cell);

286 287 288
  // ceil(((NB_RB*6(k)*2(QPSK)/32) // 3 RE *2(QPSK)
  int pdsch_dmrs_init_length =  ((fp->N_RB_DL*12)>>5)+1;

289 290 291 292 293 294 295 296 297 298 299 300 301
  //PDSCH DMRS init (eNB offset = 0)
  ue->nr_gold_pdsch[0] = (uint32_t ****)malloc16(fp->slots_per_frame*sizeof(uint32_t ***));
  uint32_t ****pdsch_dmrs = ue->nr_gold_pdsch[0];

  for (int slot=0; slot<fp->slots_per_frame; slot++) {
    pdsch_dmrs[slot] = (uint32_t ***)malloc16(fp->symbols_per_slot*sizeof(uint32_t **));
    AssertFatal(pdsch_dmrs[slot]!=NULL, "NR init: pdsch_dmrs for slot %d - malloc failed\n", slot);

    for (int symb=0; symb<fp->symbols_per_slot; symb++) {
      pdsch_dmrs[slot][symb] = (uint32_t **)malloc16(NR_MAX_NB_CODEWORDS*sizeof(uint32_t *));
      AssertFatal(pdsch_dmrs[slot][symb]!=NULL, "NR init: pdsch_dmrs for slot %d symbol %d - malloc failed\n", slot, symb);

      for (int q=0; q<NR_MAX_NB_CODEWORDS; q++) {
302
        pdsch_dmrs[slot][symb][q] = (uint32_t *)malloc16(pdsch_dmrs_init_length*sizeof(uint32_t));
303 304 305 306 307
        AssertFatal(pdsch_dmrs[slot][symb][q]!=NULL, "NR init: pdsch_dmrs for slot %d symbol %d codeword %d - malloc failed\n", slot, symb, q);
      }
    }
  }

308 309 310 311 312 313
  // initializing the scrambling IDs for PDSCH DMRS
  for (int i=0; i<2; i++)
    ue->scramblingID[i]=fp->Nid_cell;

  nr_gold_pdsch(ue,ue->scramblingID);

Hongzhi Wang's avatar
Hongzhi Wang committed
314
  // DLSCH
315
  for (gNB_id = 0; gNB_id < ue->n_connected_gNB; gNB_id++) {
Hongzhi Wang's avatar
Hongzhi Wang committed
316
    for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
317
      ue->pdsch_vars[th_id][gNB_id] = (NR_UE_PDSCH *)malloc16_clear(sizeof(NR_UE_PDSCH));
Hongzhi Wang's avatar
Hongzhi Wang committed
318 319 320
    }

    for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
321
      ue->pdcch_vars[th_id][gNB_id] = (NR_UE_PDCCH *)malloc16_clear(sizeof(NR_UE_PDCCH));
Hongzhi Wang's avatar
Hongzhi Wang committed
322 323
    }

324 325
    prach_vars[gNB_id] = (NR_UE_PRACH *)malloc16_clear(sizeof(NR_UE_PRACH));
    pbch_vars[gNB_id] = (NR_UE_PBCH *)malloc16_clear(sizeof(NR_UE_PBCH));
Hongzhi Wang's avatar
Hongzhi Wang committed
326 327 328

    if (abstraction_flag == 0) {
      for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
329
        phy_init_nr_ue__PDSCH( ue->pdsch_vars[th_id][gNB_id], fp );
Hongzhi Wang's avatar
Hongzhi Wang committed
330 331 332
      }

      for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
333 334 335 336 337
        ue->pdsch_vars[th_id][gNB_id]->llr_shifts          = (uint8_t *)malloc16_clear(7*2*fp->N_RB_DL*12);
        ue->pdsch_vars[th_id][gNB_id]->llr_shifts_p        = ue->pdsch_vars[0][gNB_id]->llr_shifts;
        ue->pdsch_vars[th_id][gNB_id]->llr[1]              = (int16_t *)malloc16_clear( (8*(3*8*8448))*sizeof(int16_t) );
        ue->pdsch_vars[th_id][gNB_id]->layer_llr[1]        = (int16_t *)malloc16_clear( (8*(3*8*8448))*sizeof(int16_t) );
        ue->pdsch_vars[th_id][gNB_id]->llr128_2ndstream    = (int16_t **)malloc16_clear( sizeof(int16_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
338 339 340 341
      }


      for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
342
        ue->pdsch_vars[th_id][gNB_id]->dl_ch_rho2_ext      = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
343 344 345 346
      }

      for (i=0; i<fp->nb_antennas_rx; i++)
        for (j=0; j<4; j++) {
347
          const int idx = (j*fp->nb_antennas_rx)+i;
Hongzhi Wang's avatar
Hongzhi Wang committed
348
          const size_t num = 7*2*fp->N_RB_DL*12+4;
349

Hongzhi Wang's avatar
Hongzhi Wang committed
350
          for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
351
            ue->pdsch_vars[th_id][gNB_id]->dl_ch_rho2_ext[idx] = (int32_t *)malloc16_clear( sizeof(int32_t) * num );
Hongzhi Wang's avatar
Hongzhi Wang committed
352 353 354 355
          }
        }

      //const size_t num = 7*2*fp->N_RB_DL*12+4;
356 357
      for (k=0; k<8; k++) { //harq_pid
        for (l=0; l<8; l++) { //round
Hongzhi Wang's avatar
Hongzhi Wang committed
358
          for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
359 360 361 362
            ue->pdsch_vars[th_id][gNB_id]->rxdataF_comp1[k][l] = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
            ue->pdsch_vars[th_id][gNB_id]->dl_ch_rho_ext[k][l] = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
            ue->pdsch_vars[th_id][gNB_id]->dl_ch_mag1[k][l]    = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
            ue->pdsch_vars[th_id][gNB_id]->dl_ch_magb1[k][l]   = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
Hongzhi Wang's avatar
Hongzhi Wang committed
363 364 365 366
          }

          for (int i=0; i<fp->nb_antennas_rx; i++)
            for (int j=0; j<4; j++) { //frame_parms->nb_antennas_tx; j++)
367
              const int idx = (j*fp->nb_antennas_rx)+i;
368

Hongzhi Wang's avatar
Hongzhi Wang committed
369
              for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
370 371 372 373
                ue->pdsch_vars[th_id][gNB_id]->dl_ch_rho_ext[k][l][idx] = (int32_t *)malloc16_clear(7*2*sizeof(int32_t)*(fp->N_RB_DL*12));
                ue->pdsch_vars[th_id][gNB_id]->rxdataF_comp1[k][l][idx] = (int32_t *)malloc16_clear(7*2*sizeof(int32_t)*(fp->N_RB_DL*12));
                ue->pdsch_vars[th_id][gNB_id]->dl_ch_mag1[k][l][idx]    = (int32_t *)malloc16_clear(7*2*sizeof(int32_t)*(fp->N_RB_DL*12));
                ue->pdsch_vars[th_id][gNB_id]->dl_ch_magb1[k][l][idx]   = (int32_t *)malloc16_clear(7*2*sizeof(int32_t)*(fp->N_RB_DL*12));
Hongzhi Wang's avatar
Hongzhi Wang committed
374
              }
375
            }
Hongzhi Wang's avatar
Hongzhi Wang committed
376 377
        }
      }
378

Hongzhi Wang's avatar
Hongzhi Wang committed
379 380
      // 100 PRBs * 12 REs/PRB * 4 PDCCH SYMBOLS * 2 LLRs/RE
      for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
381 382 383 384 385 386 387 388 389
        ue->pdcch_vars[th_id][gNB_id]->llr                 = (int16_t *)malloc16_clear( 2*4*100*12*sizeof(uint16_t) );
        ue->pdcch_vars[th_id][gNB_id]->llr16               = (int16_t *)malloc16_clear( 2*4*100*12*sizeof(uint16_t) );
        ue->pdcch_vars[th_id][gNB_id]->wbar                = (int16_t *)malloc16_clear( 2*4*100*12*sizeof(uint16_t) );
        ue->pdcch_vars[th_id][gNB_id]->e_rx                = (int16_t *)malloc16_clear( 4*2*100*12 );
        ue->pdcch_vars[th_id][gNB_id]->rxdataF_comp        = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
        ue->pdcch_vars[th_id][gNB_id]->dl_ch_rho_ext       = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
        ue->pdcch_vars[th_id][gNB_id]->rho                 = (int32_t **)malloc16( fp->nb_antennas_rx*sizeof(int32_t *) );
        ue->pdcch_vars[th_id][gNB_id]->rxdataF_ext         = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
        ue->pdcch_vars[th_id][gNB_id]->dl_ch_estimates_ext = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
390
        // Channel estimates
391 392
        ue->pdcch_vars[th_id][gNB_id]->dl_ch_estimates      = (int32_t **)malloc16_clear(4*fp->nb_antennas_rx*sizeof(int32_t *));
        ue->pdcch_vars[th_id][gNB_id]->dl_ch_estimates_time = (int32_t **)malloc16_clear(4*fp->nb_antennas_rx*sizeof(int32_t *));
393 394

        for (i=0; i<fp->nb_antennas_rx; i++) {
395
          ue->pdcch_vars[th_id][gNB_id]->rho[i] = (int32_t *)malloc16_clear( sizeof(int32_t)*(100*12*4));
396 397

          for (j=0; j<4; j++) {
398
            int idx = (j*fp->nb_antennas_rx)+i;
399 400
            ue->pdcch_vars[th_id][gNB_id]->dl_ch_estimates[idx] = (int32_t *)malloc16_clear( sizeof(int32_t)*fp->symbols_per_slot*(fp->ofdm_symbol_size+LTE_CE_FILTER_LENGTH) );
            ue->pdcch_vars[th_id][gNB_id]->dl_ch_estimates_time[idx] = (int32_t *)malloc16_clear( sizeof(int32_t)*fp->ofdm_symbol_size*2 );
401 402
            //  size_t num = 7*2*fp->N_RB_DL*12;
            size_t num = 4*273*12;  // 4 symbols, 100 PRBs, 12 REs per PRB
403 404 405 406
            ue->pdcch_vars[th_id][gNB_id]->rxdataF_comp[idx]        = (int32_t *)malloc16_clear(sizeof(int32_t) * num);
            ue->pdcch_vars[th_id][gNB_id]->dl_ch_rho_ext[idx]       = (int32_t *)malloc16_clear(sizeof(int32_t) * num);
            ue->pdcch_vars[th_id][gNB_id]->rxdataF_ext[idx]         = (int32_t *)malloc16_clear(sizeof(int32_t) * num);
            ue->pdcch_vars[th_id][gNB_id]->dl_ch_estimates_ext[idx] = (int32_t *)malloc16_clear(sizeof(int32_t) * num);
407 408
          }
        }
Hongzhi Wang's avatar
Hongzhi Wang committed
409 410 411
      }

      // PBCH
412 413 414 415 416 417 418 419
      pbch_vars[gNB_id]->rxdataF_ext         = (int32_t **)malloc16( fp->nb_antennas_rx*sizeof(int32_t *) );
      pbch_vars[gNB_id]->rxdataF_comp        = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
      pbch_vars[gNB_id]->dl_ch_estimates     = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
      pbch_vars[gNB_id]->dl_ch_estimates_ext = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
      pbch_vars[gNB_id]->dl_ch_estimates_time = (int32_t **)malloc16_clear( 4*fp->nb_antennas_rx*sizeof(int32_t *) );
      pbch_vars[gNB_id]->llr                 = (int16_t *)malloc16_clear( 1920 ); //
      prach_vars[gNB_id]->prachF             = (int16_t *)malloc16_clear( sizeof(int)*(7*2*sizeof(int)*(fp->ofdm_symbol_size*12)) );
      prach_vars[gNB_id]->prach              = (int16_t *)malloc16_clear( sizeof(int)*(7*2*sizeof(int)*(fp->ofdm_symbol_size*12)) );
Hongzhi Wang's avatar
Hongzhi Wang committed
420 421

      for (i=0; i<fp->nb_antennas_rx; i++) {
422
        pbch_vars[gNB_id]->rxdataF_ext[i]    = (int32_t *)malloc16_clear( sizeof(int32_t)*20*12*4 );
Hongzhi Wang's avatar
Hongzhi Wang committed
423 424

        for (j=0; j<4; j++) {//fp->nb_antennas_tx;j++) {
425
          int idx = (j*fp->nb_antennas_rx)+i;
426 427 428 429
          pbch_vars[gNB_id]->rxdataF_comp[idx]        = (int32_t *)malloc16_clear( sizeof(int32_t)*20*12*4 );
          pbch_vars[gNB_id]->dl_ch_estimates[idx]     = (int32_t *)malloc16_clear( sizeof(int32_t)*7*2*sizeof(int)*(fp->ofdm_symbol_size) );
          pbch_vars[gNB_id]->dl_ch_estimates_time[idx]= (int32_t *)malloc16_clear( sizeof(int32_t)*7*2*sizeof(int)*(fp->ofdm_symbol_size) );
          pbch_vars[gNB_id]->dl_ch_estimates_ext[idx] = (int32_t *)malloc16_clear( sizeof(int32_t)*20*12*4 );
Hongzhi Wang's avatar
Hongzhi Wang committed
430 431 432 433
        }
      }
    }

434
    pbch_vars[gNB_id]->decoded_output = (uint8_t *)malloc16_clear(64);
Hongzhi Wang's avatar
Hongzhi Wang committed
435 436 437 438
  }

  // initialization for the last instance of pdsch_vars (used for MU-MIMO)
  for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
439
    ue->pdsch_vars[th_id][gNB_id] = (NR_UE_PDSCH *)malloc16_clear(sizeof(NR_UE_PDSCH));
Hongzhi Wang's avatar
Hongzhi Wang committed
440 441 442 443
  }

  if (abstraction_flag == 0) {
    for (th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
444 445 446
      //phy_init_lte_ue__PDSCH( ue->pdsch_vars[th_id][gNB_id], fp );
      ue->pdsch_vars[th_id][gNB_id]->llr[1] = (int16_t *)malloc16_clear((8*(3*8*8448))*sizeof(int16_t));
      ue->pdsch_vars[th_id][gNB_id]->layer_llr[1] = (int16_t *)malloc16_clear((8*(3*8*8448))*sizeof(int16_t));
Hongzhi Wang's avatar
Hongzhi Wang committed
447 448
    }
  } else { //abstraction == 1
449
    ue->sinr_dB = (double *) malloc16_clear( fp->N_RB_DL*12*sizeof(double) );
Hongzhi Wang's avatar
Hongzhi Wang committed
450 451
  }

452
  ue->sinr_CQI_dB = (double *) malloc16_clear( fp->N_RB_DL*12*sizeof(double) );
Hongzhi Wang's avatar
Hongzhi Wang committed
453
  ue->init_averaging = 1;
454

Hongzhi Wang's avatar
Hongzhi Wang committed
455
  // default value until overwritten by RRCConnectionReconfiguration
456
  if (fp->nb_antenna_ports_gNB==2)
Hongzhi Wang's avatar
Hongzhi Wang committed
457 458 459 460 461 462 463
    ue->pdsch_config_dedicated->p_a = dBm3;
  else
    ue->pdsch_config_dedicated->p_a = dB0;

  // enable MIB/SIB decoding by default
  ue->decode_MIB = 1;
  ue->decode_SIB = 1;
464 465

  init_nr_prach_tables(839);
Raymond Knopp's avatar
Raymond Knopp committed
466
  init_symbol_rotation(fp);
Hongzhi Wang's avatar
Hongzhi Wang committed
467 468
  return 0;
}
hongzhi wang's avatar
hongzhi wang committed
469

yilmazt's avatar
yilmazt committed
470
void init_nr_ue_transport(PHY_VARS_NR_UE *ue,
471
                          int abstraction_flag) {
472
  for (int i = 0; i < NUMBER_OF_CONNECTED_gNB_MAX; i++) {
yilmazt's avatar
yilmazt committed
473 474
    for (int j=0; j<2; j++) {
      for (int k=0; k<RX_NB_TH_MAX; k++) {
475
        AssertFatal((ue->dlsch[k][i][j]  = new_nr_ue_dlsch(1,NR_MAX_DLSCH_HARQ_PROCESSES,NSOFT,MAX_LDPC_ITERATIONS,ue->frame_parms.N_RB_DL, abstraction_flag))!=NULL,"Can't get ue dlsch structures\n");
Khalid Ahmed's avatar
Khalid Ahmed committed
476
        LOG_D(PHY,"dlsch[%d][%d][%d] => %p\n",k,i,j,ue->dlsch[k][i][j]);
477 478 479 480
        if (j==0) {
          AssertFatal((ue->ulsch[k][i] = new_nr_ue_ulsch(ue->frame_parms.N_RB_UL, NR_MAX_ULSCH_HARQ_PROCESSES, abstraction_flag))!=NULL,"Can't get ue ulsch structures\n");
          LOG_D(PHY,"ulsch[%d][%d] => %p\n",k,i,ue->ulsch[k][i]);
        }
Hongzhi Wang's avatar
Hongzhi Wang committed
481 482 483
      }
    }

Hongzhi Wang's avatar
Hongzhi Wang committed
484 485
    ue->dlsch_SI[i]  = new_nr_ue_dlsch(1,1,NSOFT,MAX_LDPC_ITERATIONS,ue->frame_parms.N_RB_DL, abstraction_flag);
    ue->dlsch_ra[i]  = new_nr_ue_dlsch(1,1,NSOFT,MAX_LDPC_ITERATIONS,ue->frame_parms.N_RB_DL, abstraction_flag);
486
    ue->transmission_mode[i] = ue->frame_parms.nb_antenna_ports_gNB==1 ? 1 : 2;
Hongzhi Wang's avatar
Hongzhi Wang committed
487 488
  }

hongzhi wang's avatar
hongzhi wang committed
489
  //ue->frame_parms.pucch_config_common.deltaPUCCH_Shift = 1;
490
  ue->dlsch_MCH[0]  = new_nr_ue_dlsch(1,NR_MAX_DLSCH_HARQ_PROCESSES,NSOFT,MAX_LDPC_ITERATIONS_MBSFN,ue->frame_parms.N_RB_DL,0);
491 492 493

  for(int i=0; i<5; i++)
    ue->dl_stats[i] = 0;
Hongzhi Wang's avatar
Hongzhi Wang committed
494
}
hongzhi wang's avatar
hongzhi wang committed
495

496 497 498 499 500 501 502 503 504

void init_N_TA_offset(PHY_VARS_NR_UE *ue){

  NR_DL_FRAME_PARMS *fp = &ue->frame_parms;

  if (fp->frame_type == FDD) {
    ue->N_TA_offset = 0;
  } else {
    int N_TA_offset = fp->ul_CarrierFreq < 6e9 ? 400 : 431; // reference samples  for 25600Tc @ 30.72 Ms/s for FR1, same @ 61.44 Ms/s for FR2
505 506

    double factor = 1.0;
507 508 509
    switch (fp->numerology_index) {
      case 0: //15 kHz scs
        AssertFatal(N_TA_offset == 400, "scs_common 15kHz only for FR1\n");
510
        factor = fp->samples_per_subframe / 30720.0;
511 512 513
        break;
      case 1: //30 kHz sc
        AssertFatal(N_TA_offset == 400, "scs_common 30kHz only for FR1\n");
514
        factor = fp->samples_per_subframe / 30720.0;
515 516 517 518 519 520
        break;
      case 2: //60 kHz scs
        AssertFatal(1==0, "scs_common should not be 60 kHz\n");
        break;
      case 3: //120 kHz scs
        AssertFatal(N_TA_offset == 431, "scs_common 120kHz only for FR2\n");
521
        factor = fp->samples_per_subframe / 61440.0;
522 523
        break;
      case 4: //240 kHz scs
524 525
        AssertFatal(N_TA_offset == 431, "scs_common 240kHz only for FR2\n");
        factor = fp->samples_per_subframe / 61440.0;
526
        break;
527 528
      default:
        AssertFatal(1==0, "Invalid scs_common!\n");
529 530 531 532
    }

    ue->N_TA_offset = (int)(N_TA_offset * factor);

533
    LOG_I(PHY,"UE %d Setting N_TA_offset to %d samples (factor %f, UL Freq %lu, N_RB %d, mu %d)\n", ue->Mod_id, ue->N_TA_offset, factor, fp->ul_CarrierFreq, fp->N_RB_DL, fp->numerology_index);
534 535 536
  }
}

537
void phy_init_nr_top(PHY_VARS_NR_UE *ue) {
Raymond Knopp's avatar
Raymond Knopp committed
538
  NR_DL_FRAME_PARMS *frame_parms = &ue->frame_parms;
hongzhi wang's avatar
hongzhi wang committed
539
  crcTableInit();
frtabu's avatar
frtabu committed
540
  load_dftslib();
hongzhi wang's avatar
hongzhi wang committed
541 542
  init_context_synchro_nr(frame_parms);
  generate_ul_reference_signal_sequences(SHRT_MAX);
Hongzhi Wang's avatar
Hongzhi Wang committed
543
  // Polar encoder init for PBCH
hongzhi wang's avatar
hongzhi wang committed
544 545 546 547 548 549 550 551 552 553
  //lte_sync_time_init(frame_parms);
  //generate_ul_ref_sigs();
  //generate_ul_ref_sigs_rx();
  //generate_64qam_table();
  //generate_16qam_table();
  //generate_RIV_tables();
  //init_unscrambling_lut();
  //init_scrambling_lut();
  //set_taus_seed(1328);
}