822 lines
26 KiB
C
822 lines
26 KiB
C
/*
|
|
* 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>
|
|
#include "common/config/config_userapi.h"
|
|
#include "common/utils/LOG/log.h"
|
|
#include "common/utils/load_module_shlib.h"
|
|
#include "common/ran_context.h"
|
|
#include "common/utils/nr/nr_common.h"
|
|
#include "PHY/types.h"
|
|
#include "PHY/defs_nr_common.h"
|
|
#include "PHY/defs_nr_UE.h"
|
|
#include "PHY/defs_gNB.h"
|
|
#include "PHY/NR_REFSIG/refsig_defs_ue.h"
|
|
#include "PHY/MODULATION/modulation_eNB.h"
|
|
#include "PHY/MODULATION/modulation_UE.h"
|
|
#include "PHY/MODULATION/nr_modulation.h"
|
|
#include "PHY/INIT/nr_phy_init.h"
|
|
#include "PHY/NR_TRANSPORT/nr_transport_proto.h"
|
|
#include "PHY/NR_UE_TRANSPORT/nr_transport_proto_ue.h"
|
|
#include "PHY/NR_UE_ESTIMATION/nr_estimation.h"
|
|
#include "PHY/phy_vars.h"
|
|
#include "SCHED_NR/sched_nr.h"
|
|
#include "openair1/SIMULATION/TOOLS/sim.h"
|
|
#include "openair1/SIMULATION/RF/rf.h"
|
|
#include "openair1/SIMULATION/NR_PHY/nr_unitary_defs.h"
|
|
#include "openair1/PHY/MODULATION/nr_modulation.h"
|
|
#include <executables/softmodem-common.h>
|
|
#include <executables/nr-uesoftmodem.h>
|
|
#include "nfapi/oai_integration/vendor_ext.h"
|
|
//#define DEBUG_NR_PBCHSIM
|
|
|
|
PHY_VARS_gNB *gNB;
|
|
PHY_VARS_NR_UE *UE;
|
|
RAN_CONTEXT_t RC;
|
|
int32_t uplink_frequency_offset[MAX_NUM_CCs][4];
|
|
|
|
double cpuf;
|
|
|
|
// needed for some functions
|
|
openair0_config_t openair0_cfg[MAX_CARDS];
|
|
|
|
uint8_t const nr_rv_round_map[4] = {0, 2, 3, 1};
|
|
|
|
void inc_ref_sched_response(int _)
|
|
{
|
|
LOG_E(PHY, "fatal\n");
|
|
exit(1);
|
|
}
|
|
void deref_sched_response(int _)
|
|
{
|
|
LOG_E(PHY, "fatal\n");
|
|
exit(1);
|
|
}
|
|
static softmodem_params_t softmodem_params;
|
|
softmodem_params_t *get_softmodem_params(void) {
|
|
return &softmodem_params;
|
|
}
|
|
|
|
nrUE_params_t nrUE_params={0};
|
|
|
|
nrUE_params_t *get_nrUE_params(void) {
|
|
return &nrUE_params;
|
|
}
|
|
|
|
void init_downlink_harq_status(NR_DL_UE_HARQ_t *dl_harq) {}
|
|
NR_IF_Module_t *NR_IF_Module_init(int Mod_id) { return (NULL); }
|
|
nfapi_mode_t nfapi_getmode(void) { return NFAPI_MODE_UNKNOWN; }
|
|
|
|
void nr_fill_dl_indication(nr_downlink_indication_t *dl_ind,
|
|
fapi_nr_dci_indication_t *dci_ind,
|
|
fapi_nr_rx_indication_t *rx_ind,
|
|
const UE_nr_rxtx_proc_t *proc,
|
|
PHY_VARS_NR_UE *ue,
|
|
void *phy_data)
|
|
{
|
|
}
|
|
void nr_fill_rx_indication(fapi_nr_rx_indication_t *rx_ind,
|
|
uint8_t pdu_type,
|
|
PHY_VARS_NR_UE *ue,
|
|
NR_UE_DLSCH_t *dlsch0,
|
|
NR_UE_DLSCH_t *dlsch1,
|
|
uint16_t n_pdus,
|
|
const UE_nr_rxtx_proc_t *proc,
|
|
void *typeSpecific,
|
|
uint8_t *b)
|
|
{
|
|
}
|
|
|
|
int nr_ue_pdcch_procedures(PHY_VARS_NR_UE *ue,
|
|
const UE_nr_rxtx_proc_t *proc,
|
|
int32_t pdcch_est_size,
|
|
c16_t pdcch_dl_ch_estimates[][pdcch_est_size],
|
|
nr_phy_data_t *phy_data,
|
|
int n_ss,
|
|
c16_t rxdataF[][ue->frame_parms.samples_per_slot_wCP])
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
configmodule_interface_t *uniqCfg = NULL;
|
|
int main(int argc, char **argv)
|
|
{
|
|
stop = false;
|
|
__attribute__((unused)) struct sigaction oldaction;
|
|
sigaction(SIGINT, &sigint_action, &oldaction);
|
|
|
|
int i,aa,start_symbol;
|
|
double sigma2, sigma2_dB=10,SNR,snr0=-2.0,snr1=2.0;
|
|
double cfo=0;
|
|
uint8_t snr1set=0;
|
|
c16_t **txdata;
|
|
double **s_re,**s_im,**r_re,**r_im;
|
|
//double iqim = 0.0;
|
|
double ip =0.0;
|
|
//unsigned char pbch_pdu[6];
|
|
// int sync_pos, sync_pos_slot;
|
|
// FILE *rx_frame_file;
|
|
FILE *output_fd = NULL;
|
|
//uint8_t write_output_file=0;
|
|
//int result;
|
|
//int freq_offset;
|
|
// int subframe_offset;
|
|
// char fname[40], vname[40];
|
|
int trial,n_trials=1,n_errors=0,n_errors_payload=0;
|
|
uint8_t transmission_mode = 1,n_tx=1,n_rx=1;
|
|
uint16_t Nid_cell=0;
|
|
uint64_t SSB_positions=0x01;
|
|
int ssb_subcarrier_offset = 0;
|
|
int ssb_scan_threads = 0;
|
|
|
|
channel_desc_t *gNB2UE;
|
|
get_softmodem_params()->usim_test = 1;
|
|
|
|
//uint8_t extended_prefix_flag=0;
|
|
//int8_t interf1=-21,interf2=-21;
|
|
|
|
FILE *input_fd=NULL,*pbch_file_fd=NULL;
|
|
|
|
//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;
|
|
|
|
SCM_t channel_model=AWGN;//Rayleigh1_anticorr;
|
|
|
|
|
|
int N_RB_DL=273,mu=1;
|
|
|
|
//unsigned char frame_type = 0;
|
|
unsigned char pbch_phase = 0;
|
|
|
|
int frame=0;
|
|
int frame_length_complex_samples;
|
|
__attribute__((unused))
|
|
int frame_length_complex_samples_no_prefix;
|
|
NR_DL_FRAME_PARMS *frame_parms;
|
|
|
|
int ret;
|
|
int run_initial_sync=0;
|
|
|
|
int loglvl=OAILOG_WARNING;
|
|
|
|
float target_error_rate = 0.01;
|
|
|
|
int seed = 0;
|
|
|
|
cpuf = get_cpu_freq_GHz();
|
|
|
|
if ((uniqCfg = load_configmodule(argc, argv, CONFIG_ENABLECMDLINEONLY)) == 0) {
|
|
exit_fun("[NR_PBCHSIM] Error, configuration module init failed\n");
|
|
}
|
|
|
|
int c;
|
|
while ((c = getopt (argc, argv, "--:O:c:F:g:hIL:m:M:n:N:o:P:r:R:s:S:x:y:z:")) != -1) {
|
|
|
|
/* ignore long options starting with '--', option '-O' and their arguments that are handled by configmodule */
|
|
/* with this opstring getopt returns 1 for non-option arguments, refer to 'man 3 getopt' */
|
|
if (c == 1 || c == '-' || c == 'O')
|
|
continue;
|
|
|
|
printf("handling optarg %c\n",c);
|
|
switch (c) {
|
|
|
|
case 'c':
|
|
ssb_subcarrier_offset = atoi(optarg);
|
|
break;
|
|
|
|
/*case 'f':
|
|
write_output_file=1;
|
|
output_fd = fopen(optarg,"w");
|
|
|
|
if (output_fd==NULL) {
|
|
printf("Error opening %s\n",optarg);
|
|
exit(-1);
|
|
}
|
|
|
|
break;*/
|
|
|
|
/*case 'd':
|
|
frame_type = 1;
|
|
break;*/
|
|
|
|
case 'F':
|
|
input_fd = fopen(optarg,"r");
|
|
if (input_fd==NULL) {
|
|
printf("Problem with filename %s. Exiting.\n", optarg);
|
|
exit(-1);
|
|
}
|
|
break;
|
|
|
|
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:
|
|
printf("Unsupported channel model! Exiting.\n");
|
|
exit(-1);
|
|
}
|
|
|
|
break;
|
|
|
|
/*
|
|
case 'i':
|
|
interf1=atoi(optarg);
|
|
break;
|
|
*/
|
|
|
|
case 'I':
|
|
run_initial_sync=1;
|
|
target_error_rate=0.1;
|
|
break;
|
|
|
|
/*
|
|
case 'j':
|
|
interf2=atoi(optarg);
|
|
break;*/
|
|
|
|
case 'L':
|
|
loglvl = atoi(optarg);
|
|
break;
|
|
|
|
case 'm':
|
|
mu = atoi(optarg);
|
|
break;
|
|
|
|
case 'M':
|
|
SSB_positions = atoi(optarg);
|
|
break;
|
|
|
|
case 'n':
|
|
n_trials = atoi(optarg);
|
|
break;
|
|
|
|
case 'N':
|
|
Nid_cell = atoi(optarg);
|
|
break;
|
|
|
|
case 'o':
|
|
cfo = atof(optarg);
|
|
#ifdef DEBUG_NR_PBCHSIM
|
|
printf("Setting CFO to %f Hz\n",cfo);
|
|
#endif
|
|
break;
|
|
|
|
/*case 'p':
|
|
extended_prefix_flag=1;
|
|
break;*/
|
|
|
|
case 'P':
|
|
pbch_phase = atoi(optarg);
|
|
if (pbch_phase>3)
|
|
printf("Illegal PBCH phase (0-3) got %d\n",pbch_phase);
|
|
break;
|
|
|
|
/*
|
|
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 'r':
|
|
seed = atoi(optarg);
|
|
break;
|
|
|
|
case 'R':
|
|
N_RB_DL = atoi(optarg);
|
|
break;
|
|
|
|
case 's':
|
|
snr0 = atof(optarg);
|
|
#ifdef DEBUG_NR_PBCHSIM
|
|
printf("Setting SNR0 to %f\n",snr0);
|
|
#endif
|
|
break;
|
|
|
|
case 'S':
|
|
snr1 = atof(optarg);
|
|
snr1set=1;
|
|
#ifdef DEBUG_NR_PBCHSIM
|
|
printf("Setting SNR1 to %f\n",snr1);
|
|
#endif
|
|
break;
|
|
|
|
/*
|
|
case 't':
|
|
Td= atof(optarg);
|
|
break;
|
|
*/
|
|
|
|
case 'x':
|
|
transmission_mode=atoi(optarg);
|
|
|
|
if ((transmission_mode!=1) && (transmission_mode!=2) && (transmission_mode!=6)) {
|
|
printf("Unsupported transmission mode %d. Exiting.\n",transmission_mode);
|
|
exit(-1);
|
|
}
|
|
|
|
break;
|
|
|
|
case 'y':
|
|
n_tx=atoi(optarg);
|
|
if ((n_tx==0) || (n_tx>2)) {
|
|
printf("Unsupported number of TX antennas %d. Exiting.\n", n_tx);
|
|
exit(-1);
|
|
}
|
|
break;
|
|
|
|
case 'z':
|
|
n_rx=atoi(optarg);
|
|
if ((n_rx==0) || (n_rx>2)) {
|
|
printf("Unsupported number of RX antennas %d. Exiting.\n", n_rx);
|
|
exit(-1);
|
|
}
|
|
break;
|
|
|
|
default:
|
|
case 'h':
|
|
printf("%s -F input_filename -g channel_mod -h(elp) -I(nitial sync) -L log_lvl -n n_frames -M SSBs -n frames -N cell_id -o FO -P phase -r seed -R RBs -s snr0 -S snr1 -x transmission_mode -y TXant -z RXant\n",
|
|
argv[0]);
|
|
//printf("-A Interpolation_filname Run with Abstraction to generate Scatter plot using interpolation polynomial in file\n");
|
|
printf("-c SSB subcarrier offset\n");
|
|
//printf("-C Generate Calibration information for Abstraction (effective SNR adjustment to remove Pe bias w.r.t. AWGN)\n");
|
|
//printf("-d Use TDD\n");
|
|
//printf("-f Output filename (.txt format) for Pe/SNR results\n");
|
|
printf("-F Input filename (.txt format) for RX conformance testing\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("-h This message\n");
|
|
//printf("-i Relative strength of first intefering eNB (in dB) - cell_id mod 3 = 1\n");
|
|
printf("-I run initial sync with target error rate 0.1\n");
|
|
//printf("-j Relative strength of second intefering eNB (in dB) - cell_id mod 3 = 2\n");
|
|
printf("-L set the log level (-1 disable, 0 error, 1 warning, 2 info, 3 debug, 4 trace)\n");
|
|
printf("-m Numerology index\n");
|
|
printf("-M Multiple SSB positions in burst\n");
|
|
printf("-n Number of frames to simulate\n");
|
|
printf("-N Nid_cell\n");
|
|
printf("-o Carrier frequency offset in Hz\n");
|
|
//printf("-O oversampling factor (1,2,4,8,16)\n");
|
|
//printf("-p Use extended prefix mode\n");
|
|
printf("-P PBCH phase, allowed values 0-3\n");
|
|
printf("-r set the random number generator seed (default: 0 = current time)\n");
|
|
printf("-R N_RB_DL\n");
|
|
printf("-s Starting SNR, runs from SNR0 to SNR0 + 10 dB if not -S given. If -n 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("-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");
|
|
exit (-1);
|
|
break;
|
|
}
|
|
}
|
|
|
|
randominit(seed);
|
|
|
|
logInit();
|
|
set_glog(loglvl);
|
|
|
|
if (snr1set==0)
|
|
snr1 = snr0+10;
|
|
|
|
printf("Initializing gNodeB for mu %d, N_RB_DL %d\n",mu,N_RB_DL);
|
|
|
|
|
|
RC.gNB = (PHY_VARS_gNB**) malloc(sizeof(PHY_VARS_gNB *));
|
|
RC.gNB[0] = malloc16_clear(sizeof(*(RC.gNB[0])));
|
|
gNB = RC.gNB[0];
|
|
gNB->ofdm_offset_divisor = UINT_MAX;
|
|
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->nb_antenna_ports_gNB = n_tx;
|
|
frame_parms->N_RB_DL = N_RB_DL;
|
|
frame_parms->Nid_cell = Nid_cell;
|
|
frame_parms->ssb_type = nr_ssb_type_C;
|
|
frame_parms->freq_range = mu<2 ? FR1 : FR2;
|
|
|
|
nr_phy_config_request_sim(gNB, N_RB_DL, N_RB_DL, mu, Nid_cell, SSB_positions);
|
|
// TDD configuration
|
|
gNB->gNB_config.tdd_table.tdd_period.value = 6;
|
|
do_tdd_config_sim(gNB, mu);
|
|
|
|
phy_init_nr_gNB(gNB);
|
|
frame_parms->ssb_start_subcarrier = 12 * gNB->gNB_config.ssb_table.ssb_offset_point_a.value + ssb_subcarrier_offset;
|
|
initFloatingCoresTpool(ssb_scan_threads, &nrUE_params.Tpool, false, "UE-tpool");
|
|
|
|
int n_hf = 0;
|
|
int cyclic_prefix_type = NFAPI_CP_NORMAL;
|
|
|
|
double fs=0, eps;
|
|
double scs = 30000;
|
|
double txbw, rxbw;
|
|
uint32_t samples;
|
|
|
|
get_samplerate_and_bw(mu, N_RB_DL, frame_parms->threequarter_fs, &fs, &samples, &txbw, &rxbw);
|
|
|
|
// cfo with respect to sub-carrier spacing
|
|
eps = cfo/scs;
|
|
|
|
// computation of integer and fractional FO to compare with estimation results
|
|
int IFO;
|
|
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);
|
|
}
|
|
|
|
gNB2UE = new_channel_desc_scm(n_tx, n_rx, channel_model, fs, 0, txbw, 300e-9, 0.0, CORR_LEVEL_LOW, 0, 0, 0, 0);
|
|
|
|
if (gNB2UE==NULL) {
|
|
printf("Problem generating channel model. Exiting.\n");
|
|
exit(-1);
|
|
}
|
|
|
|
frame_length_complex_samples = frame_parms->samples_per_subframe*NR_NUMBER_OF_SUBFRAMES_PER_FRAME;
|
|
frame_length_complex_samples_no_prefix = frame_parms->samples_per_subframe_wCP;
|
|
|
|
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 = calloc(2, sizeof(c16_t*));
|
|
|
|
for (i=0; i<2; i++) {
|
|
|
|
|
|
s_re[i] = malloc16_clear(frame_length_complex_samples*sizeof(double));
|
|
s_im[i] = malloc16_clear(frame_length_complex_samples*sizeof(double));
|
|
r_re[i] = malloc16_clear(frame_length_complex_samples*sizeof(double));
|
|
r_im[i] = malloc16_clear(frame_length_complex_samples*sizeof(double));
|
|
printf("Allocating %d samples for txdata\n",frame_length_complex_samples);
|
|
txdata[i] = malloc16_clear(frame_length_complex_samples * sizeof(c16_t));
|
|
}
|
|
|
|
if (pbch_file_fd!=NULL) {
|
|
load_pbch_desc(pbch_file_fd);
|
|
}
|
|
|
|
|
|
//configure UE
|
|
|
|
UE = malloc16_clear(sizeof(*UE));
|
|
memcpy(&UE->frame_parms,frame_parms,sizeof(UE->frame_parms));
|
|
//phy_init_nr_top(UE); //called from init_nr_ue_signal
|
|
if (run_initial_sync==1) UE->is_synchronized = 0;
|
|
else UE->is_synchronized = 1;
|
|
|
|
if(eps!=0.0)
|
|
UE->UE_fo_compensation = 1; // if a frequency offset is set then perform fo estimation and compensation
|
|
|
|
if (init_nr_ue_signal(UE, 1) != 0) {
|
|
printf("Error at UE NR initialisation\n");
|
|
exit(-1);
|
|
}
|
|
|
|
processingData_L1tx_t msgDataTx;
|
|
// generate signal
|
|
const uint32_t rxdataF_sz = UE->frame_parms.samples_per_slot_wCP;
|
|
__attribute__ ((aligned(32))) c16_t rxdataF[UE->frame_parms.nb_antennas_rx][rxdataF_sz];
|
|
if (input_fd==NULL) {
|
|
|
|
for (i=0; i<frame_parms->Lmax; i++) {
|
|
if((SSB_positions >> i) & 0x01) {
|
|
|
|
const int sc_offset = frame_parms->freq_range == FR1 ? ssb_subcarrier_offset<<mu : ssb_subcarrier_offset;
|
|
const int prb_offset = frame_parms->freq_range == FR1 ? gNB->gNB_config.ssb_table.ssb_offset_point_a.value<<mu : gNB->gNB_config.ssb_table.ssb_offset_point_a.value << (mu - 2);
|
|
msgDataTx.ssb[i].ssb_pdu.ssb_pdu_rel15.bchPayload = 0x55dd33;
|
|
msgDataTx.ssb[i].ssb_pdu.ssb_pdu_rel15.SsbBlockIndex = i;
|
|
msgDataTx.ssb[i].ssb_pdu.ssb_pdu_rel15.SsbSubcarrierOffset = sc_offset;
|
|
msgDataTx.ssb[i].ssb_pdu.ssb_pdu_rel15.ssbOffsetPointA = prb_offset;
|
|
|
|
start_symbol = nr_get_ssb_start_symbol(frame_parms,i);
|
|
int slot = start_symbol/14;
|
|
|
|
for (aa=0; aa<gNB->frame_parms.nb_antennas_tx; aa++)
|
|
memset(gNB->common_vars.txdataF[0][aa], 0, frame_parms->samples_per_slot_wCP * sizeof(int32_t));
|
|
|
|
nr_common_signal_procedures (gNB,frame,slot,msgDataTx.ssb[i].ssb_pdu);
|
|
|
|
int samp = frame_parms->get_samples_slot_timestamp(slot, frame_parms, 0);
|
|
for (aa=0; aa<gNB->frame_parms.nb_antennas_tx; aa++) {
|
|
if (cyclic_prefix_type == 1) {
|
|
apply_nr_rotation_TX(frame_parms,
|
|
gNB->common_vars.txdataF[0][aa],
|
|
frame_parms->symbol_rotation[0],
|
|
slot,
|
|
frame_parms->N_RB_DL,
|
|
0,
|
|
12);
|
|
|
|
PHY_ofdm_mod((int *)gNB->common_vars.txdataF[0][aa],
|
|
(int *)&txdata[aa][samp],
|
|
frame_parms->ofdm_symbol_size,
|
|
12,
|
|
frame_parms->nb_prefix_samples,
|
|
CYCLIC_PREFIX);
|
|
} else {
|
|
apply_nr_rotation_TX(frame_parms,
|
|
gNB->common_vars.txdataF[0][aa],
|
|
frame_parms->symbol_rotation[0],
|
|
slot,
|
|
frame_parms->N_RB_DL,
|
|
0,
|
|
14);
|
|
|
|
PHY_ofdm_mod((int *)gNB->common_vars.txdataF[0][aa],
|
|
(int*)&txdata[aa][samp],
|
|
frame_parms->ofdm_symbol_size,
|
|
1,
|
|
frame_parms->nb_prefix_samples0,
|
|
CYCLIC_PREFIX);
|
|
|
|
PHY_ofdm_mod((int *)&gNB->common_vars.txdataF[0][aa][frame_parms->ofdm_symbol_size],
|
|
(int*)&txdata[aa][samp + frame_parms->nb_prefix_samples0 + frame_parms->ofdm_symbol_size],
|
|
frame_parms->ofdm_symbol_size,
|
|
13,
|
|
frame_parms->nb_prefix_samples,
|
|
CYCLIC_PREFIX);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
LOG_M("txsigF0.m","txsF0", gNB->common_vars.txdataF[0][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[0][1],frame_length_complex_samples_no_prefix, 1, 1);
|
|
|
|
} else {
|
|
printf("Reading %d samples from file to antenna buffer %d\n",frame_length_complex_samples,0);
|
|
UE->UE_fo_compensation = 1; // perform fo compensation when samples from file are used
|
|
if (fread(txdata[0],
|
|
sizeof(int32_t),
|
|
frame_length_complex_samples,
|
|
input_fd) != frame_length_complex_samples) {
|
|
printf("error reading from file\n");
|
|
//exit(-1);
|
|
}
|
|
}
|
|
|
|
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);
|
|
|
|
if (output_fd)
|
|
fwrite(txdata[0],sizeof(int32_t),frame_length_complex_samples,output_fd);
|
|
|
|
/*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));*/
|
|
|
|
|
|
for (SNR = snr0; SNR < snr1 && !stop; SNR+=.2) {
|
|
|
|
n_errors = 0;
|
|
n_errors_payload = 0;
|
|
|
|
for (trial = 0; trial < n_trials && !stop; trial++) {
|
|
|
|
for (i=0; i<frame_length_complex_samples; i++) {
|
|
for (aa=0; aa<frame_parms->nb_antennas_tx; aa++) {
|
|
r_re[aa][i] = (double)txdata[aa][i].r;
|
|
r_im[aa][i] = (double)txdata[aa][i].i;
|
|
}
|
|
}
|
|
|
|
// multipath channel
|
|
//multipath_channel(gNB2UE,s_re,s_im,r_re,r_im,frame_length_complex_samples,0);
|
|
|
|
//AWGN
|
|
sigma2_dB = 20*log10((double)AMP/4)-SNR;
|
|
sigma2 = pow(10,sigma2_dB/10);
|
|
//printf("sigma2 %f (%f dB), tx_lev %f (%f dB)\n",sigma2,sigma2_dB,txlev,10*log10((double)txlev));
|
|
|
|
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
|
|
1.0e9/fs, //sampling time (ns)
|
|
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)
|
|
|
|
for (i=0; i<frame_length_complex_samples; i++) {
|
|
for (aa=0; aa<frame_parms->nb_antennas_rx; aa++) {
|
|
UE->common_vars.rxdata[aa][i].r = (short)(r_re[aa][i] + sqrt(sigma2 / 2) * gaussdouble(0.0, 1.0));
|
|
UE->common_vars.rxdata[aa][i].i = (short)(r_im[aa][i] + sqrt(sigma2 / 2) * gaussdouble(0.0, 1.0));
|
|
}
|
|
}
|
|
|
|
if (n_trials==1) {
|
|
LOG_M("rxsig0.m", "rxs0", UE->common_vars.rxdata[0], frame_parms->samples_per_frame, 1, 1);
|
|
if (gNB->frame_parms.nb_antennas_tx > 1)
|
|
LOG_M("rxsig1.m", "rxs1", UE->common_vars.rxdata[1], frame_parms->samples_per_frame, 1, 1);
|
|
}
|
|
if (UE->is_synchronized == 0) {
|
|
UE_nr_rxtx_proc_t proc = {0};
|
|
nr_gscn_info_t gscnInfo[MAX_GSCN_BAND] = {0};
|
|
const int numGscn = 1;
|
|
gscnInfo[0].ssbFirstSC = frame_parms->ssb_start_subcarrier;
|
|
nr_initial_sync_t ret = nr_initial_sync(&proc, UE, 1, 0, gscnInfo, numGscn);
|
|
printf("nr_initial_sync1 returns %s\n", ret.cell_detected ? "cell detected" : "cell not detected");
|
|
if (!ret.cell_detected)
|
|
n_errors++;
|
|
}
|
|
else {
|
|
UE_nr_rxtx_proc_t proc={0};
|
|
|
|
uint8_t ssb_index = 0;
|
|
const int estimateSz = frame_parms->symbols_per_slot * frame_parms->ofdm_symbol_size;
|
|
__attribute__((aligned(32))) struct complex16 dl_ch_estimates[frame_parms->nb_antennas_rx][estimateSz];
|
|
__attribute__((
|
|
aligned(32))) struct complex16 dl_ch_estimates_time[frame_parms->nb_antennas_rx][frame_parms->ofdm_symbol_size];
|
|
while (!((SSB_positions >> ssb_index) & 0x01))
|
|
ssb_index++; // to select the first transmitted ssb
|
|
UE->symbol_offset = nr_get_ssb_start_symbol(frame_parms, ssb_index);
|
|
|
|
int ssb_slot = (UE->symbol_offset/14)+(n_hf*(frame_parms->slots_per_frame>>1));
|
|
proc.nr_slot_rx = ssb_slot;
|
|
proc.gNB_id = 0;
|
|
for (int i = UE->symbol_offset + 1; i < UE->symbol_offset + 4; i++) {
|
|
nr_slot_fep(UE,
|
|
frame_parms,
|
|
proc.nr_slot_rx,
|
|
i % frame_parms->symbols_per_slot,
|
|
rxdataF,
|
|
link_type_dl,
|
|
0,
|
|
UE->common_vars.rxdata);
|
|
|
|
nr_pbch_channel_estimation(&UE->frame_parms,
|
|
&UE->SL_UE_PHY_PARAMS,
|
|
estimateSz,
|
|
dl_ch_estimates,
|
|
dl_ch_estimates_time,
|
|
&proc,
|
|
i % frame_parms->symbols_per_slot,
|
|
i - (UE->symbol_offset + 1),
|
|
ssb_index % 8,
|
|
n_hf,
|
|
frame_parms->ssb_start_subcarrier,
|
|
rxdataF,
|
|
false,
|
|
frame_parms->Nid_cell);
|
|
}
|
|
fapiPbch_t result;
|
|
int ret_ssb_idx;
|
|
int ret_symbol_offset;
|
|
ret = nr_rx_pbch(UE,
|
|
&proc,
|
|
true,
|
|
estimateSz,
|
|
dl_ch_estimates,
|
|
frame_parms,
|
|
ssb_index % 8,
|
|
frame_parms->ssb_start_subcarrier,
|
|
Nid_cell,
|
|
&result,
|
|
&n_hf,
|
|
&ret_ssb_idx,
|
|
&ret_symbol_offset,
|
|
frame_parms->samples_per_frame_wCP,
|
|
rxdataF);
|
|
|
|
if (ret == 0) {
|
|
uint32_t xtra_byte = nr_pbch_extra_byte_generation(frame,
|
|
n_hf,
|
|
ssb_index,
|
|
gNB->gNB_config.ssb_table.ssb_subcarrier_offset.value,
|
|
frame_parms->Lmax);
|
|
int payload_ret = (result.xtra_byte == xtra_byte);
|
|
nfapi_nr_dl_tti_ssb_pdu_rel15_t *pdu = &msgDataTx.ssb[ssb_index].ssb_pdu.ssb_pdu_rel15;
|
|
for (int i = 0; i < 3; i++)
|
|
payload_ret += (result.decoded_output[i] == ((pdu->bchPayload >> (8 * i)) & 0xff));
|
|
// printf("ret %d\n", payload_ret);
|
|
if (payload_ret != 4)
|
|
n_errors_payload++;
|
|
}
|
|
|
|
if (ret != 0)
|
|
n_errors++;
|
|
}
|
|
} //noise trials
|
|
printf("SNR %f: trials %d, n_errors_crc = %d, n_errors_payload %d\n", SNR,n_trials,n_errors,n_errors_payload);
|
|
|
|
if (((float)n_errors/(float)n_trials <= target_error_rate) && (n_errors_payload==0)) {
|
|
printf("PBCH test OK\n");
|
|
break;
|
|
}
|
|
|
|
if (n_trials==1)
|
|
break;
|
|
|
|
} // NSR
|
|
|
|
free_channel_desc_scm(gNB2UE);
|
|
|
|
int nb_slots_to_set = (1 << mu) * NR_NUMBER_OF_SUBFRAMES_PER_FRAME;
|
|
for (int i = 0; i < nb_slots_to_set; ++i)
|
|
free(gNB->gNB_config.tdd_table.max_tdd_periodicity_list[i].max_num_of_symbol_per_slot_list);
|
|
free(gNB->gNB_config.tdd_table.max_tdd_periodicity_list);
|
|
|
|
phy_free_nr_gNB(gNB);
|
|
free(RC.gNB[0]);
|
|
free(RC.gNB);
|
|
|
|
term_nr_ue_signal(UE, 1);
|
|
free(UE);
|
|
|
|
for (i=0; i<2; i++) {
|
|
free(s_re[i]);
|
|
free(s_im[i]);
|
|
free(r_re[i]);
|
|
free(r_im[i]);
|
|
free(txdata[i]);
|
|
}
|
|
|
|
free(s_re);
|
|
free(s_im);
|
|
free(r_re);
|
|
free(r_im);
|
|
free(txdata);
|
|
|
|
if (output_fd)
|
|
fclose(output_fd);
|
|
|
|
if (input_fd)
|
|
fclose(input_fd);
|
|
|
|
loader_reset();
|
|
logTerm();
|
|
|
|
return(n_errors);
|
|
|
|
}
|