872 lines
37 KiB
C
872 lines
37 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
|
|
*/
|
|
|
|
/*! \file config_ue.c
|
|
* \brief This includes FeMBMS UE Channel Estimation Procedures for FeMBMS 1.25KHz Carrier Spacing
|
|
* \author Javier Morgade
|
|
* \date 2020
|
|
* \version 0.1
|
|
* \email: javier.morgade@ieee.org
|
|
* @ingroup _phy
|
|
|
|
*/
|
|
|
|
|
|
#include <string.h>
|
|
#include "PHY/defs_UE.h"
|
|
#include "lte_estimation.h"
|
|
#include "PHY/LTE_REFSIG/lte_refsig.h"
|
|
|
|
#include "filt96_32_khz_1dot25.h"
|
|
|
|
//#define DEBUG_CH
|
|
int lte_dl_mbsfn_channel_estimation(PHY_VARS_UE *ue,
|
|
module_id_t eNB_id,
|
|
uint8_t eNB_offset,
|
|
int subframe,
|
|
unsigned char l) {
|
|
int pilot[600] __attribute__((aligned(16)));
|
|
unsigned char aarx,aa;
|
|
unsigned int rb;
|
|
short *pil, *rxF, *ch, *ch0, *ch1, *ch11, *chp;
|
|
int ch_offset,symbol_offset;
|
|
// unsigned int n;
|
|
// int i;
|
|
int **dl_ch_estimates=ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]].dl_ch_estimates[0];
|
|
int **rxdataF=ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]].rxdataF;
|
|
ch_offset = (l*(ue->frame_parms.ofdm_symbol_size));
|
|
symbol_offset = ch_offset;//phy_vars_ue->lte_frame_parms.ofdm_symbol_size*l;
|
|
|
|
for (aarx=0; aarx<ue->frame_parms.nb_antennas_rx; aarx++) {
|
|
// generate pilot
|
|
if ((l==2)||(l==6)||(l==10)) {
|
|
lte_dl_mbsfn_rx(ue,
|
|
&pilot[0],
|
|
subframe,
|
|
l>>2);
|
|
} // if symbol==2, return 0 else if symbol = 6, return 1, else if symbol=10 return 2
|
|
|
|
pil = (short *)&pilot[0];
|
|
rxF = (short *)&rxdataF[aarx][((symbol_offset+ue->frame_parms.first_carrier_offset))];
|
|
ch = (short *)&dl_ch_estimates[aarx][ch_offset];
|
|
// if (eNb_id==0)
|
|
memset(ch,0,4*(ue->frame_parms.ofdm_symbol_size));
|
|
|
|
//***********************************************************************
|
|
if ((ue->frame_parms.N_RB_DL==6) ||
|
|
(ue->frame_parms.N_RB_DL==50) ||
|
|
(ue->frame_parms.N_RB_DL==100)) {
|
|
// Interpolation and extrapolation;
|
|
if (l==6) {
|
|
// ________________________First half of RBs____________________
|
|
ch+=2;
|
|
rxF+=2;
|
|
}
|
|
|
|
for (rb=0; rb<ue->frame_parms.N_RB_DL; rb++) {
|
|
// ------------------------1st pilot------------------------
|
|
if (rb==(ue->frame_parms.N_RB_DL>>1)) {
|
|
rxF = (short *)&rxdataF[aarx][symbol_offset+1];
|
|
|
|
if (l==6)
|
|
rxF+=2;
|
|
}
|
|
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
|
|
/*
|
|
printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
if ((rb>0)&&(rb!=(ue->frame_parms.N_RB_DL>>1))) {
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
} else {
|
|
ch[-2]= ch[0];
|
|
ch[-1]= ch[1];
|
|
}
|
|
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]);*/
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[12] - (int)pil[7]*rxF[13])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[13] + (int)pil[7]*rxF[12])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] += ch[14];
|
|
ch[11] += ch[15];
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[6],pil[7],rxF[12],rxF[13],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[16] - (int)pil[9]*rxF[17])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[17] + (int)pil[9]*rxF[16])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[16],rxF[17],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[20] - (int)pil[11]*rxF[21])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[21] + (int)pil[11]*rxF[20])>>15);
|
|
|
|
if ((rb<(ue->frame_parms.N_RB_DL-1))&&
|
|
(rb!=((ue->frame_parms.N_RB_DL>>1)-1))) {
|
|
ch[22] = ch[20]>>1;
|
|
ch[23] = ch[21]>>1;
|
|
ch[18] += ch[22];
|
|
ch[19] += ch[23];
|
|
} else {
|
|
ch[22] = ch[20];
|
|
ch[23] = ch[21];
|
|
ch[18] += (ch[22]>>1);
|
|
ch[19] += (ch[23]>>1);
|
|
}
|
|
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[10],pil[11],rxF[20],rxF[21],ch[20],ch[21]);
|
|
printf("ch11 (%d,%d)\n",ch[22],ch[23]);*/
|
|
pil+=12;
|
|
ch+=24;
|
|
rxF+=24;
|
|
}
|
|
}
|
|
//*********************************************************************
|
|
else if (ue->frame_parms.N_RB_DL==25) {
|
|
//printf("Channel estimation\n");
|
|
//------------------------ loop over first 12 RBs------------------------
|
|
if (l==6) {
|
|
// ________________________First half of RBs____________________
|
|
ch+=2;
|
|
rxF+=2;
|
|
|
|
for (rb=0; rb<12; rb++) {
|
|
// ------------------------1st pilot------------------------
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
|
|
/*
|
|
printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
if (rb>0) {
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
} else {
|
|
ch[-2]= ch[0];
|
|
ch[-1]= ch[1];
|
|
// ch[-2]= (ch[0]>>1)*3- ch[4];
|
|
// ch[-1]= (ch[1]>>1)*3- ch[5];
|
|
}
|
|
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]);*/
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[12] - (int)pil[7]*rxF[13])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[13] + (int)pil[7]*rxF[12])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] += ch[14];
|
|
ch[11] += ch[15];
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[6],pil[7],rxF[12],rxF[13],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[16] - (int)pil[9]*rxF[17])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[17] + (int)pil[9]*rxF[16])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[16],rxF[17],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[20] - (int)pil[11]*rxF[21])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[21] + (int)pil[11]*rxF[20])>>15);
|
|
ch[22] = ch[20]>>1;
|
|
ch[23] = ch[21]>>1;
|
|
ch[18] += ch[22];
|
|
ch[19] += ch[23];
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[10],pil[11],rxF[20],rxF[21],ch[20],ch[21]);
|
|
printf("ch11 (%d,%d)\n",ch[22],ch[23]);*/
|
|
pil+=12;
|
|
ch+=24;
|
|
rxF+=24;
|
|
}
|
|
|
|
// Middle RB
|
|
// ________________________First half of RB___________________
|
|
// ------------------------1st pilot---------------------------
|
|
chp = ch-24;
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
chp[22] += ch[2];
|
|
chp[23] += ch[3];
|
|
/* printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
//printf("interp0: chp[0] (%d,%d) ch23 (%d,%d)\n",chp[22],chp[23],ch[2],ch[3]);
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]);
|
|
printf("interp1: ch23 (%d,%d) \n",ch[2],ch[3]);*/
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
//ch[10] = (ch[8])/3;
|
|
//ch[11] = (ch[9])/3;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// printf("Second half\n");
|
|
// ________________________Second half of RB____________________
|
|
rxF = (short *)&rxdataF[aarx][((symbol_offset+2))];
|
|
// 4th pilot
|
|
ch[12] = (short)(((int)pil[6]*rxF[0] - (int)pil[7]*rxF[1])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[1] + (int)pil[7]*rxF[0])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] = (ch[8] / 3) + (ch[12] * 2) / 3;
|
|
ch[11] = (ch[9] / 3) + (ch[13] * 2) / 3;
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[6],pil[7],rxF[0],rxF[1],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[4] - (int)pil[9]*rxF[5])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[5] + (int)pil[9]*rxF[4])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[4],rxF[5],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[8] - (int)pil[11]*rxF[9])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[9] + (int)pil[11]*rxF[8])>>15);
|
|
ch[22] = ch[20]>>1;
|
|
ch[23] = ch[21]>>1;
|
|
ch[18] += ch[22];
|
|
ch[19] += ch[23];
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[10],pil[11],rxF[8],rxF[9],ch[20],ch[21]);*/
|
|
pil+=12;
|
|
ch+=24;
|
|
rxF+=12;
|
|
|
|
// ________________________Second half of RBs____________________
|
|
for (rb=0; rb<11; rb++) {
|
|
// ------------------------1st pilot---------------------------
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
/* printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
//if (rb>0) {
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
//}
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]);*/
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]); */
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[12] - (int)pil[7]*rxF[13])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[13] + (int)pil[7]*rxF[12])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] += ch[14];
|
|
ch[11] += ch[15];
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[6],pil[7],rxF[12],rxF[13],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[16] - (int)pil[9]*rxF[17])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[17] + (int)pil[9]*rxF[16])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[16],rxF[17],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[20] - (int)pil[11]*rxF[21])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[21] + (int)pil[11]*rxF[20])>>15);
|
|
ch[22] = ch[20]>>1;
|
|
ch[23] = ch[21]>>1;
|
|
ch[18] += ch[22];
|
|
ch[19] += ch[23];
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[10],pil[11],rxF[20],rxF[21],ch[20],ch[21]);*/
|
|
pil+=12;
|
|
ch+=24;
|
|
rxF+=24;
|
|
}
|
|
|
|
// ------------------------Last PRB ---------------------------
|
|
// ------------------------1st pilot---------------------------
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
/* printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]); */
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[12] - (int)pil[7]*rxF[13])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[13] + (int)pil[7]*rxF[12])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] += ch[14];
|
|
ch[11] += ch[15];
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[6],pil[7],rxF[12],rxF[13],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[16] - (int)pil[9]*rxF[17])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[17] + (int)pil[9]*rxF[16])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[16],rxF[17],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[20] - (int)pil[11]*rxF[21])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[21] + (int)pil[11]*rxF[20])>>15);
|
|
ch[18] += ch[20]>>1;
|
|
ch[19] += ch[21]>>1;
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[10],pil[11],rxF[20],rxF[21],ch[20],ch[21]); */
|
|
}
|
|
|
|
//**********************************************************************
|
|
// for l=2 and l=10
|
|
if (l!=6) {
|
|
// extrapolate last channel estimate
|
|
for (rb=0; rb<12; rb++) {
|
|
// ------------------------1st pilot---------------------------
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
/* printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]);*/
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[12] - (int)pil[7]*rxF[13])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[13] + (int)pil[7]*rxF[12])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] += ch[14];
|
|
ch[11] += ch[15];
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[6],pil[7],rxF[12],rxF[13],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[16] - (int)pil[9]*rxF[17])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[17] + (int)pil[9]*rxF[16])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[32],rxF[33],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[20] - (int)pil[11]*rxF[21])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[21] + (int)pil[11]*rxF[20])>>15);
|
|
ch[22] = ch[20]>>1;
|
|
ch[23] = ch[21]>>1;
|
|
ch[18] += ch[22];
|
|
ch[19] += ch[23];
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[10],pil[11],rxF[20],rxF[21],ch[20],ch[21]);*/
|
|
pil+=12;
|
|
ch+=24;
|
|
rxF+=24;
|
|
}
|
|
|
|
// ------------------------middle PRB--------------------------
|
|
// ------------------------1st pilot---------------------------
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
/* printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]);*/
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// printf("Second half\n");
|
|
// ------------------------Second half of RBs---------------------//
|
|
rxF = (short *)&rxdataF[aarx][((symbol_offset+1))];
|
|
// ---------------------------------------------------------------//
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[0] - (int)pil[7]*rxF[1])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[1] + (int)pil[7]*rxF[0])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] = (ch[12]/3)+(ch[8]<<1)/3;
|
|
ch[11] = (ch[13]/3)+(ch[9]<<1)/3;
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[6],pil[7],rxF[0],rxF[1],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[4] - (int)pil[9]*rxF[5])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[5] + (int)pil[9]*rxF[4])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[4],pil[5],rxF[4],rxF[5],ch[8],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[8] - (int)pil[11]*rxF[9])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[9] + (int)pil[11]*rxF[8])>>15);
|
|
ch[22] = ch[20]>>1;
|
|
ch[23] = ch[21]>>1;
|
|
ch[18] += ch[22];
|
|
ch[19] += ch[23];
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
rb,pil[10],pil[11],rxF[8],rxF[9],ch[20],ch[21]);*/
|
|
pil+=12;
|
|
ch+=24;
|
|
rxF+=12;
|
|
|
|
// ________________________Second half of RBs____________________
|
|
for (rb=0; rb<11; rb++) {
|
|
// ------------------------1st pilot---------------------------
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
/* printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]); */
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[12] - (int)pil[7]*rxF[13])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[13] + (int)pil[7]*rxF[12])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] += ch[14];
|
|
ch[11] += ch[15];
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[6],pil[7],rxF[12],rxF[13],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[16] - (int)pil[9]*rxF[17])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[17] + (int)pil[9]*rxF[16])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[16],rxF[17],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[20] - (int)pil[11]*rxF[21])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[21] + (int)pil[11]*rxF[20])>>15);
|
|
ch[22] = ch[20]>>1;
|
|
ch[23] = ch[21]>>1;
|
|
ch[18] += ch[22];
|
|
ch[19] += ch[23];
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[10],pil[11],rxF[20],rxF[21],ch[20],ch[21]);*/
|
|
pil+=12;
|
|
ch+=24;
|
|
rxF+=24;
|
|
}
|
|
|
|
// ------------------------Last PRB ---------------------------
|
|
// ------------------------1st pilot---------------------------
|
|
ch[0] = (short)(((int)pil[0]*rxF[0] - (int)pil[1]*rxF[1])>>15);
|
|
ch[1] = (short)(((int)pil[0]*rxF[1] + (int)pil[1]*rxF[0])>>15);
|
|
ch[2] = ch[0]>>1;
|
|
ch[3] = ch[1]>>1;
|
|
ch[-2] += ch[2];
|
|
ch[-1] += ch[3];
|
|
/* printf("rb %d: pil0 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[0],pil[1],rxF[0],rxF[1],ch[0],ch[1]);*/
|
|
// ------------------------2nd pilot------------------------
|
|
ch[4] = (short)(((int)pil[2]*rxF[4] - (int)pil[3]*rxF[5])>>15);
|
|
ch[5] = (short)(((int)pil[2]*rxF[5] + (int)pil[3]*rxF[4])>>15);
|
|
ch[6] = ch[4]>>1;
|
|
ch[7] = ch[5]>>1;
|
|
ch[2] += ch[6];
|
|
ch[3] += ch[7];
|
|
/* printf("rb %d: pil1 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[2],pil[3],rxF[4],rxF[5],ch[4],ch[5]); */
|
|
// ------------------------3rd pilot------------------------
|
|
ch[8] = (short)(((int)pil[4]*rxF[8] - (int)pil[5]*rxF[9])>>15);
|
|
ch[9] = (short)(((int)pil[4]*rxF[9] + (int)pil[5]*rxF[8])>>15);
|
|
ch[10] = ch[8]>>1;
|
|
ch[11] = ch[9]>>1;
|
|
ch[6] += ch[10];
|
|
ch[7] += ch[11];
|
|
/* printf("rb %d: pil2 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[8],rxF[9],ch[8],ch[9]);*/
|
|
// ------------------------4th pilot------------------------
|
|
ch[12] = (short)(((int)pil[6]*rxF[12] - (int)pil[7]*rxF[13])>>15);
|
|
ch[13] = (short)(((int)pil[6]*rxF[13] + (int)pil[7]*rxF[12])>>15);
|
|
ch[14] = ch[12]>>1;
|
|
ch[15] = ch[13]>>1;
|
|
ch[10] += ch[14];
|
|
ch[11] += ch[15];
|
|
/* printf("rb %d: pil3 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[6],pil[7],rxF[12],rxF[13],ch[12],ch[13]);*/
|
|
// ------------------------5th pilot------------------------
|
|
ch[16] = (short)(((int)pil[8]*rxF[16] - (int)pil[9]*rxF[17])>>15);
|
|
ch[17] = (short)(((int)pil[8]*rxF[17] + (int)pil[9]*rxF[16])>>15);
|
|
ch[18] = ch[16]>>1;
|
|
ch[19] = ch[17]>>1;
|
|
ch[14] += ch[18];
|
|
ch[15] += ch[19];
|
|
/* printf("rb %d: pil4 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[4],pil[5],rxF[16],rxF[17],ch[16],ch[17]);*/
|
|
// ------------------------6th pilot------------------------
|
|
ch[20] = (short)(((int)pil[10]*rxF[20] - (int)pil[11]*rxF[21])>>15);
|
|
ch[21] = (short)(((int)pil[10]*rxF[21] + (int)pil[11]*rxF[20])>>15);
|
|
ch[22]= (ch[20]>>1)*3- ch[18];
|
|
ch[23]= (ch[21]>>1)*3- ch[19];
|
|
ch[18] += ch[20]>>1;
|
|
ch[19] += ch[21]>>1;
|
|
/* printf("rb %d: pil5 (%d,%d) x (%d,%d) = (%d,%d)\n",
|
|
13+rb,pil[10],pil[11],rxF[20],rxF[21],ch[20],ch[21]);*/
|
|
}
|
|
}
|
|
|
|
//------------------------Temporal Interpolation ------------------------------
|
|
int symb_sz = ue->frame_parms.ofdm_symbol_size;
|
|
if (l==6) {
|
|
ch = (short *)&dl_ch_estimates[aarx][ch_offset];
|
|
// printf("Interpolating ch 2,6 => %d\n",ch_offset);
|
|
c16_t *ch_prev = (c16_t *)&dl_ch_estimates[aarx][2 * symb_sz];
|
|
ch0 = (short *)&dl_ch_estimates[aarx][0 * (symb_sz)];
|
|
memcpy(ch0, ch_prev, 4 * symb_sz);
|
|
ch1 = (short *)&dl_ch_estimates[aarx][1 * (symb_sz)];
|
|
memcpy(ch1, ch_prev, 4 * symb_sz);
|
|
// 3/4 ch2 + 1/4 ch6 => ch3
|
|
mult_complex_vector_real_scalar(ch_prev, 24576, ch_prev + symb_sz, symb_sz);
|
|
multadd_complex_vector_real_scalar((c16_t *)ch, 8192, ch_prev + symb_sz, symb_sz);
|
|
// 1/2 ch2 + 1/2 ch6 => ch4
|
|
mult_complex_vector_real_scalar(ch_prev, 16384, ch_prev + 2 * symb_sz, symb_sz);
|
|
multadd_complex_vector_real_scalar((c16_t *)ch, 16384, ch_prev + 2 * symb_sz, symb_sz);
|
|
// 1/4 ch2 + 3/4 ch6 => ch5
|
|
mult_complex_vector_real_scalar(ch_prev, 8192, ch_prev + 3 * symb_sz, symb_sz);
|
|
multadd_complex_vector_real_scalar((c16_t *)ch, 24576, ch_prev + 3 * symb_sz, symb_sz);
|
|
}
|
|
|
|
if (l==10) {
|
|
ch = (short *)&dl_ch_estimates[aarx][ch_offset];
|
|
c16_t *ch_prev = (c16_t *)&dl_ch_estimates[aarx][6 * symb_sz];
|
|
// 3/4 ch6 + 1/4 ch10 => ch7
|
|
mult_complex_vector_real_scalar(ch_prev, 24576, ch_prev + symb_sz, symb_sz);
|
|
multadd_complex_vector_real_scalar((c16_t *)ch, 8192, ch_prev + symb_sz, symb_sz);
|
|
// 1/2 ch6 + 1/2 ch10 => ch8
|
|
mult_complex_vector_real_scalar(ch_prev, 16384, ch_prev + 2 * symb_sz, symb_sz);
|
|
multadd_complex_vector_real_scalar((c16_t *)ch, 16384, ch_prev + 2 * symb_sz, symb_sz);
|
|
// 1/4 ch6 + 3/4 ch10 => ch9
|
|
mult_complex_vector_real_scalar(ch_prev, 8192, ch_prev + 3 * symb_sz, symb_sz);
|
|
multadd_complex_vector_real_scalar((c16_t *)ch, 24576, ch_prev + 3 * symb_sz, symb_sz);
|
|
// 5/4 ch10 - 1/4 ch6 => ch11
|
|
// Ch11
|
|
ch_prev = (c16_t *)&dl_ch_estimates[aarx][10 * (symb_sz)];
|
|
ch11 = (short *)&dl_ch_estimates[aarx][11 * (symb_sz)];
|
|
memcpy(ch11, ch_prev, 4 * symb_sz);
|
|
}
|
|
}
|
|
|
|
// do ifft of channel estimate
|
|
for (aa=0; aa<ue->frame_parms.nb_antennas_rx*ue->frame_parms.nb_antennas_tx; aa++) {
|
|
int32_t *tmp = ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]].dl_ch_estimates[eNB_offset][aa];
|
|
if (tmp) {
|
|
int len;
|
|
switch (ue->frame_parms.N_RB_DL) {
|
|
case 6:
|
|
len = 128;
|
|
break;
|
|
case 25:
|
|
len = 512;
|
|
break;
|
|
case 50:
|
|
len = 1024;
|
|
break;
|
|
case 75:
|
|
len=1536;
|
|
break;
|
|
case 100:
|
|
len = 2048;
|
|
break;
|
|
default:
|
|
LOG_E(PHY, "Unknown N_RB_DL %d\n", ue->frame_parms.N_RB_DL);
|
|
return -1;
|
|
}
|
|
|
|
idft(get_idft(len),
|
|
(int16_t *)&tmp[8],
|
|
(int16_t *)ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]]
|
|
.dl_ch_estimates_time[eNB_offset][aa],
|
|
1);
|
|
}
|
|
}
|
|
return(0);
|
|
}
|
|
|
|
|
|
|
|
int lte_dl_mbsfn_khz_1dot25_channel_estimation(PHY_VARS_UE *ue,
|
|
module_id_t eNB_id,
|
|
uint8_t eNB_offset,
|
|
int subframe) {
|
|
int pilot_khz_1dot25[2*2*600] __attribute__((aligned(16)));
|
|
unsigned char aarx,aa;
|
|
// unsigned int rb;
|
|
int ch_offset,symbol_offset;
|
|
int pilot_cnt;
|
|
int16_t *f, *f2, *fl, *f2l2, *fr, *f2r2 /*,*f2_dc,*f_dc*/;
|
|
// unsigned int n;
|
|
// int i;
|
|
int **dl_ch_estimates=ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]].dl_ch_estimates[0];
|
|
int **rxdataF=ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]].rxdataF;
|
|
ch_offset = 0;//(l*(ue->frame_parms.ofdm_symbol_size));
|
|
symbol_offset = 0;//ch_offset;//phy_vars_ue->lte_frame_parms.ofdm_symbol_size*l;
|
|
//AssertFatal( ue->frame_parms.N_RB_DL==25,"OFDM symbol size %d not yet supported for FeMBMS\n",ue->frame_parms.N_RB_DL);
|
|
|
|
if( (subframe&0x1) == 0) {
|
|
f=filt24_0_khz_1dot25;
|
|
f2=filt24_2_khz_1dot25;
|
|
fl=filt24_0_khz_1dot25;
|
|
f2l2=filt24_2_khz_1dot25;
|
|
fr=filt24_0r2_khz_1dot25;
|
|
f2r2=filt24_2r_khz_1dot25;
|
|
//f_dc=filt24_0_dcr_khz_1dot25;
|
|
//f2_dc=filt24_2_dcl_khz_1dot25;
|
|
} else {
|
|
f=filt24_0_khz_1dot25;
|
|
f2=filt24_2_khz_1dot25;
|
|
fl=filt24_0_khz_1dot25;
|
|
f2l2=filt24_2_khz_1dot25;
|
|
fr=filt24_0r2_khz_1dot25;
|
|
f2r2=filt24_2r_khz_1dot25;
|
|
//f_dc=filt24_0_dcr_khz_1dot25;
|
|
//f2_dc=filt24_2_dcl_khz_1dot25;
|
|
}
|
|
|
|
for (aarx=0; aarx<ue->frame_parms.nb_antennas_rx; aarx++) {
|
|
// generate pilot
|
|
lte_dl_mbsfn_khz_1dot25_rx(ue, pilot_khz_1dot25, subframe);
|
|
c16_t *pil = (c16_t *)pilot_khz_1dot25;
|
|
c16_t *dl_ch = (c16_t *)&dl_ch_estimates[aarx][ch_offset];
|
|
memset(dl_ch, 0, sizeof(c16_t) * ue->frame_parms.ofdm_symbol_size_khz_1dot25);
|
|
|
|
unsigned int k = (subframe & 0x1) == 0 ? 0 : 3;
|
|
c16_t *rxF = (c16_t *)&rxdataF[aarx][ue->frame_parms.first_carrier_offset_khz_1dot25 + k];
|
|
|
|
if (1 /*ue->frame_parms.N_RB_DL==25*/) {
|
|
multadd_real_vector_complex_scalar(fl, c16mulShift(*pil++, *rxF, 15), dl_ch, 24);
|
|
rxF += 6;
|
|
dl_ch += 4;
|
|
multadd_real_vector_complex_scalar(f2l2, c16mulShift(*pil++, *rxF, 15), dl_ch, 24);
|
|
rxF += 6;
|
|
dl_ch += 8;
|
|
|
|
for (pilot_cnt = 2; pilot_cnt < ue->frame_parms.N_RB_DL * 12 - 1 /*299*/; pilot_cnt += 2) {
|
|
multadd_real_vector_complex_scalar(f, c16mulShift(*pil++, *rxF, 15), dl_ch, 24);
|
|
rxF += 6;
|
|
dl_ch += 4;
|
|
multadd_real_vector_complex_scalar(f2, c16mulShift(*pil++, *rxF, 15), dl_ch, 24);
|
|
rxF += 6;
|
|
dl_ch += 8;
|
|
}
|
|
|
|
rxF = (c16_t *)&rxdataF[aarx][symbol_offset + 1 + k]; // Skip DC offset
|
|
|
|
for (pilot_cnt = 0; pilot_cnt < ue->frame_parms.N_RB_DL * 12 - 3 /*297*/; pilot_cnt += 2) {
|
|
multadd_real_vector_complex_scalar(f, c16mulShift(*pil++, *rxF, 15), dl_ch, 24);
|
|
rxF += 6;
|
|
dl_ch += 4;
|
|
multadd_real_vector_complex_scalar(f2, c16mulShift(*pil++, *rxF, 15), dl_ch, 24);
|
|
rxF += 6;
|
|
dl_ch += 8;
|
|
}
|
|
|
|
multadd_real_vector_complex_scalar(fr, c16mulShift(*pil++, *rxF, 15), dl_ch, 24);
|
|
rxF += 6;
|
|
dl_ch += 4;
|
|
multadd_real_vector_complex_scalar(f2r2, c16mulShift(*pil, *rxF, 15), dl_ch, 24);
|
|
}
|
|
}
|
|
|
|
// do ifft of channel estimate
|
|
for (aa=0; aa<ue->frame_parms.nb_antennas_rx*ue->frame_parms.nb_antennas_tx; aa++) {
|
|
int32_t *tmp = ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]].dl_ch_estimates[0][aa];
|
|
if (tmp) {
|
|
int len = 0;
|
|
switch (ue->frame_parms.N_RB_DL) {
|
|
case 25:
|
|
len = 6144;
|
|
break;
|
|
case 50:
|
|
len = 12288;
|
|
break;
|
|
case 100:
|
|
len = 24576;
|
|
break;
|
|
}
|
|
if (len)
|
|
idft(get_idft(len),
|
|
(int16_t *)&tmp[8],
|
|
(int16_t *)ue->common_vars.common_vars_rx_data_per_thread[ue->current_thread_id[subframe]].dl_ch_estimates_time[0][aa],
|
|
1);
|
|
}
|
|
}
|
|
return(0);
|
|
}
|
|
|
|
|
|
|