Skip to content

O
OpenXG-RAN
Commit 79b6e1d8 authored by Raymond Knopp's avatar Raymond Knopp
Browse files
Options

PSS detection

parent 16526c7c
Hide whitespace changes
Inline Side-by-side
Showing with 774 additions and 188 deletions
openair1/PHY/INIT/defs.h
View file @ 79b6e1d8
......@@ -346,7 +346,9 @@ void lte_param_init(PHY_VARS_eNB **eNBp,
uint8_t pa,
uint8_t threequarter_fs,
uint8_t osf,
uint32_t perfect_ce);
uint32_t perfect_ce,
uint8_t sidelink_active,
uint8_t SLonly);
#if defined(Rel10) || defined(Rel14)
......
openair1/PHY/INIT/lte_init_ue.c
View file @ 79b6e1d8
......@@ -698,14 +698,18 @@ int init_lte_ue_signal(PHY_VARS_UE *ue,
// init RX buffers
common_vars->rxdata = (int32_t**)malloc16( fp->nb_antennas_rx*sizeof(int32_t*) );
common_vars->common_vars_rx_data_per_thread[0].rxdataF = (int32_t**)malloc16( fp->nb_antennas_rx*sizeof(int32_t*) );
common_vars->common_vars_rx_data_per_thread[1].rxdataF = (int32_t**)malloc16( fp->nb_antennas_rx*sizeof(int32_t*) );
common_vars->rxdata = (int32_t**)malloc16( fp->nb_antennas_rx*sizeof(int32_t*) );
common_vars->common_vars_rx_data_per_thread[0].rxdataF = (int32_t**)malloc16( fp->nb_antennas_rx*sizeof(int32_t*) );
common_vars->common_vars_rx_data_per_thread[1].rxdataF = (int32_t**)malloc16( fp->nb_antennas_rx*sizeof(int32_t*) );
if (ue->sidelink_active == 1) common_vars->rxdata_syncSL = (int32_t**)malloc16( fp->nb_antennas_rx*sizeof(int16_t*) );
for (i=0; i<fp->nb_antennas_rx; i++) {
common_vars->rxdata[i] = (int32_t*) malloc16_clear( (fp->samples_per_tti*10+2048)*sizeof(int32_t) );
common_vars->common_vars_rx_data_per_thread[0].rxdataF[i] = (int32_t*)malloc16_clear( sizeof(int32_t)*(fp->ofdm_symbol_size*14) );
common_vars->common_vars_rx_data_per_thread[1].rxdataF[i] = (int32_t*)malloc16_clear( sizeof(int32_t)*(fp->ofdm_symbol_size*14) );
if (ue->sidelink_active == 1) common_vars->rxdata_syncSL[i] = (int16_t*)malloc16_clear(((40*fp->samples_per_tti)+2048)*2*sizeof(int16_t));
}
......@@ -1025,38 +1029,272 @@ void init_lte_ue_transport(PHY_VARS_UE *ue,int abstraction_flag) {
void free_ue_resources(PHY_VARS_UE *ue) {
for (int aa=0;aa<ue->frame_parms.nb_antennas_rx;aa++) {
free(ue->sl_rxdataF[aa]);
free(ue->sl_rxdata_7_5kHz[aa]);
free(ue->pusch_slcch->rxdataF_ext[aa]);
free(ue->pusch_slcch->drs_ch_estimates[aa]);
free(ue->pusch_slcch->rxdataF_comp[aa]);
free(ue->pusch_slcch->ul_ch_mag[aa]);
free(ue->pusch_slsch->rxdataF_ext[aa]);
free(ue->pusch_slsch->drs_ch_estimates[aa]);
free(ue->pusch_slsch->rxdataF_comp[aa]);
free(ue->pusch_slsch->ul_ch_mag[aa]);
free(ue->pusch_sldch->rxdataF_ext[aa]);
free(ue->pusch_sldch->drs_ch_estimates[aa]);
free(ue->pusch_sldch->rxdataF_comp[aa]);
free(ue->pusch_sldch->ul_ch_mag[aa]);
LTE_DL_FRAME_PARMS *fp = &ue->frame_parms;
LTE_UE_COMMON* const common_vars = &ue->common_vars;
LTE_UE_PDSCH** const pdsch_vars_SI = ue->pdsch_vars_SI;
LTE_UE_PDSCH** const pdsch_vars_ra = ue->pdsch_vars_ra;
LTE_UE_PDSCH** const pdsch_vars_p = ue->pdsch_vars_p;
LTE_UE_PDSCH** const pdsch_vars_mch = ue->pdsch_vars_MCH;
LTE_UE_PDSCH* (*pdsch_vars_th)[][NUMBER_OF_CONNECTED_eNB_MAX+1] = &ue->pdsch_vars;
LTE_UE_PDCCH* (*pdcch_vars_th)[][NUMBER_OF_CONNECTED_eNB_MAX] = &ue->pdcch_vars;
LTE_UE_PBCH** const pbch_vars = ue->pbch_vars;
LTE_UE_PRACH** const prach_vars = ue->prach_vars;
for (int i=0; i<fp->nb_antennas_tx; i++) {
free(common_vars->txdata[i]);
free(common_vars->txdataF[i]);
}
free(common_vars->txdata);
free(common_vars->txdataF);
// init RX buffers
for (int i=0; i<fp->nb_antennas_rx; i++) {
free(common_vars->rxdata[i]);
free(common_vars->common_vars_rx_data_per_thread[0].rxdataF[i]);
free(common_vars->common_vars_rx_data_per_thread[1].rxdataF[i]);
if (ue->sidelink_active == 1) free(common_vars->rxdata_syncSL[i]);
}
free(common_vars->rxdata);
free(common_vars->common_vars_rx_data_per_thread[0].rxdataF);
free(common_vars->common_vars_rx_data_per_thread[1].rxdataF);
if (ue->sidelink_active==1) free(common_vars->rxdata_syncSL);
int eNB_id;
// Channel estimates
for (eNB_id=0; eNB_id<7; eNB_id++) {
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free(common_vars->common_vars_rx_data_per_thread[th_id].dl_ch_estimates[eNB_id]);
free(common_vars->common_vars_rx_data_per_thread[th_id].dl_ch_estimates_time[eNB_id]);
}
for (int i=0; i<fp->nb_antennas_rx; i++)
for (int j=0; j<4; j++) {
int idx = (j<<1) + i;
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free(common_vars->common_vars_rx_data_per_thread[th_id].dl_ch_estimates[eNB_id][idx]);
free(common_vars->common_vars_rx_data_per_thread[th_id].dl_ch_estimates_time[eNB_id][idx]);
}
}
}
// DLSCH
for (eNB_id=0; eNB_id<ue->n_connected_eNB; eNB_id++) {
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]);
}
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdcch_vars_th)[th_id][eNB_id]);
}
free(pdsch_vars_SI[eNB_id]);
free(pdsch_vars_ra[eNB_id]);
free(pdsch_vars_p[eNB_id]);
free(pdsch_vars_mch[eNB_id]);
free(prach_vars[eNB_id]);
free(pbch_vars[eNB_id]);
#ifdef Rel14
free(ue->pscch_vars_tx);
free(ue->pscch_vars_rx);
#endif
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]->llr_shifts);
free((*pdsch_vars_th)[th_id][eNB_id]->llr_shifts_p);
free((*pdsch_vars_th)[th_id][eNB_id]->llr[1]);
free((*pdsch_vars_th)[th_id][eNB_id]->llr128_2ndstream);
free((*pdsch_vars_th)[th_id][eNB_id]->rho);
}
for (int i=0; i<fp->nb_antennas_rx; i++){
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]->rho[i]);
}
}
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_rho2_ext);
}
for (int i=0; i<fp->nb_antennas_rx; i++)
for (int j=0; j<4; j++) {
const int idx = (j<<1)+i;
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_rho2_ext[idx]);
}
}
//const size_t num = 7*2*fp->N_RB_DL*12+4;
for (int k=0;k<8;k++) { //harq_pid
for (int l=0;l<8;l++) { //round
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]->rxdataF_comp1[k][l]);
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_rho_ext[k][l]);
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_mag1[k][l]);
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_magb1[k][l]);
}
for (int i=0; i<fp->nb_antennas_rx; i++)
for (int j=0; j<4; j++) { //frame_parms->nb_antennas_tx; j++)
const int idx = (j<<1)+i;
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_rho_ext[k][l][idx]);
free((*pdsch_vars_th)[th_id][eNB_id]->rxdataF_comp1[k][l][idx]);
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_mag1[k][l][idx]);
free((*pdsch_vars_th)[th_id][eNB_id]->dl_ch_magb1[k][l][idx]);
}
}
}
}
// 100 PRBs * 12 REs/PRB * 4 PDCCH SYMBOLS * 2 LLRs/RE
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdcch_vars_th)[th_id][eNB_id]->llr);
free((*pdcch_vars_th)[th_id][eNB_id]->llr16);
free((*pdcch_vars_th)[th_id][eNB_id]->wbar);
free((*pdcch_vars_th)[th_id][eNB_id]->e_rx);
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_comp);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_rho_ext);
free((*pdcch_vars_th)[th_id][eNB_id]->rho);
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_ext);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_estimates_ext);
}
for (int i=0; i<fp->nb_antennas_rx; i++) {
//ue_pdcch_vars[eNB_id]->rho[i] = (int32_t*)malloc16_clear( sizeof(int32_t)*(fp->N_RB_DL*12*7*2) );
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdcch_vars_th)[th_id][eNB_id]->rho[i]);
}
for (int j=0; j<4; j++) { //fp->nb_antennas_tx; j++)
int idx = (j<<1)+i;
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_comp[idx]);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_rho_ext[idx]);
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_ext[idx]);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_estimates_ext[idx]);
}
}
}
// 100 PRBs * 12 REs/PRB * 4 PDCCH SYMBOLS * 2 LLRs/RE
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdcch_vars_th)[th_id][eNB_id]->llr);
free((*pdcch_vars_th)[th_id][eNB_id]->llr16);
free((*pdcch_vars_th)[th_id][eNB_id]->wbar);
free((*pdcch_vars_th)[th_id][eNB_id]->e_rx);
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_comp);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_rho_ext);
free((*pdcch_vars_th)[th_id][eNB_id]->rho);
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_ext);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_estimates_ext);
}
for (int i=0; i<fp->nb_antennas_rx; i++) {
//ue_pdcch_vars[eNB_id]->rho[i] = (int32_t*)malloc16_clear( sizeof(int32_t)*(fp->N_RB_DL*12*7*2) );
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdcch_vars_th)[th_id][eNB_id]->rho[i]);
}
for (int j=0; j<4; j++) { //fp->nb_antennas_tx; j++)
int idx = (j<<1)+i;
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_comp[idx]);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_rho_ext[idx]);
free((*pdcch_vars_th)[th_id][eNB_id]->rxdataF_ext[idx]);
free((*pdcch_vars_th)[th_id][eNB_id]->dl_ch_estimates_ext[idx]);
}
}
}
// PBCH
free(pbch_vars[eNB_id]->rxdataF_ext);
free(pbch_vars[eNB_id]->rxdataF_comp);
free(pbch_vars[eNB_id]->dl_ch_estimates_ext);
free(pbch_vars[eNB_id]->llr);
free(prach_vars[eNB_id]->prachF);
free(prach_vars[eNB_id]->prach);
for (int i=0; i<fp->nb_antennas_rx; i++) {
free(pbch_vars[eNB_id]->rxdataF_ext[i]);
for (int j=0; j<4; j++) {//fp->nb_antennas_tx;j++) {
int idx = (j<<1)+i;
free(pbch_vars[eNB_id]->rxdataF_comp[idx]);
free(pbch_vars[eNB_id]->dl_ch_estimates_ext[idx]);
}
}
free(pbch_vars[eNB_id]->decoded_output);
}
// initialization for the last instance of pdsch_vars (used for MU-MIMO)
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]);
}
free(pdsch_vars_SI[eNB_id]);
free(pdsch_vars_ra[eNB_id]);
free(pdsch_vars_p[eNB_id]);
for (int th_id=0; th_id<RX_NB_TH_MAX; th_id++) {
free((*pdsch_vars_th)[th_id][eNB_id]->llr[1]);
}
free(ue->sinr_CQI_dB);
if (ue->sidelink_active == 1) {
for (int aa=0;aa<ue->frame_parms.nb_antennas_rx;aa++) {
free(ue->sl_rxdataF[aa]);
free(ue->sl_rxdata_7_5kHz[aa]);
free(ue->pusch_slcch->rxdataF_ext[aa]);
free(ue->pusch_slcch->drs_ch_estimates[aa]);
free(ue->pusch_slcch->rxdataF_comp[aa]);
free(ue->pusch_slcch->ul_ch_mag[aa]);
free(ue->pusch_slsch->rxdataF_ext[aa]);
free(ue->pusch_slsch->drs_ch_estimates[aa]);
free(ue->pusch_slsch->rxdataF_comp[aa]);
free(ue->pusch_slsch->ul_ch_mag[aa]);
free(ue->pusch_sldch->rxdataF_ext[aa]);
free(ue->pusch_sldch->drs_ch_estimates[aa]);
free(ue->pusch_sldch->rxdataF_comp[aa]);
free(ue->pusch_sldch->ul_ch_mag[aa]);
}
}
if (ue->sidelink_active == 1) {
free(ue->sl_rxdataF);
free(ue->sl_rxdata_7_5kHz);
free(ue->pusch_slcch->rxdataF_ext);
free(ue->pusch_slcch->drs_ch_estimates);
free(ue->pusch_slcch->rxdataF_comp);
free(ue->pusch_slcch->ul_ch_mag);
free(ue->pusch_slsch->rxdataF_ext);
free(ue->pusch_slsch->drs_ch_estimates);
free(ue->pusch_slsch->rxdataF_comp);
free(ue->pusch_slsch->ul_ch_mag);
free(ue->pusch_sldch->rxdataF_ext);
free(ue->pusch_sldch->drs_ch_estimates);
free(ue->pusch_sldch->rxdataF_comp);
free(ue->pusch_sldch->ul_ch_mag);
free(ue->slsch_dlsch_llr);
free(ue->slsch_ulsch_llr);
free(ue->sldch_dlsch_llr);
free(ue->sldch_ulsch_llr);
}
free(ue->sl_rxdataF);
free(ue->sl_rxdata_7_5kHz);
free(ue->pusch_slcch->rxdataF_ext);
free(ue->pusch_slcch->drs_ch_estimates);
free(ue->pusch_slcch->rxdataF_comp);
free(ue->pusch_slcch->ul_ch_mag);
free(ue->pusch_slsch->rxdataF_ext);
free(ue->pusch_slsch->drs_ch_estimates);
free(ue->pusch_slsch->rxdataF_comp);
free(ue->pusch_slsch->ul_ch_mag);
free(ue->pusch_sldch->rxdataF_ext);
free(ue->pusch_sldch->drs_ch_estimates);
free(ue->pusch_sldch->rxdataF_comp);
free(ue->pusch_sldch->ul_ch_mag);
free(ue->slsch_dlsch_llr);
free(ue->slsch_ulsch_llr);
free(ue->sldch_dlsch_llr);
free(ue->sldch_ulsch_llr);
}
openair1/PHY/INIT/lte_param_init.c
View file @ 79b6e1d8
......@@ -51,7 +51,9 @@ void lte_param_init(PHY_VARS_eNB **eNBp,
uint8_t pa,
uint8_t threequarter_fs,
uint8_t osf,
uint32_t perfect_ce)
uint32_t perfect_ce,
uint8_t sidelink_active,
uint8_t SLonly)
{
LTE_DL_FRAME_PARMS *frame_parms;
......@@ -143,6 +145,9 @@ void lte_param_init(PHY_VARS_eNB **eNBp,
UE->measurements.adj_cell_id[1] = Nid_cell+2;
for (i=0; i<3; i++)
lte_gold(frame_parms,UE->lte_gold_table[i],Nid_cell+i);
UE->sidelink_active = sidelink_active;
UE->SLonly = SLonly;
printf("Calling init_lte_ue_signal\n");
init_lte_ue_signal(UE,1,0);
generate_pcfich_reg_mapping(&UE->frame_parms);
......
openair1/PHY/LTE_ESTIMATION/defs.h
View file @ 79b6e1d8
......@@ -62,6 +62,10 @@ int lte_sync_time(int **rxdata,
LTE_DL_FRAME_PARMS *frame_parms,
int *eNB_id);
int lte_sync_timeSL(PHY_VARS_UE *ue,
int *ind,
int64_t *lev,
int64_t *avg);
/*!
\brief This function performs the coarse frequency and PSS synchronization.
The algorithm uses a frequency-domain correlation. It scans over 20 MHz/10ms signal chunks using each of the 3 PSS finding the most likely (strongest) carriers and their frequency offset (+-2.5 kHz).
......
openair1/PHY/LTE_ESTIMATION/lte_sync_time.c
View file @ 79b6e1d8
......@@ -40,11 +40,11 @@
#endif
//#define DEBUG_PHY
int* sync_corr_ue0 = NULL;
int* sync_corr_ue1 = NULL;
int* sync_corr_ue2 = NULL;
int sync_tmp[2048*4] __attribute__((aligned(32)));
short syncF_tmp[2048*2] __attribute__((aligned(32)));
int32_t* sync_corr_ue0 = NULL;
int32_t* sync_corr_ue1 = NULL;
int32_t* sync_corr_ue2 = NULL;
int32_t sync_tmp[2048*4] __attribute__((aligned(32)));
int16_t syncF_tmp[2048*2] __attribute__((aligned(32)));
......@@ -53,9 +53,9 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
int i,k;
sync_corr_ue0 = (int *)malloc16(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*sizeof(int)*frame_parms->samples_per_tti);
sync_corr_ue1 = (int *)malloc16(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*sizeof(int)*frame_parms->samples_per_tti);
sync_corr_ue2 = (int *)malloc16(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*sizeof(int)*frame_parms->samples_per_tti);
sync_corr_ue0 = (int32_t *)malloc16(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*sizeof(int32_t)*frame_parms->samples_per_tti);
sync_corr_ue1 = (int32_t *)malloc16(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*sizeof(int32_t)*frame_parms->samples_per_tti);
sync_corr_ue2 = (int32_t *)malloc16(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*sizeof(int32_t)*frame_parms->samples_per_tti);
if (sync_corr_ue0) {
#ifdef DEBUG_PHY
......@@ -96,10 +96,8 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
#ifdef DEBUG_PHY
LOG_D(PHY,"[openair][LTE_PHY][SYNC] primary_synch0_time allocated at %p\n", primary_synch0_time);
#endif
} else {
LOG_E(PHY,"[openair][LTE_PHY][SYNC] primary_synch0_time not allocated\n");
return(-1);
}
} else AssertFatal(1==0,"primary_synch0_time not allocated\n");
// primary_synch1_time = (int *)malloc16((frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples)*sizeof(int));
primary_synch1_time = (int16_t *)malloc16((frame_parms->ofdm_symbol_size)*sizeof(int16_t)*2);
......@@ -110,10 +108,7 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
#ifdef DEBUG_PHY
LOG_D(PHY,"[openair][LTE_PHY][SYNC] primary_synch1_time allocated at %p\n", primary_synch1_time);
#endif
} else {
LOG_E(PHY,"[openair][LTE_PHY][SYNC] primary_synch1_time not allocated\n");
return(-1);
}
} else AssertFatal(1==0,"primary_synch1_time not allocated\n");
// primary_synch2_time = (int *)malloc16((frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples)*sizeof(int));
primary_synch2_time = (int16_t *)malloc16((frame_parms->ofdm_symbol_size)*sizeof(int16_t)*2);
......@@ -124,10 +119,29 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
#ifdef DEBUG_PHY
LOG_D(PHY,"[openair][LTE_PHY][SYNC] primary_synch2_time allocated at %p\n", primary_synch2_time);
#endif
} else {
LOG_E(PHY,"[openair][LTE_PHY][SYNC] primary_synch2_time not allocated\n");
return(-1);
}
} else AssertFatal(1==0,"primary_synch2_time not allocated\n");
primary_synch0SL_time = (int16_t *)malloc16((frame_parms->ofdm_symbol_size)*sizeof(int16_t)*2);
if (primary_synch0SL_time) {
// bzero(primary_synch0_time,(frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples)*sizeof(int));
bzero(primary_synch0SL_time,(frame_parms->ofdm_symbol_size)*sizeof(int16_t)*2);
#ifdef DEBUG_PHY
LOG_D(PHY,"[openair][LTE_PHY][SYNC] primary_synch0SL_time allocated at %p\n", primary_synch0SL_time);
#endif
} else AssertFatal(1==0,"primary_synch0SL_time not allocated\n");
// primary_synch1_time = (int *)malloc16((frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples)*sizeof(int));
primary_synch1SL_time = (int16_t *)malloc16((frame_parms->ofdm_symbol_size)*sizeof(int16_t)*2);
if (primary_synch1SL_time) {
// bzero(primary_synch1_time,(frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples)*sizeof(int));
bzero(primary_synch1SL_time,(frame_parms->ofdm_symbol_size)*sizeof(int16_t)*2);
#ifdef DEBUG_PHY
LOG_D(PHY,"[openair][LTE_PHY][SYNC] primary_synch1SL_time allocated at %p\n", primary_synch1SL_time);
#endif
} else AssertFatal(1==0,"primary_synch1SL_time not allocated\n");
// generate oversampled sync_time sequences
......@@ -146,29 +160,29 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
switch (frame_parms->N_RB_DL) {
case 6:
idft128((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft128((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 25:
idft512((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft512((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 50:
idft1024((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft1024((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 75:
idft1536((short*)syncF_tmp, /// complex input
(short*)sync_tmp,
idft1536((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp,
1); /// complex output
break;
case 100:
idft2048((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft2048((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
default:
......@@ -194,29 +208,29 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
switch (frame_parms->N_RB_DL) {
case 6:
idft128((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft128((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 25:
idft512((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft512((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 50:
idft1024((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft1024((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 75:
idft1536((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft1536((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 100:
idft2048((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft2048((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
default:
......@@ -242,29 +256,29 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
switch (frame_parms->N_RB_DL) {
case 6:
idft128((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft128((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 25:
idft512((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft512((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 50:
idft1024((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft1024((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 75:
idft1536((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft1536((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 100:
idft2048((short*)syncF_tmp, /// complex input
(short*)sync_tmp, /// complex output
idft2048((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
default:
......@@ -275,14 +289,108 @@ int lte_sync_time_init(LTE_DL_FRAME_PARMS *frame_parms ) // LTE_UE_COMMON *com
for (i=0; i<frame_parms->ofdm_symbol_size; i++)
((int32_t*)primary_synch2_time)[i] = sync_tmp[i];
k=frame_parms->ofdm_symbol_size-36;
for (i=0; i<72; i++) {
syncF_tmp[2*k] = primary_synch0SL[2*i]>>2; //we need to shift input to avoid overflow in fft
syncF_tmp[2*k+1] = primary_synch0SL[2*i+1]>>2;
k++;
if (k >= frame_parms->ofdm_symbol_size) {
k-=frame_parms->ofdm_symbol_size;
}
}
#ifdef DEBUG_PHY
switch (frame_parms->N_RB_DL) {
case 6:
idft128((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 25:
idft512((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 50:
idft1024((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 75:
idft1536((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp,
1); /// complex output
break;
case 100:
idft2048((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
default:
LOG_E(PHY,"Unsupported N_RB_DL %d\n",frame_parms->N_RB_DL);
break;
}
for (i=0; i<frame_parms->ofdm_symbol_size; i++)
((int32_t*)primary_synch0SL_time)[i] = sync_tmp[i];
k=frame_parms->ofdm_symbol_size-36;
for (i=0; i<72; i++) {
syncF_tmp[2*k] = primary_synch1SL[2*i]>>2; //we need to shift input to avoid overflow in fft
syncF_tmp[2*k+1] = primary_synch1SL[2*i+1]>>2;
k++;
if (k >= frame_parms->ofdm_symbol_size) {
k-=frame_parms->ofdm_symbol_size;
}
}
switch (frame_parms->N_RB_DL) {
case 6:
idft128((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 25:
idft512((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 50:
idft1024((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 75:
idft1536((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
case 100:
idft2048((int16_t*)syncF_tmp, /// complex input
(int16_t*)sync_tmp, /// complex output
1);
break;
default:
LOG_E(PHY,"Unsupported N_RB_DL %d\n",frame_parms->N_RB_DL);
break;
}
for (i=0; i<frame_parms->ofdm_symbol_size; i++)
((int32_t*)primary_synch1SL_time)[i] = sync_tmp[i];
/*
write_output("primary_sync0.m","psync0",primary_synch0_time,frame_parms->ofdm_symbol_size,1,1);
write_output("primary_sync1.m","psync1",primary_synch1_time,frame_parms->ofdm_symbol_size,1,1);
write_output("primary_sync2.m","psync2",primary_synch2_time,frame_parms->ofdm_symbol_size,1,1);
#endif
write_output("primary_syncSL0.m","psyncSL0",primary_synch0SL_time,frame_parms->ofdm_symbol_size,1,1);
write_output("primary_syncSL1.m","psyncSL1",primary_synch1SL_time,frame_parms->ofdm_symbol_size,1,1);
*/
return (1);
}
......@@ -321,6 +429,17 @@ void lte_sync_time_free(void)
free(primary_synch2_time);
}
if (primary_synch0SL_time) {
LOG_D(PHY,"Freeing primary_sync0SL_time ...\n");
free(primary_synch0SL_time);
}
if (primary_synch1SL_time) {
LOG_D(PHY,"Freeing primary_sync1SL_time ...\n");
free(primary_synch1SL_time);
}
sync_corr_ue0 = NULL;
sync_corr_ue1 = NULL;
sync_corr_ue2 = NULL;
......@@ -329,9 +448,9 @@ void lte_sync_time_free(void)
primary_synch2_time = NULL;
}
static inline int abs32(int x)
static inline int32_t abs32(int32_t x)
{
return (((int)((short*)&x)[0])*((int)((short*)&x)[0]) + ((int)((short*)&x)[1])*((int)((short*)&x)[1]));
return (((int32_t)((int16_t*)&x)[0])*((int32_t)((int16_t*)&x)[0]) + ((int32_t)((int16_t*)&x)[1])*((int32_t)((int16_t*)&x)[1]));
}
#ifdef DEBUG_PHY
......@@ -350,9 +469,9 @@ int lte_sync_time(int **rxdata, ///rx data in time domain
// perform a time domain correlation using the oversampled sync sequence
unsigned int n, ar, s, peak_pos, peak_val, sync_source;
int result,result2;
int sync_out[3] = {0,0,0},sync_out2[3] = {0,0,0};
int tmp[3] = {0,0,0};
int32_t result,result2;
int32_t sync_out[3] = {0,0,0},sync_out2[3] = {0,0,0};
int32_t tmp[3] = {0,0,0};
int length = LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*frame_parms->samples_per_tti>>1;
//LOG_D(PHY,"[SYNC TIME] Calling sync_time.\n");
......@@ -396,45 +515,45 @@ int lte_sync_time(int **rxdata, ///rx data in time domain
//calculate dot product of primary_synch0_time and rxdata[ar][n] (ar=0..nb_ant_rx) and store the sum in temp[n];
for (ar=0; ar<frame_parms->nb_antennas_rx; ar++) {
result = dot_product((short*)primary_synch0_time, (short*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
result2 = dot_product((short*)primary_synch0_time, (short*) &(rxdata[ar][n+length]), frame_parms->ofdm_symbol_size, SHIFT);
((short*)sync_corr_ue0)[2*n] += ((short*) &result)[0];
((short*)sync_corr_ue0)[2*n+1] += ((short*) &result)[1];
((short*)sync_corr_ue0)[2*(length+n)] += ((short*) &result2)[0];
((short*)sync_corr_ue0)[(2*(length+n))+1] += ((short*) &result2)[1];
((short*)sync_out)[0] += ((short*) &result)[0];
((short*)sync_out)[1] += ((short*) &result)[1];
((short*)sync_out2)[0] += ((short*) &result2)[0];
((short*)sync_out2)[1] += ((short*) &result2)[1];
result = dot_product((int16_t*)primary_synch0_time, (int16_t*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
result2 = dot_product((int16_t*)primary_synch0_time, (int16_t*) &(rxdata[ar][n+length]), frame_parms->ofdm_symbol_size, SHIFT);
((int16_t*)sync_corr_ue0)[2*n] += ((int16_t*) &result)[0];
((int16_t*)sync_corr_ue0)[2*n+1] += ((int16_t*) &result)[1];
((int16_t*)sync_corr_ue0)[2*(length+n)] += ((int16_t*) &result2)[0];
((int16_t*)sync_corr_ue0)[(2*(length+n))+1] += ((int16_t*) &result2)[1];
((int16_t*)sync_out)[0] += ((int16_t*) &result)[0];
((int16_t*)sync_out)[1] += ((int16_t*) &result)[1];
((int16_t*)sync_out2)[0] += ((int16_t*) &result2)[0];
((int16_t*)sync_out2)[1] += ((int16_t*) &result2)[1];
}
for (ar=0; ar<frame_parms->nb_antennas_rx; ar++) {
result = dot_product((short*)primary_synch1_time, (short*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
result2 = dot_product((short*)primary_synch1_time, (short*) &(rxdata[ar][n+length]), frame_parms->ofdm_symbol_size, SHIFT);
((short*)sync_corr_ue1)[2*n] += ((short*) &result)[0];
((short*)sync_corr_ue1)[2*n+1] += ((short*) &result)[1];
((short*)sync_corr_ue1)[2*(length+n)] += ((short*) &result2)[0];
((short*)sync_corr_ue1)[(2*(length+n))+1] += ((short*) &result2)[1];
((short*)sync_out)[2] += ((short*) &result)[0];
((short*)sync_out)[3] += ((short*) &result)[1];
((short*)sync_out2)[2] += ((short*) &result2)[0];
((short*)sync_out2)[3] += ((short*) &result2)[1];
result = dot_product((int16_t*)primary_synch1_time, (int16_t*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
result2 = dot_product((int16_t*)primary_synch1_time, (int16_t*) &(rxdata[ar][n+length]), frame_parms->ofdm_symbol_size, SHIFT);
((int16_t*)sync_corr_ue1)[2*n] += ((int16_t*) &result)[0];
((int16_t*)sync_corr_ue1)[2*n+1] += ((int16_t*) &result)[1];
((int16_t*)sync_corr_ue1)[2*(length+n)] += ((int16_t*) &result2)[0];
((int16_t*)sync_corr_ue1)[(2*(length+n))+1] += ((int16_t*) &result2)[1];
((int16_t*)sync_out)[2] += ((int16_t*) &result)[0];
((int16_t*)sync_out)[3] += ((int16_t*) &result)[1];
((int16_t*)sync_out2)[2] += ((int16_t*) &result2)[0];
((int16_t*)sync_out2)[3] += ((int16_t*) &result2)[1];
}
for (ar=0; ar<frame_parms->nb_antennas_rx; ar++) {
result = dot_product((short*)primary_synch2_time, (short*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
result2 = dot_product((short*)primary_synch2_time, (short*) &(rxdata[ar][n+length]), frame_parms->ofdm_symbol_size, SHIFT);
((short*)sync_corr_ue2)[2*n] += ((short*) &result)[0];
((short*)sync_corr_ue2)[2*n+1] += ((short*) &result)[1];
((short*)sync_corr_ue2)[2*(length+n)] += ((short*) &result2)[0];
((short*)sync_corr_ue2)[(2*(length+n))+1] += ((short*) &result2)[1];
((short*)sync_out)[4] += ((short*) &result)[0];
((short*)sync_out)[5] += ((short*) &result)[1];
((short*)sync_out2)[4] += ((short*) &result2)[0];
((short*)sync_out2)[5] += ((short*) &result2)[1];
result = dot_product((int16_t*)primary_synch2_time, (int16_t*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
result2 = dot_product((int16_t*)primary_synch2_time, (int16_t*) &(rxdata[ar][n+length]), frame_parms->ofdm_symbol_size, SHIFT);
((int16_t*)sync_corr_ue2)[2*n] += ((int16_t*) &result)[0];
((int16_t*)sync_corr_ue2)[2*n+1] += ((int16_t*) &result)[1];
((int16_t*)sync_corr_ue2)[2*(length+n)] += ((int16_t*) &result2)[0];
((int16_t*)sync_corr_ue2)[(2*(length+n))+1] += ((int16_t*) &result2)[1];
((int16_t*)sync_out)[4] += ((int16_t*) &result)[0];
((int16_t*)sync_out)[5] += ((int16_t*) &result)[1];
((int16_t*)sync_out2)[4] += ((int16_t*) &result2)[0];
((int16_t*)sync_out2)[5] += ((int16_t*) &result2)[1];
}
}
......@@ -487,6 +606,119 @@ int lte_sync_time(int **rxdata, ///rx data in time domain
}
int lte_sync_timeSL(PHY_VARS_UE *ue,
int *ind,
int64_t *lev,
int64_t *avg)
{
LTE_DL_FRAME_PARMS *frame_parms = &ue->frame_parms;
// perform a time domain correlation using the oversampled sync sequence
int length = 4*LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*frame_parms->samples_per_tti;
int32_t sync_corr0[frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples];
int32_t sync_corr1[frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples];
// circular copy of beginning to end of rxdata buffer. Note: buffer should be big enough upon calling this function
for (int ar=0;ar<frame_parms->nb_antennas_rx;ar++) memcpy((void*)&ue->common_vars.rxdata_syncSL[ar][2*length],
(void*)&ue->common_vars.rxdata_syncSL[ar][0],
frame_parms->ofdm_symbol_size);
int32_t tmp0,tmp1;
int32_t magtmp0,magtmp1,lev0,lev1,maxlev0=0,maxlev1=0;
int maxpos0=0,maxpos1=0;
int64_t avg0=0,avg1=0;
int32_t result;
int32_t **rxdata = ue->common_vars.rxdata_syncSL; ///rx data in time domain
RU_t ru_tmp;
int16_t **rxdata_7_5kHz = ue->sl_rxdata_7_5kHz;
memset((void*)&ru_tmp,0,sizeof(RU_t));
memcpy((void*)&ru_tmp.frame_parms,(void*)&ue->frame_parms,sizeof(LTE_DL_FRAME_PARMS));
ru_tmp.N_TA_offset=0;
ru_tmp.common.rxdata = rxdata;
ru_tmp.common.rxdata_7_5kHz = (int32_t**)rxdata_7_5kHz;
ru_tmp.nb_rx = frame_parms->nb_antennas_rx;
// remove 7.5 kHz
for (int slot=0;slot<80;slot++) {
remove_7_5_kHz(&ru_tmp,slot);
for (int ar=0;ar<frame_parms->nb_antennas_rx;ar++) {
memcpy((void*)&rxdata[ar][slot*2*(frame_parms->samples_per_tti/2)],
(void*)&rxdata_7_5kHz[ar][(slot&1)*2*(frame_parms->samples_per_tti/2)],
sizeof(int16_t)*(2*frame_parms->samples_per_tti/2));
}
}
for (int n=0; n<length; n+=4) {
int nprime = n % (frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples);
tmp0 = 0;
tmp1 = 0;
//calculate dot product of primary_synch0_time and rxdata[ar][n] (ar=0..nb_ant_rx) and store the sum in temp[n];
for (int ar=0; ar<frame_parms->nb_antennas_rx; ar++) {
result = dot_product((int16_t*)primary_synch0SL_time, (int16_t*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
((int16_t*)&tmp0)[0] += ((int16_t*) &result)[0];
((int16_t*)&tmp0)[1] += ((int16_t*) &result)[1];
result = dot_product((int16_t*)primary_synch1SL_time, (int16_t*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
((int16_t*)&tmp1)[0] += ((int16_t*) &result)[0];
((int16_t*)&tmp1)[1] += ((int16_t*) &result)[1];
}
// tmpi holds <synchi,rx0>+<synci,rx1>+...+<synchi,rx_{nbrx-1}>
magtmp0 = abs32(tmp0);
magtmp1 = abs32(tmp1);
// this does max |tmpi(n)|^2 + |tmpi(n-L)|^2 and argmax |tmpi(n)|^2 + |tmpi(n-L)|^2
if (n>(frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples)) {
// if (n<4096) printf("syncSL: sample %d (nprime %d) : , mag0 %d, prev0 %d, mag1 %d, prev1 %d\n",
// n,nprime,magtmp0,sync_corr0[nprime],magtmp1,sync_corr1[nprime]);
lev0 = magtmp0 + sync_corr0[nprime];
lev1 = magtmp1 + sync_corr1[nprime];
if (lev0>maxlev0) { maxlev0 = lev0; maxpos0 = n-(frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples); }
if (lev1>maxlev1) { maxlev1 = lev1; maxpos1 = n-(frame_parms->ofdm_symbol_size+frame_parms->nb_prefix_samples); }
avg0 += magtmp0;
avg1 += magtmp1;
}
sync_corr0[nprime]=magtmp0;
sync_corr1[nprime]=magtmp1;
}
avg0/=length;
avg1/=length;
// PSS in symbol 1
int pssoffset = frame_parms->ofdm_symbol_size + frame_parms->nb_prefix_samples0 + frame_parms->nb_prefix_samples;
if (maxlev0 > maxlev1) {
if ((int64_t)maxlev0 > (5*avg0)) {*lev = maxlev0; *ind=0; *avg=avg0; return((length+maxpos0-pssoffset)%length);};
}
else {
if ((int64_t)maxlev1 > (5*avg1)) {*lev = maxlev1; *ind=1; *avg=avg1; return((length+maxpos1-pssoffset)%length);};
}
return(-1);
}
//#define DEBUG_PHY
int lte_sync_time_eNB(int32_t **rxdata, ///rx data in time domain
......@@ -501,7 +733,7 @@ int lte_sync_time_eNB(int32_t **rxdata, ///rx data in time domain
unsigned int n, ar, peak_val, peak_pos;
uint64_t mean_val;
int result;
short *primary_synch_time;
int16_t *primary_synch_time;
int eNB_id = frame_parms->Nid_cell%3;
// LOG_E(PHY,"[SYNC TIME] Calling sync_time_eNB(%p,%p,%d,%d)\n",rxdata,frame_parms,eNB_id,length);
......@@ -512,15 +744,15 @@ int lte_sync_time_eNB(int32_t **rxdata, ///rx data in time domain
switch (eNB_id) {
case 0:
primary_synch_time = (short*)primary_synch0_time;
primary_synch_time = (int16_t*)primary_synch0_time;
break;
case 1:
primary_synch_time = (short*)primary_synch1_time;
primary_synch_time = (int16_t*)primary_synch1_time;
break;
case 2:
primary_synch_time = (short*)primary_synch2_time;
primary_synch_time = (int16_t*)primary_synch2_time;
break;
default:
......@@ -541,9 +773,9 @@ int lte_sync_time_eNB(int32_t **rxdata, ///rx data in time domain
//calculate dot product of primary_synch0_time and rxdata[ar][n] (ar=0..nb_ant_rx) and store the sum in temp[n];
for (ar=0; ar<frame_parms->nb_antennas_rx; ar++) {
result = dot_product((short*)primary_synch_time, (short*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
//((short*)sync_corr)[2*n] += ((short*) &result)[0];
//((short*)sync_corr)[2*n+1] += ((short*) &result)[1];
result = dot_product((int16_t*)primary_synch_time, (int16_t*) &(rxdata[ar][n]), frame_parms->ofdm_symbol_size, SHIFT);
//((int16_t*)sync_corr)[2*n] += ((int16_t*) &result)[0];
//((int16_t*)sync_corr)[2*n+1] += ((int16_t*) &result)[1];
sync_corr_eNB[n] += abs32(result);
}
......
openair1/PHY/LTE_TRANSPORT/slbch.c
View file @ 79b6e1d8
......@@ -84,7 +84,9 @@ int generate_slbch(int32_t **txdataF,
for (symb=0;symb<10;symb++) {
k = (frame_parms->ofdm_symbol_size<<1)-72;
txptr = (int16_t*)&txdataF[0][subframe*Nsymb*frame_parms->ofdm_symbol_size+(symb*frame_parms->ofdm_symbol_size)];
printf("Generating PSBCH in symbol %d offset %d\n",symb,
(subframe*Nsymb*frame_parms->ofdm_symbol_size)+(symb*frame_parms->ofdm_symbol_size));
txptr = (int16_t*)&txdataF[0][(subframe*Nsymb*frame_parms->ofdm_symbol_size)+(symb*frame_parms->ofdm_symbol_size)];
// first half (negative frequencies)
for (int i=0;i<72;i++) {
if (*eptr++ == 1) txptr[k] =-a;
......
openair1/PHY/LTE_TRANSPORT/sldch.c
View file @ 79b6e1d8
......@@ -470,12 +470,13 @@ void sldch_codingmodulation(PHY_VARS_UE *ue,int frame_tx,int subframe_tx,int npr
tx_amp = AMP;
#endif
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
if (ue->generate_ul_signal[subframe_tx][0] == 0)
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
ulsch_modulation(ue->common_vars.txdataF,
tx_amp,
frame_tx,
......
openair1/PHY/LTE_TRANSPORT/slsch.c
View file @ 79b6e1d8
......@@ -455,11 +455,12 @@ void pscch_codingmodulation(PHY_VARS_UE *ue,int frame_tx,int subframe_tx,uint32_
int32_t *txptr;
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
if (ue->generate_ul_signal[subframe_tx][0] == 0)
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
for (int j=0,l=0; l<Nsymb2; l++) {
re_offset = re_offset0;
......@@ -591,11 +592,12 @@ void slsch_codingmodulation(PHY_VARS_UE *ue,UE_rxtx_proc_t *proc,int frame_tx,in
tx_amp = AMP;
#endif
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
if (ue->generate_ul_signal[subframe_tx][0] == 0)
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
ulsch_modulation(ue->common_vars.txdataF,
tx_amp,
......
openair1/PHY/LTE_TRANSPORT/slss.c
View file @ 79b6e1d8
......@@ -43,6 +43,8 @@ void check_and_generate_slss(PHY_VARS_UE *ue,int frame_tx,int subframe_tx) {
int tx_amp;
AssertFatal(slss!=NULL,"slss is null\n");
LOG_I(PHY,"check_and_generate_slss: frame_tx %d, subframe_tx %d : slss->SL_offsetIndicator %d, slss->slmib_length %d\n",
frame_tx,subframe_tx,slss->SL_OffsetIndicator, slss->slmib_length);
......@@ -66,33 +68,37 @@ void check_and_generate_slss(PHY_VARS_UE *ue,int frame_tx,int subframe_tx) {
tx_amp = AMP;
#endif
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
if (ue->generate_ul_signal[subframe_tx][0] == 0)
for (int aa=0; aa<ue->frame_parms.nb_antennas_tx; aa++) {
memset(&ue->common_vars.txdataF[aa][subframe_tx*ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti],
0,
ue->frame_parms.ofdm_symbol_size*ue->frame_parms.symbols_per_tti*sizeof(int32_t));
}
// PSS
generate_slpss(ue->common_vars.txdataF,
tx_amp,
&ue->frame_parms,
1,
subframe_tx
);
);
generate_slpss(ue->common_vars.txdataF,
tx_amp,
&ue->frame_parms,
2,
subframe_tx
);
/*
generate_slbch(ue->common_vars.txdataF,
tx_amp,
&ue->frame_parms,
subframe_tx,
ue->slss->slmib);
*/
generate_slsss(ue->common_vars.txdataF,
subframe_tx,
tx_amp,
......@@ -104,8 +110,9 @@ void check_and_generate_slss(PHY_VARS_UE *ue,int frame_tx,int subframe_tx) {
&ue->frame_parms,
12);
ue->sl_chan = PSBCH;
ue->sl_chan = PSBCH;
generate_drs_pusch(ue,
NULL,
0,
......@@ -117,8 +124,10 @@ void check_and_generate_slss(PHY_VARS_UE *ue,int frame_tx,int subframe_tx) {
NULL,
0);
ue->generate_ul_signal[subframe_tx][0] = 1;
ue->slss_generated = 1;
LOG_D(PHY,"ULSCH (after slss) : signal F energy %d dB (txdataF %p)\n",dB_fixed(signal_energy(&ue->common_vars.txdataF[0][subframe_tx*14*ue->frame_parms.ofdm_symbol_size],14*ue->frame_parms.ofdm_symbol_size)),&ue->common_vars.txdataF[0][subframe_tx*14*ue->frame_parms.ofdm_symbol_size]);
// write_output("txdataF_pre.m","txF_pre",&ue->common_vars.txdataF[0][subframe_tx*14*ue->frame_parms.ofdm_symbol_size],14*ue->frame_parms.ofdm_symbol_size,1,1);
......
openair1/PHY/LTE_TRANSPORT/slsss.c
View file @ 79b6e1d8
......@@ -307,26 +307,30 @@ int rx_slsss(PHY_VARS_UE *ue,int32_t *tot_metric,uint8_t *phase_max,int Nid2,int
#endif
// Do FFTs for SSS/PSS
// SSS
LOG_I(PHY,"Doing SSS detection at offset %d\n",ue->rx_offsetSL);
RU_t ru_tmp;
memset((void*)&ru_tmp,0,sizeof(RU_t));
memcpy((void*)&ru_tmp.frame_parms,(void*)&ue->frame_parms,sizeof(LTE_DL_FRAME_PARMS));
ru_tmp.N_TA_offset=0;
ru_tmp.common.rxdata = ue->common_vars.rxdata;
ru_tmp.common.rxdata_7_5kHz = (int32_t**)rxdata_7_5kHz;
ru_tmp.common.rxdata_7_5kHz = (int32_t**)malloc16(ue->frame_parms.nb_antennas_rx*sizeof(int32_t*));
for (int aa=0;aa<ue->frame_parms.nb_antennas_rx;aa++)
ru_tmp.common.rxdata_7_5kHz[aa] = (int32_t*)&rxdata_7_5kHz[aa][ue->rx_offsetSL*2];
ru_tmp.common.rxdataF = (int32_t**)rxdataF;
ru_tmp.nb_rx = ue->frame_parms.nb_antennas_rx;
remove_7_5_kHz(&ru_tmp,(subframe_rx<<1));
remove_7_5_kHz(&ru_tmp,(subframe_rx<<1)+1);
// remove_7_5_kHz(&ru_tmp,(subframe_rx<<1));
// remove_7_5_kHz(&ru_tmp,(subframe_rx<<1)+1);
// PSS
slot_fep_ul(&ru_tmp,1,0,0);
slot_fep_ul(&ru_tmp,2,0,0);
// SSS
slot_fep_ul(&ru_tmp,11,1,0);
slot_fep_ul(&ru_tmp,12,1,0);
slot_fep_ul(&ru_tmp,4,1,0);
slot_fep_ul(&ru_tmp,5,1,0);
free(ru_tmp.common.rxdata_7_5kHz);
} else { // TDD
AssertFatal(1==0,"TDD not supported for Sidelink\n");
}
......@@ -337,12 +341,12 @@ int rx_slsss(PHY_VARS_UE *ue,int32_t *tot_metric,uint8_t *phase_max,int Nid2,int
pss1_ext,
sss1_ext,
0);
/*
write_output("rxsig0.m","rxs0",&ue->common_vars.rxdata[0][0],ue->frame_parms.samples_per_tti,1,1);
write_output("rxdataF0.m","rxF0",&ue->common_vars.rxdataF[0][0],2*14*ue->frame_parms.ofdm_symbol_size,2,1);
write_output("pss_ext0.m","pssext0",pss_ext,72,1,1);
write_output("rxdataF0.m","rxF0",&rxdataF[0][0],2*14*ue->frame_parms.ofdm_symbol_size,1,1);
write_output("pss_ext0.m","pssext0",pss0_ext,72,1,1);
write_output("sss0_ext0.m","sss0ext0",sss0_ext,72,1,1);
*/
exit(-1);
// get conjugated channel estimate from PSS (symbol 6), H* = R* \cdot PSS
// and do channel estimation and compensation based on PSS
......
openair1/PHY/defs.h
View file @ 79b6e1d8
......@@ -1414,6 +1414,7 @@ typedef struct {
uint8_t destination_id;
// DMRS group-hopping sequences for PSBCH (index 0) and 256 possible PSSCH (indices 1...256)
uint32_t gh[257][20];
uint8_t slss_generated;
uint8_t pscch_coded;
uint8_t pscch_generated;
uint8_t pssch_generated;
......
openair1/PHY/extern.h
View file @ 79b6e1d8
......@@ -63,6 +63,8 @@ extern unsigned char primary_synch2_tab[72];
extern const int16_t *primary_synch0_time; //!< index: [0..ofdm_symbol_size*2[
extern const int16_t *primary_synch1_time; //!< index: [0..ofdm_symbol_size*2[
extern const int16_t *primary_synch2_time; //!< index: [0..ofdm_symbol_size*2[
extern const int16_t *primary_synch0SL_time;
extern const int16_t *primary_synch1SL_time;
extern int *sync_corr_ue0; //!< index [0..10*samples_per_tti[
extern int *sync_corr_ue1; //!< index [0..10*samples_per_tti[
extern int *sync_corr_ue2; //!< index [0..10*samples_per_tti[
......
openair1/PHY/impl_defs_lte.h
View file @ 79b6e1d8
......@@ -977,7 +977,11 @@ typedef struct {
/// - first index: rx antenna [0..nb_antennas_rx[
/// - second index: sample [0..FRAME_LENGTH_COMPLEX_SAMPLES+2048[
int32_t **rxdata;
/// \brief holds the received data vector used for SL primary synchronization (40ms)
/// - first index: rx antenna [0..nb_antennas_rx[
/// - second index: sample [0..4*FRAME_LENGTH_COMPLEX_SAMPLES+2048[
int16_t **rxdata_syncSL;
LTE_UE_COMMON_PER_THREAD common_vars_rx_data_per_thread[RX_NB_TH_MAX];
/// holds output of the sync correlator
......
openair1/PHY/vars.h
View file @ 79b6e1d8
......@@ -37,10 +37,10 @@ const int16_t *primary_synch0_time;
const int16_t *primary_synch1_time;
const int16_t *primary_synch2_time;
#ifdef Rel14
const int16_t *primary_synch0SL_time;
const int16_t *primary_synch1SL_time;
#endif
#include "PHY/CODING/vars.h"
......
openair1/SCHED/phy_procedures_lte_ue.c
View file @ 79b6e1d8
......@@ -2369,6 +2369,9 @@ void phy_procedures_UE_SL_TX(PHY_VARS_UE *ue,UE_rxtx_proc_t *proc) {
}
}
ue->slss_generated=0;
// check for SLBCH/SLSS
AssertFatal(0==pthread_mutex_lock(&ue->slss_mutex),"");
if ((ue->slss = ue_get_slss(ue->Mod_id,ue->CC_id,frame_tx,subframe_tx)) != NULL) check_and_generate_slss(ue,frame_tx,subframe_tx);
......
openair1/SIMULATION/LTE_PHY/slschsim.c
View file @ 79b6e1d8
......@@ -63,6 +63,8 @@ int main(int argc, char **argv) {
int log_level = LOG_INFO;
SLSCH_t slsch;
SLDCH_t sldch;
SLSS_t slss;
SCM_t channel_model=AWGN;
UE_rxtx_proc_t proc;
double snr0 = 35;
......@@ -74,8 +76,12 @@ int main(int argc, char **argv) {
int nb_rb=20;
char channel_model_input[20];
int pscch_errors=0;
int do_SLSS=0;
int index;
int64_t psslevel;
int64_t avglevel;
AssertFatal(load_configmodule(argc,argv) != NULL,
"cannot load configuration module, exiting\n");
logInit();
......@@ -86,7 +92,7 @@ int main(int argc, char **argv) {
char c;
while ((c = getopt (argc, argv, "hf:m:n:g:r:z:w:s:")) != -1) {
while ((c = getopt (argc, argv, "hf:m:n:g:r:z:w:s:S")) != -1) {
switch (c) {
case 'f':
snr_step= atof(optarg);
......@@ -179,6 +185,10 @@ int main(int argc, char **argv) {
}
break;
case 'S':
do_SLSS=1;
break;
case 'h':
default:
printf("%s -h(elp) -a(wgn on) -m mcs -n n_frames -s snr0 -z RXant \n",argv[0]);
......@@ -191,6 +201,7 @@ int main(int argc, char **argv) {
printf("-r number of resource blocks\n");
printf("-g [A:M] Use 3GPP 25.814 SCM-A/B/C/D('A','B','C','D') or 36-101 EPA('E'), EVA ('F'),ETU('G') models (ignores delay spread and Ricean factor), Rayghleigh8 ('H'), Rayleigh1('I'), Rayleigh1_corr('J'), Rayleigh1_anticorr ('K'), Rice8('L'), Rice1('M')\n");
printf("-z Number of RX antennas used in UE\n");
printf("-S Run SL synchronization procedures\n");
exit(1);
break;
}
......@@ -212,7 +223,9 @@ int main(int argc, char **argv) {
0, //pa
0, //threequart_fs
1, //osf
0); //perfect_ce
0, //perfect_ce
1, //sidelink_active
1); //SLonly
UE2UE[0][0][0] = new_channel_desc_scm(UE->frame_parms.nb_antennas_tx,
UE->frame_parms.nb_antennas_rx,
......@@ -229,8 +242,11 @@ int main(int argc, char **argv) {
PHY_vars_UE_g[0] = (PHY_VARS_UE**) malloc(sizeof(PHY_VARS_UE*));
PHY_vars_UE_g[0][0] = UE;
init_lte_ue_transport(UE,0);
if (do_SLSS==1) lte_sync_time_init(&UE->frame_parms);
UE->rx_total_gain_dB = 120.0;
UE->rx_offset = 0;
UE->timing_advance = 0;
......@@ -238,6 +254,8 @@ int main(int argc, char **argv) {
UE->hw_timing_advance = 0;
UE->slsch = &slsch;
UE->sldch = &sldch;
UE->slss = &slss;
// SLSCH/CCH Configuration
slsch.N_SL_RB_data = 20;
slsch.prb_Start_data = 5;
......@@ -253,7 +271,7 @@ int main(int argc, char **argv) {
slsch.SL_SC_Period = 320;
slsch.bitmap1 = 0xffffffffff;
// SCI Paramters and Payload
slsch.n_pscch = 1111;
slsch.n_pscch = 13;
slsch.format = 0;
slsch.freq_hopping_flag = 0;
slsch.resource_block_coding = 127;
......@@ -290,6 +308,19 @@ int main(int argc, char **argv) {
sldch.bitmap1 = 0xffff;
sldch.bitmap_length = 16;
sldch.payload_length = 256;
memset((void*)&slss,0,sizeof(slss));
if (do_SLSS == 1) {
slss.SL_OffsetIndicator = 0;
slss.slss_id = 169;
slss.slmib_length = 5;
slss.slmib[0] = 0;
slss.slmib[1] = 1;
slss.slmib[2] = 2;
slss.slmib[3] = 3;
slss.slmib[4] = 4;
}
// copy sidelink parameters, PSCCH and PSSCH payloads will get overwritten
memcpy((void*)&UE->slsch_rx,(void*)UE->slsch,sizeof(SLSCH_t));
......@@ -312,7 +343,9 @@ int main(int argc, char **argv) {
UE->pscch_coded=0;
UE->pscch_generated=0;
UE->psdch_generated=0;
for (int absSF=0;absSF<10240;absSF++) {
UE->slss_generated=0;
frame = absSF/10;
subframe= absSF%10;
check_and_generate_psdch(UE,frame,subframe);
......@@ -321,14 +354,22 @@ int main(int argc, char **argv) {
proc.subframe_tx = subframe;
proc.frame_tx = frame;
check_and_generate_pssch(UE,&proc,frame,subframe);
if (UE->psdch_generated>0 || UE->pscch_generated > 0 || UE->pssch_generated > 0) {
check_and_generate_slss(UE,frame,subframe);
if (UE->psdch_generated>0 || UE->pscch_generated > 0 || UE->pssch_generated > 0 || UE->slss_generated > 0) {
AssertFatal(UE->pscch_generated<3,"Illegal pscch_generated %d\n",UE->pscch_generated);
// FEP
ulsch_common_procedures(UE,&proc,0);
// write_output("txsig0SL.m","txs0",&UE->common_vars.txdata[0][UE->frame_parms.samples_per_tti*subframe],UE->frame_parms.samples_per_tti,1,1);
printf("Running do_SL_sig for subframe %d, slot_ind %d\n",subframe,UE->pscch_generated);
// write_output("txsig0SL.m","txs0",&UE->common_vars.txdata[0][UE->frame_parms.samples_per_tti*subframe],UE->frame_parms.samples_per_tti,1,1);
// printf("Running do_SL_sig for frame %d subframe %d (%d,%d,%d,%d)\n",frame,subframe,UE->slss_generated,UE->pscch_generated,UE->psdch_generated,UE->pssch_generated);
do_SL_sig(0,UE2UE,subframe,UE->pscch_generated,&UE->frame_parms,frame,0);
// write_output("rxsig0.m","rxs0",&UE->common_vars.rxdata[0][UE->frame_parms.samples_per_tti*subframe],UE->frame_parms.samples_per_tti,1,1);
// write_output("rxsig0.m","rxs0",&UE->common_vars.rxdata[0][UE->frame_parms.samples_per_tti*subframe],UE->frame_parms.samples_per_tti,1,1);
if (do_SLSS==1)
memcpy((void*)&UE->common_vars.rxdata_syncSL[0][(((frame&3)*10)+subframe)*2*UE->frame_parms.samples_per_tti],
(void*)&UE->common_vars.rxdata[0][subframe*UE->frame_parms.samples_per_tti],
2*UE->frame_parms.samples_per_tti*sizeof(int16_t));
// write_output("rxsyncb0.m","rxsyncb0",(void*)UE->common_vars.rxdata_syncSL[0],(UE->frame_parms.samples_per_tti),1,1);
// exit(-1);
UE->pscch_generated = 0;
UE->pssch_generated = 0;
UE->psdch_generated = 0;
......@@ -336,7 +377,26 @@ int main(int argc, char **argv) {
}
rx_slcch(UE,frame,subframe);
rx_slsch(UE,&proc,frame,subframe);
if ((absSF % 40) == 3 && do_SLSS==1) {
printf("Running Initial synchronization for SL\n");
// initial synch for SL
// write_output("rxsyncb.m","rxsyncb",(void*)UE->common_vars.rxdata_syncSL[0],(UE->frame_parms.samples_per_tti),1,1);
UE->rx_offsetSL = lte_sync_timeSL(UE,
&index,
&psslevel,
&avglevel);
printf("absSF %d: Frame %d, index %d, psslevel %lld dB avglevel %lld dB => %d sample offset\n",
absSF,frame,index,dB_fixed(psslevel),dB_fixed(avglevel),UE->rx_offsetSL);
int32_t sss_metric;
int32_t phase_max;
rx_slsss(UE,&sss_metric,&phase_max,index,subframe);
// write_output("rxsynca.m","rxsynca",(void*)UE->common_vars.rxdata_syncSL[0],(UE->frame_parms.samples_per_tti),1,1);
// exit(-1);
}
UE->sl_fep_done = 0;
if ((absSF%320) == 319) {
if (UE->slcch_received == 0) pscch_errors++;
......
targets/RT/USER/lte-ue.c
View file @ 79b6e1d8
......@@ -703,8 +703,21 @@ static void *UE_thread_synchSL(void *arg)
AssertFatal ( 0== pthread_mutex_unlock(&UE->proc.mutex_synchSL), "");
// Do initial synch here
LOG_I(PHY,"Running PSS timing estimation first\n");
int MLind;
int64_t maxlev;
int64_t avglev;
int rxoffset = lte_sync_timeSL(UE,
&MLind,
&maxlev,
&avglev);
if (rxoffset>=0) LOG_I(PHY,"Most likely Nid_SL/168 = %d with rxoffset %d, lev %d dB, avg %d dB\n",
MLind,rxoffset,dB_fixed(maxlev),dB_fixed(avglev));
AssertFatal ( 0== pthread_mutex_lock(&UE->proc.mutex_synchSL), "");
UE->proc.instance_cnt_synchSL--;
UE->is_synchronizedSL = 0;
AssertFatal ( 0== pthread_mutex_unlock(&UE->proc.mutex_synchSL), "");
}
}
/*!
......@@ -1659,6 +1672,7 @@ void *UE_threadSL(void *arg) {
AssertFatal(UE->rfdevice.trx_start_func(&UE->rfdevice) == 0,"Could not start the device");
while (!oai_exit) {
AssertFatal ( 0== pthread_mutex_lock(&UE->proc.mutex_synch), "");
int instance_cnt_synch = UE->proc.instance_cnt_synchSL;
......@@ -1670,9 +1684,9 @@ void *UE_threadSL(void *arg) {
if (is_synchronized == 0 && UE->is_SynchRef == 0) {
if (instance_cnt_synch < 0) { // we can invoke the synch
// grab 10 ms of signal and wakeup synch thread
// grab 40 ms of signal and wakeup synch thread
for (int i=0; i<UE->frame_parms.nb_antennas_rx; i++)
rxp[i] = (void*)&UE->common_vars.rxdata[i][0];
rxp[i] = (void*)&UE->common_vars.rxdata_syncSL[i][0];
AssertFatal( UE->frame_parms.samples_per_tti*10 ==
UE->rfdevice.trx_read_func(&UE->rfdevice,
......@@ -1844,6 +1858,9 @@ void *UE_threadSL(void *arg) {
} // start_rx_stream==1
} // UE->is_synchronized==0 && UE->is_SynchRef==0
} // while !oai_exit
for (int i=0; i<UE->frame_parms.nb_antennas_rx;i++) free(rxdata[i]);
return NULL;
}
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment