1420 lines
52 KiB
C
1420 lines
52 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 PHY/LTE_TRANSPORT/ulsch_demodulation.c
|
|
* \brief Top-level routines for demodulating the PUSCH physical channel from 36.211 V8.6 2009-03
|
|
* \author R. Knopp
|
|
* \date 2011
|
|
* \version 0.1
|
|
* \company Eurecom
|
|
* \email: knopp@eurecom.fr, florian.kaltenberger@eurecom.fr, ankit.bhamri@eurecom.fr
|
|
* \note
|
|
* \warning
|
|
*/
|
|
|
|
#include "PHY/defs_eNB.h"
|
|
#include "PHY/phy_extern.h"
|
|
#include "transport_eNB.h"
|
|
//#define DEBUG_ULSCH
|
|
#include "PHY/sse_intrin.h"
|
|
#include "transport_common_proto.h"
|
|
#include "PHY/LTE_ESTIMATION/lte_estimation.h"
|
|
#include "PHY/MODULATION/modulation_eNB.h"
|
|
|
|
#include "T.h"
|
|
|
|
//extern char* namepointer_chMag ;
|
|
//eren
|
|
//extern int **ulchmag_eren;
|
|
//eren
|
|
|
|
static short jitter[8] __attribute__ ((aligned(16))) = {1,0,0,1,0,1,1,0};
|
|
static short jitterc[8] __attribute__ ((aligned(16))) = {0,1,1,0,1,0,0,1};
|
|
|
|
void lte_idft(LTE_DL_FRAME_PARMS *frame_parms,uint32_t *z, uint16_t Msc_PUSCH)
|
|
{
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
__m128i idft_in128[3][1200],idft_out128[3][1200];
|
|
__m128i norm128;
|
|
#elif defined(__arm__)
|
|
int16x8_t idft_in128[3][1200],idft_out128[3][1200];
|
|
int16x8_t norm128;
|
|
#endif
|
|
int16_t *idft_in0=(int16_t*)idft_in128[0],*idft_out0=(int16_t*)idft_out128[0];
|
|
int16_t *idft_in1=(int16_t*)idft_in128[1],*idft_out1=(int16_t*)idft_out128[1];
|
|
int16_t *idft_in2=(int16_t*)idft_in128[2],*idft_out2=(int16_t*)idft_out128[2];
|
|
|
|
uint32_t *z0,*z1,*z2,*z3,*z4,*z5,*z6,*z7,*z8,*z9,*z10=NULL,*z11=NULL;
|
|
int i,ip;
|
|
|
|
|
|
|
|
// printf("Doing lte_idft for Msc_PUSCH %d\n",Msc_PUSCH);
|
|
|
|
if (frame_parms->Ncp == 0) { // Normal prefix
|
|
z0 = z;
|
|
z1 = z0+(frame_parms->N_RB_DL*12);
|
|
z2 = z1+(frame_parms->N_RB_DL*12);
|
|
//pilot
|
|
z3 = z2+(2*frame_parms->N_RB_DL*12);
|
|
z4 = z3+(frame_parms->N_RB_DL*12);
|
|
z5 = z4+(frame_parms->N_RB_DL*12);
|
|
|
|
z6 = z5+(frame_parms->N_RB_DL*12);
|
|
z7 = z6+(frame_parms->N_RB_DL*12);
|
|
z8 = z7+(frame_parms->N_RB_DL*12);
|
|
//pilot
|
|
z9 = z8+(2*frame_parms->N_RB_DL*12);
|
|
z10 = z9+(frame_parms->N_RB_DL*12);
|
|
// srs
|
|
z11 = z10+(frame_parms->N_RB_DL*12);
|
|
} else { // extended prefix
|
|
z0 = z;
|
|
z1 = z0+(frame_parms->N_RB_DL*12);
|
|
//pilot
|
|
z2 = z1+(2*frame_parms->N_RB_DL*12);
|
|
z3 = z2+(frame_parms->N_RB_DL*12);
|
|
z4 = z3+(frame_parms->N_RB_DL*12);
|
|
|
|
z5 = z4+(frame_parms->N_RB_DL*12);
|
|
z6 = z5+(frame_parms->N_RB_DL*12);
|
|
//pilot
|
|
z7 = z6+(2*frame_parms->N_RB_DL*12);
|
|
z8 = z7+(frame_parms->N_RB_DL*12);
|
|
// srs
|
|
z9 = z8+(frame_parms->N_RB_DL*12);
|
|
}
|
|
|
|
// conjugate input
|
|
for (i=0; i<(Msc_PUSCH>>2); i++) {
|
|
#if defined(__x86_64__)||defined(__i386__)
|
|
*&(((__m128i*)z0)[i])=_mm_sign_epi16(*&(((__m128i*)z0)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z1)[i])=_mm_sign_epi16(*&(((__m128i*)z1)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z2)[i])=_mm_sign_epi16(*&(((__m128i*)z2)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z3)[i])=_mm_sign_epi16(*&(((__m128i*)z3)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z4)[i])=_mm_sign_epi16(*&(((__m128i*)z4)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z5)[i])=_mm_sign_epi16(*&(((__m128i*)z5)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z6)[i])=_mm_sign_epi16(*&(((__m128i*)z6)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z7)[i])=_mm_sign_epi16(*&(((__m128i*)z7)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z8)[i])=_mm_sign_epi16(*&(((__m128i*)z8)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z9)[i])=_mm_sign_epi16(*&(((__m128i*)z9)[i]),*(__m128i*)&conjugate2[0]);
|
|
|
|
if (frame_parms->Ncp==NORMAL) {
|
|
*&(((__m128i*)z10)[i])=_mm_sign_epi16(*&(((__m128i*)z10)[i]),*(__m128i*)&conjugate2[0]);
|
|
*&(((__m128i*)z11)[i])=_mm_sign_epi16(*&(((__m128i*)z11)[i]),*(__m128i*)&conjugate2[0]);
|
|
}
|
|
#elif defined(__arm__)
|
|
*&(((int16x8_t*)z0)[i])=vmulq_s16(*&(((int16x8_t*)z0)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z1)[i])=vmulq_s16(*&(((int16x8_t*)z1)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z2)[i])=vmulq_s16(*&(((int16x8_t*)z2)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z3)[i])=vmulq_s16(*&(((int16x8_t*)z3)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z4)[i])=vmulq_s16(*&(((int16x8_t*)z4)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z5)[i])=vmulq_s16(*&(((int16x8_t*)z5)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z6)[i])=vmulq_s16(*&(((int16x8_t*)z6)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z7)[i])=vmulq_s16(*&(((int16x8_t*)z7)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z8)[i])=vmulq_s16(*&(((int16x8_t*)z8)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z9)[i])=vmulq_s16(*&(((int16x8_t*)z9)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
|
|
|
|
if (frame_parms->Ncp==NORMAL) {
|
|
*&(((int16x8_t*)z10)[i])=vmulq_s16(*&(((int16x8_t*)z10)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z11)[i])=vmulq_s16(*&(((int16x8_t*)z11)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
}
|
|
|
|
#endif
|
|
}
|
|
|
|
for (i=0,ip=0; i<Msc_PUSCH; i++,ip+=4) {
|
|
((uint32_t*)idft_in0)[ip+0] = z0[i];
|
|
((uint32_t*)idft_in0)[ip+1] = z1[i];
|
|
((uint32_t*)idft_in0)[ip+2] = z2[i];
|
|
((uint32_t*)idft_in0)[ip+3] = z3[i];
|
|
((uint32_t*)idft_in1)[ip+0] = z4[i];
|
|
((uint32_t*)idft_in1)[ip+1] = z5[i];
|
|
((uint32_t*)idft_in1)[ip+2] = z6[i];
|
|
((uint32_t*)idft_in1)[ip+3] = z7[i];
|
|
((uint32_t*)idft_in2)[ip+0] = z8[i];
|
|
((uint32_t*)idft_in2)[ip+1] = z9[i];
|
|
|
|
if (frame_parms->Ncp==0) {
|
|
((uint32_t*)idft_in2)[ip+2] = z10[i];
|
|
((uint32_t*)idft_in2)[ip+3] = z11[i];
|
|
}
|
|
}
|
|
|
|
|
|
switch (Msc_PUSCH) {
|
|
case 12:
|
|
dft12((int16_t *)idft_in0,(int16_t *)idft_out0);
|
|
dft12((int16_t *)idft_in1,(int16_t *)idft_out1);
|
|
dft12((int16_t *)idft_in2,(int16_t *)idft_out2);
|
|
|
|
#if defined(__x86_64__)||defined(__i386__)
|
|
norm128 = _mm_set1_epi16(9459);
|
|
#elif defined(__arm__)
|
|
norm128 = vdupq_n_s16(9459);
|
|
#endif
|
|
for (i=0; i<12; i++) {
|
|
#if defined(__x86_64__)||defined(__i386__)
|
|
((__m128i*)idft_out0)[i] = _mm_slli_epi16(_mm_mulhi_epi16(((__m128i*)idft_out0)[i],norm128),1);
|
|
((__m128i*)idft_out1)[i] = _mm_slli_epi16(_mm_mulhi_epi16(((__m128i*)idft_out1)[i],norm128),1);
|
|
((__m128i*)idft_out2)[i] = _mm_slli_epi16(_mm_mulhi_epi16(((__m128i*)idft_out2)[i],norm128),1);
|
|
#elif defined(__arm__)
|
|
((int16x8_t*)idft_out0)[i] = vqdmulhq_s16(((int16x8_t*)idft_out0)[i],norm128);
|
|
((int16x8_t*)idft_out1)[i] = vqdmulhq_s16(((int16x8_t*)idft_out1)[i],norm128);
|
|
((int16x8_t*)idft_out2)[i] = vqdmulhq_s16(((int16x8_t*)idft_out2)[i],norm128);
|
|
#endif
|
|
}
|
|
|
|
break;
|
|
|
|
case 24:
|
|
dft24(idft_in0,idft_out0,1);
|
|
dft24(idft_in1,idft_out1,1);
|
|
dft24(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 36:
|
|
dft36(idft_in0,idft_out0,1);
|
|
dft36(idft_in1,idft_out1,1);
|
|
dft36(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 48:
|
|
dft48(idft_in0,idft_out0,1);
|
|
dft48(idft_in1,idft_out1,1);
|
|
dft48(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 60:
|
|
dft60(idft_in0,idft_out0,1);
|
|
dft60(idft_in1,idft_out1,1);
|
|
dft60(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 72:
|
|
dft72(idft_in0,idft_out0,1);
|
|
dft72(idft_in1,idft_out1,1);
|
|
dft72(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 96:
|
|
dft96(idft_in0,idft_out0,1);
|
|
dft96(idft_in1,idft_out1,1);
|
|
dft96(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 108:
|
|
dft108(idft_in0,idft_out0,1);
|
|
dft108(idft_in1,idft_out1,1);
|
|
dft108(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 120:
|
|
dft120(idft_in0,idft_out0,1);
|
|
dft120(idft_in1,idft_out1,1);
|
|
dft120(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 144:
|
|
dft144(idft_in0,idft_out0,1);
|
|
dft144(idft_in1,idft_out1,1);
|
|
dft144(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 180:
|
|
dft180(idft_in0,idft_out0,1);
|
|
dft180(idft_in1,idft_out1,1);
|
|
dft180(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 192:
|
|
dft192(idft_in0,idft_out0,1);
|
|
dft192(idft_in1,idft_out1,1);
|
|
dft192(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 216:
|
|
dft216(idft_in0,idft_out0,1);
|
|
dft216(idft_in1,idft_out1,1);
|
|
dft216(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 240:
|
|
dft240(idft_in0,idft_out0,1);
|
|
dft240(idft_in1,idft_out1,1);
|
|
dft240(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 288:
|
|
dft288(idft_in0,idft_out0,1);
|
|
dft288(idft_in1,idft_out1,1);
|
|
dft288(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 300:
|
|
dft300(idft_in0,idft_out0,1);
|
|
dft300(idft_in1,idft_out1,1);
|
|
dft300(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
case 324:
|
|
dft324((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft324((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft324((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 360:
|
|
dft360((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft360((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft360((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 384:
|
|
dft384((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft384((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft384((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 432:
|
|
dft432((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft432((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft432((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 480:
|
|
dft480((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft480((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft480((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 540:
|
|
dft540((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft540((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft540((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 576:
|
|
dft576((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft576((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft576((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 600:
|
|
dft600((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft600((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft600((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 648:
|
|
dft648((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft648((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft648((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 720:
|
|
dft720((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft720((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft720((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 864:
|
|
dft864((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft864((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft864((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 900:
|
|
dft900((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft900((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft900((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 960:
|
|
dft960((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft960((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft960((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 972:
|
|
dft972((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft972((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft972((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 1080:
|
|
dft1080((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft1080((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft1080((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 1152:
|
|
dft1152((int16_t*)idft_in0,(int16_t*)idft_out0,1);
|
|
dft1152((int16_t*)idft_in1,(int16_t*)idft_out1,1);
|
|
dft1152((int16_t*)idft_in2,(int16_t*)idft_out2,1);
|
|
break;
|
|
|
|
case 1200:
|
|
dft1200(idft_in0,idft_out0,1);
|
|
dft1200(idft_in1,idft_out1,1);
|
|
dft1200(idft_in2,idft_out2,1);
|
|
break;
|
|
|
|
default:
|
|
// should not be reached
|
|
LOG_E( PHY, "Unsupported Msc_PUSCH value of %"PRIu16"\n", Msc_PUSCH );
|
|
return;
|
|
}
|
|
|
|
|
|
|
|
for (i=0,ip=0; i<Msc_PUSCH; i++,ip+=4) {
|
|
z0[i] = ((uint32_t*)idft_out0)[ip];
|
|
/*
|
|
printf("out0 (%d,%d),(%d,%d),(%d,%d),(%d,%d)\n",
|
|
((int16_t*)&idft_out0[ip])[0],((int16_t*)&idft_out0[ip])[1],
|
|
((int16_t*)&idft_out0[ip+1])[0],((int16_t*)&idft_out0[ip+1])[1],
|
|
((int16_t*)&idft_out0[ip+2])[0],((int16_t*)&idft_out0[ip+2])[1],
|
|
((int16_t*)&idft_out0[ip+3])[0],((int16_t*)&idft_out0[ip+3])[1]);
|
|
*/
|
|
z1[i] = ((uint32_t*)idft_out0)[ip+1];
|
|
z2[i] = ((uint32_t*)idft_out0)[ip+2];
|
|
z3[i] = ((uint32_t*)idft_out0)[ip+3];
|
|
z4[i] = ((uint32_t*)idft_out1)[ip+0];
|
|
z5[i] = ((uint32_t*)idft_out1)[ip+1];
|
|
z6[i] = ((uint32_t*)idft_out1)[ip+2];
|
|
z7[i] = ((uint32_t*)idft_out1)[ip+3];
|
|
z8[i] = ((uint32_t*)idft_out2)[ip];
|
|
z9[i] = ((uint32_t*)idft_out2)[ip+1];
|
|
|
|
if (frame_parms->Ncp==0) {
|
|
z10[i] = ((uint32_t*)idft_out2)[ip+2];
|
|
z11[i] = ((uint32_t*)idft_out2)[ip+3];
|
|
}
|
|
}
|
|
|
|
// conjugate output
|
|
for (i=0; i<(Msc_PUSCH>>2); i++) {
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
((__m128i*)z0)[i]=_mm_sign_epi16(((__m128i*)z0)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z1)[i]=_mm_sign_epi16(((__m128i*)z1)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z2)[i]=_mm_sign_epi16(((__m128i*)z2)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z3)[i]=_mm_sign_epi16(((__m128i*)z3)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z4)[i]=_mm_sign_epi16(((__m128i*)z4)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z5)[i]=_mm_sign_epi16(((__m128i*)z5)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z6)[i]=_mm_sign_epi16(((__m128i*)z6)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z7)[i]=_mm_sign_epi16(((__m128i*)z7)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z8)[i]=_mm_sign_epi16(((__m128i*)z8)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z9)[i]=_mm_sign_epi16(((__m128i*)z9)[i],*(__m128i*)&conjugate2[0]);
|
|
|
|
if (frame_parms->Ncp==NORMAL) {
|
|
((__m128i*)z10)[i]=_mm_sign_epi16(((__m128i*)z10)[i],*(__m128i*)&conjugate2[0]);
|
|
((__m128i*)z11)[i]=_mm_sign_epi16(((__m128i*)z11)[i],*(__m128i*)&conjugate2[0]);
|
|
}
|
|
#elif defined(__arm__)
|
|
*&(((int16x8_t*)z0)[i])=vmulq_s16(*&(((int16x8_t*)z0)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z1)[i])=vmulq_s16(*&(((int16x8_t*)z1)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z2)[i])=vmulq_s16(*&(((int16x8_t*)z2)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z3)[i])=vmulq_s16(*&(((int16x8_t*)z3)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z4)[i])=vmulq_s16(*&(((int16x8_t*)z4)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z5)[i])=vmulq_s16(*&(((int16x8_t*)z5)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z6)[i])=vmulq_s16(*&(((int16x8_t*)z6)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z7)[i])=vmulq_s16(*&(((int16x8_t*)z7)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z8)[i])=vmulq_s16(*&(((int16x8_t*)z8)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z9)[i])=vmulq_s16(*&(((int16x8_t*)z9)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
|
|
|
|
if (frame_parms->Ncp==NORMAL) {
|
|
*&(((int16x8_t*)z10)[i])=vmulq_s16(*&(((int16x8_t*)z10)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
*&(((int16x8_t*)z11)[i])=vmulq_s16(*&(((int16x8_t*)z11)[i]),*(int16x8_t*)&conjugate2[0]);
|
|
}
|
|
|
|
#endif
|
|
}
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
_mm_empty();
|
|
_m_empty();
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int32_t ulsch_qpsk_llr(LTE_DL_FRAME_PARMS *frame_parms,
|
|
int32_t **rxdataF_comp,
|
|
int16_t *ulsch_llr,
|
|
uint8_t symbol,
|
|
uint16_t nb_rb,
|
|
int16_t **llrp)
|
|
{
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
__m128i *rxF=(__m128i*)&rxdataF_comp[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
__m128i **llrp128 = (__m128i **)llrp;
|
|
#elif defined(__arm__)
|
|
int16x8_t *rxF= (int16x8_t*)&rxdataF_comp[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
int16x8_t **llrp128 = (int16x8_t **)llrp;
|
|
#endif
|
|
|
|
int i;
|
|
|
|
// printf("qpsk llr for symbol %d (pos %d), llr offset %d\n",symbol,(symbol*frame_parms->N_RB_DL*12),llr128U-(__m128i*)ulsch_llr);
|
|
|
|
for (i=0; i<(nb_rb*3); i++) {
|
|
//printf("%d,%d,%d,%d,%d,%d,%d,%d\n",((int16_t *)rxF)[0],((int16_t *)rxF)[1],((int16_t *)rxF)[2],((int16_t *)rxF)[3],((int16_t *)rxF)[4],((int16_t *)rxF)[5],((int16_t *)rxF)[6],((int16_t *)rxF)[7]);
|
|
*(*llrp128) = *rxF;
|
|
rxF++;
|
|
(*llrp128)++;
|
|
}
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
_mm_empty();
|
|
_m_empty();
|
|
#endif
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
void ulsch_16qam_llr(LTE_DL_FRAME_PARMS *frame_parms,
|
|
int32_t **rxdataF_comp,
|
|
int16_t *ulsch_llr,
|
|
int32_t **ul_ch_mag,
|
|
uint8_t symbol,
|
|
uint16_t nb_rb,
|
|
int16_t **llrp)
|
|
{
|
|
int i;
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
__m128i *rxF=(__m128i*)&rxdataF_comp[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
__m128i *ch_mag;
|
|
__m128i mmtmpU0;
|
|
__m128i **llrp128=(__m128i **)llrp;
|
|
ch_mag =(__m128i*)&ul_ch_mag[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
#elif defined(__arm__)
|
|
int16x8_t *rxF=(int16x8_t*)&rxdataF_comp[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
int16x8_t *ch_mag;
|
|
int16x8_t xmm0;
|
|
int16_t **llrp16=llrp;
|
|
ch_mag =(int16x8_t*)&ul_ch_mag[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
#endif
|
|
|
|
for (i=0; i<(nb_rb*3); i++) {
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
mmtmpU0 = _mm_abs_epi16(rxF[i]);
|
|
// print_shorts("tmp0",&tmp0);
|
|
|
|
mmtmpU0 = _mm_subs_epi16(ch_mag[i],mmtmpU0);
|
|
|
|
(*llrp128)[0] = _mm_unpacklo_epi32(rxF[i],mmtmpU0);
|
|
(*llrp128)[1] = _mm_unpackhi_epi32(rxF[i],mmtmpU0);
|
|
(*llrp128)+=2;
|
|
#elif defined(__arm__)
|
|
xmm0 = vabsq_s16(rxF[i]);
|
|
xmm0 = vqsubq_s16(ch_mag[i],xmm0);
|
|
(*llrp16)[0] = vgetq_lane_s16(rxF[i],0);
|
|
(*llrp16)[1] = vgetq_lane_s16(xmm0,0);
|
|
(*llrp16)[2] = vgetq_lane_s16(rxF[i],1);
|
|
(*llrp16)[3] = vgetq_lane_s16(xmm0,1);
|
|
(*llrp16)[4] = vgetq_lane_s16(rxF[i],2);
|
|
(*llrp16)[5] = vgetq_lane_s16(xmm0,2);
|
|
(*llrp16)[6] = vgetq_lane_s16(rxF[i],2);
|
|
(*llrp16)[7] = vgetq_lane_s16(xmm0,3);
|
|
(*llrp16)[8] = vgetq_lane_s16(rxF[i],4);
|
|
(*llrp16)[9] = vgetq_lane_s16(xmm0,4);
|
|
(*llrp16)[10] = vgetq_lane_s16(rxF[i],5);
|
|
(*llrp16)[11] = vgetq_lane_s16(xmm0,5);
|
|
(*llrp16)[12] = vgetq_lane_s16(rxF[i],6);
|
|
(*llrp16)[13] = vgetq_lane_s16(xmm0,6);
|
|
(*llrp16)[14] = vgetq_lane_s16(rxF[i],7);
|
|
(*llrp16)[15] = vgetq_lane_s16(xmm0,7);
|
|
(*llrp16)+=16;
|
|
#endif
|
|
|
|
|
|
// print_bytes("rxF[i]",&rxF[i]);
|
|
// print_bytes("rxF[i+1]",&rxF[i+1]);
|
|
}
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
_mm_empty();
|
|
_m_empty();
|
|
#endif
|
|
|
|
}
|
|
|
|
void ulsch_64qam_llr(LTE_DL_FRAME_PARMS *frame_parms,
|
|
int32_t **rxdataF_comp,
|
|
int16_t *ulsch_llr,
|
|
int32_t **ul_ch_mag,
|
|
int32_t **ul_ch_magb,
|
|
uint8_t symbol,
|
|
uint16_t nb_rb,
|
|
int16_t **llrp)
|
|
{
|
|
int i;
|
|
int32_t **llrp32=(int32_t **)llrp;
|
|
|
|
#if defined(__x86_64__) || defined(__i386)
|
|
__m128i *rxF=(__m128i*)&rxdataF_comp[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
__m128i *ch_mag,*ch_magb;
|
|
__m128i mmtmpU1,mmtmpU2;
|
|
|
|
ch_mag =(__m128i*)&ul_ch_mag[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
ch_magb =(__m128i*)&ul_ch_magb[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
#elif defined(__arm__)
|
|
int16x8_t *rxF=(int16x8_t*)&rxdataF_comp[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
int16x8_t *ch_mag,*ch_magb;
|
|
int16x8_t mmtmpU1,mmtmpU2;
|
|
|
|
ch_mag =(int16x8_t*)&ul_ch_mag[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
ch_magb =(int16x8_t*)&ul_ch_magb[0][(symbol*frame_parms->N_RB_DL*12)];
|
|
#endif
|
|
// printf("symbol %d: mag %d, magb %d\n",symbol,_mm_extract_epi16(ch_mag[0],0),_mm_extract_epi16(ch_magb[0],0));
|
|
for (i=0; i<(nb_rb*3); i++) {
|
|
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
mmtmpU1 = _mm_abs_epi16(rxF[i]);
|
|
|
|
mmtmpU1 = _mm_subs_epi16(ch_mag[i],mmtmpU1);
|
|
|
|
mmtmpU2 = _mm_abs_epi16(mmtmpU1);
|
|
mmtmpU2 = _mm_subs_epi16(ch_magb[i],mmtmpU2);
|
|
|
|
(*llrp32)[0] = _mm_extract_epi32(rxF[i],0);
|
|
(*llrp32)[1] = _mm_extract_epi32(mmtmpU1,0);
|
|
(*llrp32)[2] = _mm_extract_epi32(mmtmpU2,0);
|
|
(*llrp32)[3] = _mm_extract_epi32(rxF[i],1);
|
|
(*llrp32)[4] = _mm_extract_epi32(mmtmpU1,1);
|
|
(*llrp32)[5] = _mm_extract_epi32(mmtmpU2,1);
|
|
(*llrp32)[6] = _mm_extract_epi32(rxF[i],2);
|
|
(*llrp32)[7] = _mm_extract_epi32(mmtmpU1,2);
|
|
(*llrp32)[8] = _mm_extract_epi32(mmtmpU2,2);
|
|
(*llrp32)[9] = _mm_extract_epi32(rxF[i],3);
|
|
(*llrp32)[10] = _mm_extract_epi32(mmtmpU1,3);
|
|
(*llrp32)[11] = _mm_extract_epi32(mmtmpU2,3);
|
|
#elif defined(__arm__)
|
|
mmtmpU1 = vabsq_s16(rxF[i]);
|
|
|
|
mmtmpU1 = vqsubq_s16(ch_mag[i],mmtmpU1);
|
|
|
|
mmtmpU2 = vabsq_s16(mmtmpU1);
|
|
mmtmpU2 = vqsubq_s16(ch_magb[i],mmtmpU2);
|
|
|
|
(*llrp32)[0] = vgetq_lane_s32((int32x4_t)rxF[i],0);
|
|
(*llrp32)[1] = vgetq_lane_s32((int32x4_t)mmtmpU1,0);
|
|
(*llrp32)[2] = vgetq_lane_s32((int32x4_t)mmtmpU2,0);
|
|
(*llrp32)[3] = vgetq_lane_s32((int32x4_t)rxF[i],1);
|
|
(*llrp32)[4] = vgetq_lane_s32((int32x4_t)mmtmpU1,1);
|
|
(*llrp32)[5] = vgetq_lane_s32((int32x4_t)mmtmpU2,1);
|
|
(*llrp32)[6] = vgetq_lane_s32((int32x4_t)rxF[i],2);
|
|
(*llrp32)[7] = vgetq_lane_s32((int32x4_t)mmtmpU1,2);
|
|
(*llrp32)[8] = vgetq_lane_s32((int32x4_t)mmtmpU2,2);
|
|
(*llrp32)[9] = vgetq_lane_s32((int32x4_t)rxF[i],3);
|
|
(*llrp32)[10] = vgetq_lane_s32((int32x4_t)mmtmpU1,3);
|
|
(*llrp32)[11] = vgetq_lane_s32((int32x4_t)mmtmpU2,3);
|
|
|
|
#endif
|
|
(*llrp32)+=12;
|
|
}
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
_mm_empty();
|
|
_m_empty();
|
|
#endif
|
|
}
|
|
|
|
void ulsch_detection_mrc(LTE_DL_FRAME_PARMS *frame_parms,
|
|
int32_t **rxdataF_comp,
|
|
int32_t **ul_ch_mag,
|
|
int32_t **ul_ch_magb,
|
|
uint8_t symbol,
|
|
uint16_t nb_rb)
|
|
{
|
|
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
|
|
__m128i *rxdataF_comp128_0,*ul_ch_mag128_0,*ul_ch_mag128_0b;
|
|
__m128i *rxdataF_comp128_1,*ul_ch_mag128_1,*ul_ch_mag128_1b;
|
|
#elif defined(__arm__)
|
|
|
|
int16x8_t *rxdataF_comp128_0,*ul_ch_mag128_0,*ul_ch_mag128_0b;
|
|
int16x8_t *rxdataF_comp128_1,*ul_ch_mag128_1,*ul_ch_mag128_1b;
|
|
|
|
#endif
|
|
int32_t i;
|
|
|
|
if (frame_parms->nb_antennas_rx>1) {
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
rxdataF_comp128_0 = (__m128i *)&rxdataF_comp[0][symbol*frame_parms->N_RB_DL*12];
|
|
rxdataF_comp128_1 = (__m128i *)&rxdataF_comp[1][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_0 = (__m128i *)&ul_ch_mag[0][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_1 = (__m128i *)&ul_ch_mag[1][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_0b = (__m128i *)&ul_ch_magb[0][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_1b = (__m128i *)&ul_ch_magb[1][symbol*frame_parms->N_RB_DL*12];
|
|
|
|
// MRC on each re of rb, both on MF output and magnitude (for 16QAM/64QAM llr computation)
|
|
for (i=0; i<nb_rb*3; i++) {
|
|
rxdataF_comp128_0[i] = _mm_adds_epi16(_mm_srai_epi16(rxdataF_comp128_0[i],1),_mm_srai_epi16(rxdataF_comp128_1[i],1));
|
|
ul_ch_mag128_0[i] = _mm_adds_epi16(_mm_srai_epi16(ul_ch_mag128_0[i],1),_mm_srai_epi16(ul_ch_mag128_1[i],1));
|
|
ul_ch_mag128_0b[i] = _mm_adds_epi16(_mm_srai_epi16(ul_ch_mag128_0b[i],1),_mm_srai_epi16(ul_ch_mag128_1b[i],1));
|
|
rxdataF_comp128_0[i] = _mm_add_epi16(rxdataF_comp128_0[i],(*(__m128i*)&jitterc[0]));
|
|
|
|
#elif defined(__arm__)
|
|
rxdataF_comp128_0 = (int16x8_t *)&rxdataF_comp[0][symbol*frame_parms->N_RB_DL*12];
|
|
rxdataF_comp128_1 = (int16x8_t *)&rxdataF_comp[1][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_0 = (int16x8_t *)&ul_ch_mag[0][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_1 = (int16x8_t *)&ul_ch_mag[1][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_0b = (int16x8_t *)&ul_ch_magb[0][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128_1b = (int16x8_t *)&ul_ch_magb[1][symbol*frame_parms->N_RB_DL*12];
|
|
|
|
// MRC on each re of rb, both on MF output and magnitude (for 16QAM/64QAM llr computation)
|
|
for (i=0; i<nb_rb*3; i++) {
|
|
rxdataF_comp128_0[i] = vhaddq_s16(rxdataF_comp128_0[i],rxdataF_comp128_1[i]);
|
|
ul_ch_mag128_0[i] = vhaddq_s16(ul_ch_mag128_0[i],ul_ch_mag128_1[i]);
|
|
ul_ch_mag128_0b[i] = vhaddq_s16(ul_ch_mag128_0b[i],ul_ch_mag128_1b[i]);
|
|
rxdataF_comp128_0[i] = vqaddq_s16(rxdataF_comp128_0[i],(*(int16x8_t*)&jitterc[0]));
|
|
|
|
|
|
#endif
|
|
}
|
|
}
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
_mm_empty();
|
|
_m_empty();
|
|
#endif
|
|
}
|
|
|
|
void ulsch_extract_rbs_single(int32_t **rxdataF,
|
|
int32_t **rxdataF_ext,
|
|
uint32_t first_rb,
|
|
uint32_t nb_rb,
|
|
uint8_t l,
|
|
uint8_t Ns,
|
|
LTE_DL_FRAME_PARMS *frame_parms)
|
|
{
|
|
|
|
|
|
uint16_t nb_rb1,nb_rb2;
|
|
uint8_t aarx;
|
|
int32_t *rxF,*rxF_ext;
|
|
|
|
//uint8_t symbol = l+Ns*frame_parms->symbols_per_tti/2;
|
|
uint8_t symbol = l+((7-frame_parms->Ncp)*(Ns&1)); ///symbol within sub-frame
|
|
|
|
AssertFatal((frame_parms->nb_antennas_rx>0) && (frame_parms->nb_antennas_rx<5),
|
|
"nb_antennas_rx not in (1-4)\n");
|
|
|
|
for (aarx=0; aarx<frame_parms->nb_antennas_rx; aarx++) {
|
|
|
|
|
|
nb_rb1 = cmin(cmax((int)(frame_parms->N_RB_UL) - (int)(2*first_rb),(int)0),(int)(2*nb_rb)); // 2 times no. RBs before the DC
|
|
nb_rb2 = 2*nb_rb - nb_rb1; // 2 times no. RBs after the DC
|
|
|
|
#ifdef DEBUG_ULSCH
|
|
printf("ulsch_extract_rbs_single: 2*nb_rb1 = %d, 2*nb_rb2 = %d\n",nb_rb1,nb_rb2);
|
|
#endif
|
|
|
|
rxF_ext = &rxdataF_ext[aarx][(symbol*frame_parms->N_RB_UL*12)];
|
|
|
|
if (nb_rb1) {
|
|
rxF = &rxdataF[aarx][(first_rb*12 + frame_parms->first_carrier_offset + symbol*frame_parms->ofdm_symbol_size)];
|
|
memcpy(rxF_ext, rxF, nb_rb1*6*sizeof(int));
|
|
rxF_ext += nb_rb1*6;
|
|
|
|
if (nb_rb2) {
|
|
rxF = &rxdataF[aarx][(symbol*frame_parms->ofdm_symbol_size)];
|
|
memcpy(rxF_ext, rxF, nb_rb2*6*sizeof(int));
|
|
rxF_ext += nb_rb2*6;
|
|
}
|
|
} else { //there is only data in the second half
|
|
rxF = &rxdataF[aarx][(6*(2*first_rb - frame_parms->N_RB_UL) + symbol*frame_parms->ofdm_symbol_size)];
|
|
memcpy(rxF_ext, rxF, nb_rb2*6*sizeof(int));
|
|
rxF_ext += nb_rb2*6;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
void ulsch_correct_ext(int32_t **rxdataF_ext,
|
|
int32_t **rxdataF_ext2,
|
|
uint16_t symbol,
|
|
LTE_DL_FRAME_PARMS *frame_parms,
|
|
uint16_t nb_rb)
|
|
{
|
|
|
|
int32_t i,j,aarx;
|
|
int32_t *rxF_ext2,*rxF_ext;
|
|
|
|
for (aarx=0; aarx<frame_parms->nb_antennas_rx; aarx++) {
|
|
rxF_ext2 = &rxdataF_ext2[aarx][symbol*12*frame_parms->N_RB_UL];
|
|
rxF_ext = &rxdataF_ext[aarx][2*symbol*12*frame_parms->N_RB_UL];
|
|
|
|
for (i=0,j=0; i<12*nb_rb; i++,j+=2) {
|
|
rxF_ext2[i] = rxF_ext[j];
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void ulsch_channel_compensation(int32_t **rxdataF_ext,
|
|
int32_t **ul_ch_estimates_ext,
|
|
int32_t **ul_ch_mag,
|
|
int32_t **ul_ch_magb,
|
|
int32_t **rxdataF_comp,
|
|
LTE_DL_FRAME_PARMS *frame_parms,
|
|
uint8_t symbol,
|
|
uint8_t Qm,
|
|
uint16_t nb_rb,
|
|
uint8_t output_shift)
|
|
{
|
|
|
|
uint16_t rb;
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
|
|
__m128i *ul_ch128,*ul_ch_mag128,*ul_ch_mag128b,*rxdataF128,*rxdataF_comp128;
|
|
uint8_t aarx;//,symbol_mod;
|
|
__m128i mmtmpU0,mmtmpU1,mmtmpU2,mmtmpU3;
|
|
|
|
#elif defined(__arm__)
|
|
|
|
int16x4_t *ul_ch128,*rxdataF128;
|
|
int16x8_t *ul_ch_mag128,*ul_ch_mag128b,*rxdataF_comp128;
|
|
|
|
uint8_t aarx;//,symbol_mod;
|
|
int32x4_t mmtmpU0,mmtmpU1,mmtmpU0b,mmtmpU1b;
|
|
int16_t conj[4]__attribute__((aligned(16))) = {1,-1,1,-1};
|
|
int32x4_t output_shift128 = vmovq_n_s32(-(int32_t)output_shift);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
for (aarx=0; aarx<frame_parms->nb_antennas_rx; aarx++) {
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
|
|
ul_ch128 = (__m128i *)&ul_ch_estimates_ext[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128 = (__m128i *)&ul_ch_mag[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128b = (__m128i *)&ul_ch_magb[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
rxdataF128 = (__m128i *)&rxdataF_ext[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
rxdataF_comp128 = (__m128i *)&rxdataF_comp[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
|
|
#elif defined(__arm__)
|
|
|
|
|
|
ul_ch128 = (int16x4_t *)&ul_ch_estimates_ext[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128 = (int16x8_t *)&ul_ch_mag[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
ul_ch_mag128b = (int16x8_t *)&ul_ch_magb[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
rxdataF128 = (int16x4_t *)&rxdataF_ext[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
rxdataF_comp128 = (int16x8_t *)&rxdataF_comp[aarx][symbol*frame_parms->N_RB_DL*12];
|
|
|
|
#endif
|
|
for (rb=0; rb<nb_rb; rb++) {
|
|
// printf("comp: symbol %d rb %d\n",symbol,rb);
|
|
|
|
// just compute channel magnitude without scaling, this is done after equalization for SC-FDMA
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
mmtmpU0 = _mm_madd_epi16(ul_ch128[0],ul_ch128[0]);
|
|
|
|
mmtmpU0 = _mm_srai_epi32(mmtmpU0,output_shift);
|
|
mmtmpU1 = _mm_madd_epi16(ul_ch128[1],ul_ch128[1]);
|
|
|
|
mmtmpU1 = _mm_srai_epi32(mmtmpU1,output_shift);
|
|
|
|
mmtmpU0 = _mm_packs_epi32(mmtmpU0,mmtmpU1);
|
|
|
|
ul_ch_mag128[0] = _mm_unpacklo_epi16(mmtmpU0,mmtmpU0);
|
|
ul_ch_mag128[1] = _mm_unpackhi_epi16(mmtmpU0,mmtmpU0);
|
|
|
|
mmtmpU0 = _mm_madd_epi16(ul_ch128[2],ul_ch128[2]);
|
|
|
|
mmtmpU0 = _mm_srai_epi32(mmtmpU0,output_shift);
|
|
mmtmpU1 = _mm_packs_epi32(mmtmpU0,mmtmpU0);
|
|
ul_ch_mag128[2] = _mm_unpacklo_epi16(mmtmpU1,mmtmpU1);
|
|
|
|
// printf("comp: symbol %d rb %d => %d,%d,%d (output_shift %d)\n",symbol,rb,*((int16_t*)&ul_ch_mag128[0]),*((int16_t*)&ul_ch_mag128[1]),*((int16_t*)&ul_ch_mag128[2]),output_shift);
|
|
|
|
|
|
#elif defined(__arm__)
|
|
mmtmpU0 = vmull_s16(ul_ch128[0], ul_ch128[0]);
|
|
mmtmpU0 = vqshlq_s32(vqaddq_s32(mmtmpU0,vrev64q_s32(mmtmpU0)),-output_shift128);
|
|
mmtmpU1 = vmull_s16(ul_ch128[1], ul_ch128[1]);
|
|
mmtmpU1 = vqshlq_s32(vqaddq_s32(mmtmpU1,vrev64q_s32(mmtmpU1)),-output_shift128);
|
|
ul_ch_mag128[0] = vcombine_s16(vmovn_s32(mmtmpU0),vmovn_s32(mmtmpU1));
|
|
mmtmpU0 = vmull_s16(ul_ch128[2], ul_ch128[2]);
|
|
mmtmpU0 = vqshlq_s32(vqaddq_s32(mmtmpU0,vrev64q_s32(mmtmpU0)),-output_shift128);
|
|
mmtmpU1 = vmull_s16(ul_ch128[3], ul_ch128[3]);
|
|
mmtmpU1 = vqshlq_s32(vqaddq_s32(mmtmpU1,vrev64q_s32(mmtmpU1)),-output_shift128);
|
|
ul_ch_mag128[1] = vcombine_s16(vmovn_s32(mmtmpU0),vmovn_s32(mmtmpU1));
|
|
mmtmpU0 = vmull_s16(ul_ch128[4], ul_ch128[4]);
|
|
mmtmpU0 = vqshlq_s32(vqaddq_s32(mmtmpU0,vrev64q_s32(mmtmpU0)),-output_shift128);
|
|
mmtmpU1 = vmull_s16(ul_ch128[5], ul_ch128[5]);
|
|
mmtmpU1 = vqshlq_s32(vqaddq_s32(mmtmpU1,vrev64q_s32(mmtmpU1)),-output_shift128);
|
|
ul_ch_mag128[2] = vcombine_s16(vmovn_s32(mmtmpU0),vmovn_s32(mmtmpU1));
|
|
|
|
#endif
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
// multiply by conjugated channel
|
|
mmtmpU0 = _mm_madd_epi16(ul_ch128[0],rxdataF128[0]);
|
|
// print_ints("re",&mmtmpU0);
|
|
|
|
// mmtmpU0 contains real part of 4 consecutive outputs (32-bit)
|
|
mmtmpU1 = _mm_shufflelo_epi16(ul_ch128[0],_MM_SHUFFLE(2,3,0,1));
|
|
mmtmpU1 = _mm_shufflehi_epi16(mmtmpU1,_MM_SHUFFLE(2,3,0,1));
|
|
mmtmpU1 = _mm_sign_epi16(mmtmpU1,*(__m128i*)&conjugate[0]);
|
|
|
|
mmtmpU1 = _mm_madd_epi16(mmtmpU1,rxdataF128[0]);
|
|
// print_ints("im",&mmtmpU1);
|
|
// mmtmpU1 contains imag part of 4 consecutive outputs (32-bit)
|
|
mmtmpU0 = _mm_srai_epi32(mmtmpU0,output_shift);
|
|
// print_ints("re(shift)",&mmtmpU0);
|
|
mmtmpU1 = _mm_srai_epi32(mmtmpU1,output_shift);
|
|
// print_ints("im(shift)",&mmtmpU1);
|
|
mmtmpU2 = _mm_unpacklo_epi32(mmtmpU0,mmtmpU1);
|
|
mmtmpU3 = _mm_unpackhi_epi32(mmtmpU0,mmtmpU1);
|
|
// print_ints("c0",&mmtmpU2);
|
|
// print_ints("c1",&mmtmpU3);
|
|
rxdataF_comp128[0] = _mm_packs_epi32(mmtmpU2,mmtmpU3);
|
|
/*
|
|
print_shorts("rx:",&rxdataF128[0]);
|
|
print_shorts("ch:",&ul_ch128[0]);
|
|
print_shorts("pack:",&rxdataF_comp128[0]);
|
|
*/
|
|
// multiply by conjugated channel
|
|
mmtmpU0 = _mm_madd_epi16(ul_ch128[1],rxdataF128[1]);
|
|
// mmtmpU0 contains real part of 4 consecutive outputs (32-bit)
|
|
mmtmpU1 = _mm_shufflelo_epi16(ul_ch128[1],_MM_SHUFFLE(2,3,0,1));
|
|
mmtmpU1 = _mm_shufflehi_epi16(mmtmpU1,_MM_SHUFFLE(2,3,0,1));
|
|
mmtmpU1 = _mm_sign_epi16(mmtmpU1,*(__m128i*)conjugate);
|
|
mmtmpU1 = _mm_madd_epi16(mmtmpU1,rxdataF128[1]);
|
|
// mmtmpU1 contains imag part of 4 consecutive outputs (32-bit)
|
|
mmtmpU0 = _mm_srai_epi32(mmtmpU0,output_shift);
|
|
mmtmpU1 = _mm_srai_epi32(mmtmpU1,output_shift);
|
|
mmtmpU2 = _mm_unpacklo_epi32(mmtmpU0,mmtmpU1);
|
|
mmtmpU3 = _mm_unpackhi_epi32(mmtmpU0,mmtmpU1);
|
|
|
|
rxdataF_comp128[1] = _mm_packs_epi32(mmtmpU2,mmtmpU3);
|
|
// print_shorts("rx:",rxdataF128[1]);
|
|
// print_shorts("ch:",ul_ch128[1]);
|
|
// print_shorts("pack:",rxdataF_comp128[1]);
|
|
// multiply by conjugated channel
|
|
mmtmpU0 = _mm_madd_epi16(ul_ch128[2],rxdataF128[2]);
|
|
// mmtmpU0 contains real part of 4 consecutive outputs (32-bit)
|
|
mmtmpU1 = _mm_shufflelo_epi16(ul_ch128[2],_MM_SHUFFLE(2,3,0,1));
|
|
mmtmpU1 = _mm_shufflehi_epi16(mmtmpU1,_MM_SHUFFLE(2,3,0,1));
|
|
mmtmpU1 = _mm_sign_epi16(mmtmpU1,*(__m128i*)conjugate);
|
|
mmtmpU1 = _mm_madd_epi16(mmtmpU1,rxdataF128[2]);
|
|
// mmtmpU1 contains imag part of 4 consecutive outputs (32-bit)
|
|
mmtmpU0 = _mm_srai_epi32(mmtmpU0,output_shift);
|
|
mmtmpU1 = _mm_srai_epi32(mmtmpU1,output_shift);
|
|
mmtmpU2 = _mm_unpacklo_epi32(mmtmpU0,mmtmpU1);
|
|
mmtmpU3 = _mm_unpackhi_epi32(mmtmpU0,mmtmpU1);
|
|
|
|
rxdataF_comp128[2] = _mm_packs_epi32(mmtmpU2,mmtmpU3);
|
|
// print_shorts("rx:",rxdataF128[2]);
|
|
// print_shorts("ch:",ul_ch128[2]);
|
|
// print_shorts("pack:",rxdataF_comp128[2]);
|
|
|
|
// Add a jitter to compensate for the saturation in "packs" resulting in a bias on the DC after IDFT
|
|
rxdataF_comp128[0] = _mm_add_epi16(rxdataF_comp128[0],(*(__m128i*)&jitter[0]));
|
|
rxdataF_comp128[1] = _mm_add_epi16(rxdataF_comp128[1],(*(__m128i*)&jitter[0]));
|
|
rxdataF_comp128[2] = _mm_add_epi16(rxdataF_comp128[2],(*(__m128i*)&jitter[0]));
|
|
|
|
ul_ch128+=3;
|
|
ul_ch_mag128+=3;
|
|
ul_ch_mag128b+=3;
|
|
rxdataF128+=3;
|
|
rxdataF_comp128+=3;
|
|
#elif defined(__arm__)
|
|
mmtmpU0 = vmull_s16(ul_ch128[0], rxdataF128[0]);
|
|
//mmtmpU0 = [Re(ch[0])Re(rx[0]) Im(ch[0])Im(ch[0]) Re(ch[1])Re(rx[1]) Im(ch[1])Im(ch[1])]
|
|
mmtmpU1 = vmull_s16(ul_ch128[1], rxdataF128[1]);
|
|
//mmtmpU1 = [Re(ch[2])Re(rx[2]) Im(ch[2])Im(ch[2]) Re(ch[3])Re(rx[3]) Im(ch[3])Im(ch[3])]
|
|
mmtmpU0 = vcombine_s32(vpadd_s32(vget_low_s32(mmtmpU0),vget_high_s32(mmtmpU0)),
|
|
vpadd_s32(vget_low_s32(mmtmpU1),vget_high_s32(mmtmpU1)));
|
|
//mmtmpU0 = [Re(ch[0])Re(rx[0])+Im(ch[0])Im(ch[0]) Re(ch[1])Re(rx[1])+Im(ch[1])Im(ch[1]) Re(ch[2])Re(rx[2])+Im(ch[2])Im(ch[2]) Re(ch[3])Re(rx[3])+Im(ch[3])Im(ch[3])]
|
|
|
|
mmtmpU0b = vmull_s16(vrev32_s16(vmul_s16(ul_ch128[0],*(int16x4_t*)conj)), rxdataF128[0]);
|
|
//mmtmpU0 = [-Im(ch[0])Re(rx[0]) Re(ch[0])Im(rx[0]) -Im(ch[1])Re(rx[1]) Re(ch[1])Im(rx[1])]
|
|
mmtmpU1b = vmull_s16(vrev32_s16(vmul_s16(ul_ch128[1],*(int16x4_t*)conj)), rxdataF128[1]);
|
|
//mmtmpU0 = [-Im(ch[2])Re(rx[2]) Re(ch[2])Im(rx[2]) -Im(ch[3])Re(rx[3]) Re(ch[3])Im(rx[3])]
|
|
mmtmpU1 = vcombine_s32(vpadd_s32(vget_low_s32(mmtmpU0b),vget_high_s32(mmtmpU0b)),
|
|
vpadd_s32(vget_low_s32(mmtmpU1b),vget_high_s32(mmtmpU1b)));
|
|
//mmtmpU1 = [-Im(ch[0])Re(rx[0])+Re(ch[0])Im(rx[0]) -Im(ch[1])Re(rx[1])+Re(ch[1])Im(rx[1]) -Im(ch[2])Re(rx[2])+Re(ch[2])Im(rx[2]) -Im(ch[3])Re(rx[3])+Re(ch[3])Im(rx[3])]
|
|
|
|
mmtmpU0 = vqshlq_s32(mmtmpU0,-output_shift128);
|
|
mmtmpU1 = vqshlq_s32(mmtmpU1,-output_shift128);
|
|
rxdataF_comp128[0] = vcombine_s16(vmovn_s32(mmtmpU0),vmovn_s32(mmtmpU1));
|
|
mmtmpU0 = vmull_s16(ul_ch128[2], rxdataF128[2]);
|
|
mmtmpU1 = vmull_s16(ul_ch128[3], rxdataF128[3]);
|
|
mmtmpU0 = vcombine_s32(vpadd_s32(vget_low_s32(mmtmpU0),vget_high_s32(mmtmpU0)),
|
|
vpadd_s32(vget_low_s32(mmtmpU1),vget_high_s32(mmtmpU1)));
|
|
mmtmpU0b = vmull_s16(vrev32_s16(vmul_s16(ul_ch128[2],*(int16x4_t*)conj)), rxdataF128[2]);
|
|
mmtmpU1b = vmull_s16(vrev32_s16(vmul_s16(ul_ch128[3],*(int16x4_t*)conj)), rxdataF128[3]);
|
|
mmtmpU1 = vcombine_s32(vpadd_s32(vget_low_s32(mmtmpU0b),vget_high_s32(mmtmpU0b)),
|
|
vpadd_s32(vget_low_s32(mmtmpU1b),vget_high_s32(mmtmpU1b)));
|
|
mmtmpU0 = vqshlq_s32(mmtmpU0,-output_shift128);
|
|
mmtmpU1 = vqshlq_s32(mmtmpU1,-output_shift128);
|
|
rxdataF_comp128[1] = vcombine_s16(vmovn_s32(mmtmpU0),vmovn_s32(mmtmpU1));
|
|
|
|
mmtmpU0 = vmull_s16(ul_ch128[4], rxdataF128[4]);
|
|
mmtmpU1 = vmull_s16(ul_ch128[5], rxdataF128[5]);
|
|
mmtmpU0 = vcombine_s32(vpadd_s32(vget_low_s32(mmtmpU0),vget_high_s32(mmtmpU0)),
|
|
vpadd_s32(vget_low_s32(mmtmpU1),vget_high_s32(mmtmpU1)));
|
|
|
|
mmtmpU0b = vmull_s16(vrev32_s16(vmul_s16(ul_ch128[4],*(int16x4_t*)conj)), rxdataF128[4]);
|
|
mmtmpU1b = vmull_s16(vrev32_s16(vmul_s16(ul_ch128[5],*(int16x4_t*)conj)), rxdataF128[5]);
|
|
mmtmpU1 = vcombine_s32(vpadd_s32(vget_low_s32(mmtmpU0b),vget_high_s32(mmtmpU0b)),
|
|
vpadd_s32(vget_low_s32(mmtmpU1b),vget_high_s32(mmtmpU1b)));
|
|
|
|
|
|
mmtmpU0 = vqshlq_s32(mmtmpU0,-output_shift128);
|
|
mmtmpU1 = vqshlq_s32(mmtmpU1,-output_shift128);
|
|
rxdataF_comp128[2] = vcombine_s16(vmovn_s32(mmtmpU0),vmovn_s32(mmtmpU1));
|
|
|
|
// Add a jitter to compensate for the saturation in "packs" resulting in a bias on the DC after IDFT
|
|
rxdataF_comp128[0] = vqaddq_s16(rxdataF_comp128[0],(*(int16x8_t*)&jitter[0]));
|
|
rxdataF_comp128[1] = vqaddq_s16(rxdataF_comp128[1],(*(int16x8_t*)&jitter[0]));
|
|
rxdataF_comp128[2] = vqaddq_s16(rxdataF_comp128[2],(*(int16x8_t*)&jitter[0]));
|
|
|
|
|
|
ul_ch128+=6;
|
|
ul_ch_mag128+=3;
|
|
ul_ch_mag128b+=3;
|
|
rxdataF128+=6;
|
|
rxdataF_comp128+=3;
|
|
#endif
|
|
|
|
}
|
|
}
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
_mm_empty();
|
|
_m_empty();
|
|
#endif
|
|
}
|
|
|
|
void ulsch_channel_level(int32_t **drs_ch_estimates_ext,
|
|
LTE_DL_FRAME_PARMS *frame_parms,
|
|
int32_t *avg,
|
|
uint16_t nb_rb)
|
|
{
|
|
|
|
int16_t rb;
|
|
uint8_t aarx;
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
__m128i *ul_ch128;
|
|
__m128 avg128U;
|
|
#elif defined(__arm__)
|
|
int32x4_t avg128U;
|
|
int16x4_t *ul_ch128;
|
|
#endif
|
|
for (aarx=0; aarx<frame_parms->nb_antennas_rx; aarx++) {
|
|
//clear average level
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
avg128U = _mm_setzero_ps();
|
|
ul_ch128=(__m128i *)drs_ch_estimates_ext[aarx];
|
|
|
|
for (rb=0; rb<nb_rb; rb++) {
|
|
|
|
avg128U = _mm_add_ps(avg128U,_mm_cvtepi32_ps(_mm_madd_epi16(ul_ch128[0],ul_ch128[0])));
|
|
avg128U = _mm_add_ps(avg128U,_mm_cvtepi32_ps(_mm_madd_epi16(ul_ch128[1],ul_ch128[1])));
|
|
avg128U = _mm_add_ps(avg128U,_mm_cvtepi32_ps(_mm_madd_epi16(ul_ch128[2],ul_ch128[2])));
|
|
|
|
ul_ch128+=3;
|
|
|
|
|
|
}
|
|
|
|
#elif defined(__arm__)
|
|
avg128U = vdupq_n_s32(0);
|
|
ul_ch128=(int16x4_t *)drs_ch_estimates_ext[aarx];
|
|
|
|
for (rb=0; rb<nb_rb; rb++) {
|
|
|
|
avg128U = vqaddq_s32(avg128U,vmull_s16(ul_ch128[0],ul_ch128[0]));
|
|
avg128U = vqaddq_s32(avg128U,vmull_s16(ul_ch128[1],ul_ch128[1]));
|
|
avg128U = vqaddq_s32(avg128U,vmull_s16(ul_ch128[2],ul_ch128[2]));
|
|
avg128U = vqaddq_s32(avg128U,vmull_s16(ul_ch128[3],ul_ch128[3]));
|
|
avg128U = vqaddq_s32(avg128U,vmull_s16(ul_ch128[4],ul_ch128[4]));
|
|
avg128U = vqaddq_s32(avg128U,vmull_s16(ul_ch128[5],ul_ch128[5]));
|
|
ul_ch128+=6;
|
|
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
DevAssert( nb_rb );
|
|
avg[aarx] = (int)((((float*)&avg128U)[0] +
|
|
((float*)&avg128U)[1] +
|
|
((float*)&avg128U)[2] +
|
|
((float*)&avg128U)[3])/(float)(nb_rb*12));
|
|
|
|
}
|
|
|
|
#if defined(__x86_64__) || defined(__i386__)
|
|
_mm_empty();
|
|
_m_empty();
|
|
#endif
|
|
}
|
|
|
|
int ulsch_power_LUT[750];
|
|
|
|
void init_ulsch_power_LUT(void) {
|
|
|
|
int i;
|
|
|
|
for (i=0;i<750;i++) ulsch_power_LUT[i] = (int)ceil((pow(2.0,(double)i/100) - 1.0));
|
|
|
|
}
|
|
|
|
void rx_ulsch(PHY_VARS_eNB *eNB,
|
|
eNB_rxtx_proc_t *proc,
|
|
uint8_t UE_id) {
|
|
|
|
|
|
LTE_eNB_ULSCH_t **ulsch = eNB->ulsch;
|
|
|
|
// flagMag = 0;
|
|
LTE_eNB_COMMON *common_vars = &eNB->common_vars;
|
|
LTE_eNB_PUSCH *pusch_vars = eNB->pusch_vars[UE_id];
|
|
LTE_DL_FRAME_PARMS *frame_parms = &eNB->frame_parms;
|
|
|
|
uint32_t l,i;
|
|
int32_t avgs;
|
|
uint8_t log2_maxh=0,aarx;
|
|
int32_t avgU[eNB->frame_parms.nb_antennas_rx];
|
|
|
|
|
|
// uint8_t harq_pid = ( ulsch->RRCConnRequest_flag== 0) ? subframe2harq_pid_tdd(frame_parms->tdd_config,subframe) : 0;
|
|
uint8_t harq_pid;
|
|
uint8_t Qm;
|
|
int16_t *llrp;
|
|
int subframe = proc->subframe_rx;
|
|
|
|
harq_pid = subframe2harq_pid(frame_parms,proc->frame_rx,subframe);
|
|
Qm = ulsch[UE_id]->harq_processes[harq_pid]->Qm;
|
|
#ifdef DEBUG_ULSCH
|
|
printf("rx_ulsch: harq_pid %d, nb_rb %d first_rb %d\n",harq_pid,ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,ulsch[UE_id]->harq_processes[harq_pid]->first_rb);
|
|
|
|
#endif //DEBUG_ULSCH
|
|
|
|
if (ulsch[UE_id]->harq_processes[harq_pid]->nb_rb == 0) {
|
|
LOG_E(PHY,"PUSCH (%d/%x) nb_rb=0!\n", harq_pid,ulsch[UE_id]->rnti);
|
|
return;
|
|
}
|
|
|
|
for (l=0; l<(frame_parms->symbols_per_tti-ulsch[UE_id]->harq_processes[harq_pid]->srs_active); l++) {
|
|
|
|
#ifdef DEBUG_ULSCH
|
|
printf("rx_ulsch : symbol %d (first_rb %d,nb_rb %d), rxdataF %p, rxdataF_ext %p\n",l,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->first_rb,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,
|
|
common_vars->rxdataF,
|
|
pusch_vars->rxdataF_ext);
|
|
#endif //DEBUG_ULSCH
|
|
|
|
ulsch_extract_rbs_single(common_vars->rxdataF,
|
|
pusch_vars->rxdataF_ext,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->first_rb,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,
|
|
l%(frame_parms->symbols_per_tti/2),
|
|
l/(frame_parms->symbols_per_tti/2),
|
|
frame_parms);
|
|
|
|
lte_ul_channel_estimation(eNB,proc,
|
|
UE_id,
|
|
l%(frame_parms->symbols_per_tti/2),
|
|
l/(frame_parms->symbols_per_tti/2));
|
|
}
|
|
|
|
int correction_factor = 1;
|
|
int deltaMCS=1;
|
|
int MPR_times_100Ks;
|
|
|
|
if (deltaMCS==1) {
|
|
// Note we're using TBS instead of sumKr, since didn't run segmentation yet!
|
|
|
|
MPR_times_100Ks = 500*ulsch[UE_id]->harq_processes[harq_pid]->TBS/(ulsch[UE_id]->harq_processes[harq_pid]->nb_rb*12*4*ulsch[UE_id]->harq_processes[harq_pid]->Nsymb_pusch);
|
|
|
|
AssertFatal(MPR_times_100Ks < 750 && MPR_times_100Ks >= 0,"Impossible value for MPR_times_100Ks %d (TBS %d,Nre %d)\n",
|
|
MPR_times_100Ks,ulsch[UE_id]->harq_processes[harq_pid]->TBS,
|
|
(ulsch[UE_id]->harq_processes[harq_pid]->nb_rb*12*4*ulsch[UE_id]->harq_processes[harq_pid]->Nsymb_pusch));
|
|
|
|
if (MPR_times_100Ks > 0) correction_factor = ulsch_power_LUT[MPR_times_100Ks];
|
|
|
|
}
|
|
for (i=0; i<frame_parms->nb_antennas_rx; i++) {
|
|
|
|
pusch_vars->ulsch_power[i] = signal_energy_nodc(pusch_vars->drs_ch_estimates[i],
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb*12)/correction_factor;
|
|
/* printf("%4.4d.%d power harq_pid %d rb %2.2d TBS %2.2d (MPR_times_Ks %d correction %d) power %d dBtimes10\n", proc->frame_rx, proc->subframe_rx, harq_pid, ulsch[UE_id]->harq_processes[harq_pid]->nb_rb, ulsch[UE_id]->harq_processes[harq_pid]->TBS,MPR_times_100Ks,correction_factor,dB_fixed_times10(pusch_vars->ulsch_power[i]));
|
|
*/
|
|
}
|
|
|
|
|
|
//write_output("rxdataF_ext.m","rxF_ext",pusch_vars->rxdataF_ext[eNB_id][0],300*(frame_parms->symbols_per_tti-ulsch[UE_id]->srs_active),1,1);
|
|
//write_output("ulsch_chest.m","drs_est",pusch_vars->drs_ch_estimates[eNB_id][0],300*(frame_parms->symbols_per_tti-ulsch[UE_id]->srs_active),1,1);
|
|
|
|
|
|
ulsch_channel_level(pusch_vars->drs_ch_estimates,
|
|
frame_parms,
|
|
avgU,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb);
|
|
|
|
// printf("[ULSCH] avg[0] %d\n",avgU[0]);
|
|
|
|
|
|
avgs = 0;
|
|
|
|
for (aarx=0; aarx<frame_parms->nb_antennas_rx; aarx++)
|
|
avgs = cmax(avgs,avgU[aarx]);
|
|
|
|
// log2_maxh = 4+(log2_approx(avgs)/2);
|
|
|
|
log2_maxh = (log2_approx(avgs)/2)+ log2_approx(frame_parms->nb_antennas_rx-1)+4;
|
|
|
|
#ifdef DEBUG_ULSCH
|
|
printf("[ULSCH] log2_maxh = %d (%d,%d)\n",log2_maxh,avgU[0],avgs);
|
|
#endif
|
|
|
|
|
|
for (l=0; l<(frame_parms->symbols_per_tti-ulsch[UE_id]->harq_processes[harq_pid]->srs_active); l++) {
|
|
|
|
if (((frame_parms->Ncp == 0) && ((l==3) || (l==10)))|| // skip pilots
|
|
((frame_parms->Ncp == 1) && ((l==2) || (l==8)))) {
|
|
l++;
|
|
}
|
|
|
|
ulsch_channel_compensation(
|
|
pusch_vars->rxdataF_ext,
|
|
pusch_vars->drs_ch_estimates,
|
|
pusch_vars->ul_ch_mag,
|
|
pusch_vars->ul_ch_magb,
|
|
pusch_vars->rxdataF_comp,
|
|
frame_parms,
|
|
l,
|
|
Qm,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,
|
|
log2_maxh); // log2_maxh+I0_shift
|
|
|
|
|
|
|
|
|
|
if (frame_parms->nb_antennas_rx > 1)
|
|
ulsch_detection_mrc(frame_parms,
|
|
pusch_vars->rxdataF_comp,
|
|
pusch_vars->ul_ch_mag,
|
|
pusch_vars->ul_ch_magb,
|
|
l,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb);
|
|
|
|
|
|
|
|
// if ((eNB->measurements.n0_power_dB[0]+3)<pusch_vars->ulsch_power[0]) {
|
|
if (23<pusch_vars->ulsch_power[0]) {
|
|
freq_equalization(frame_parms,
|
|
pusch_vars->rxdataF_comp,
|
|
pusch_vars->ul_ch_mag,
|
|
pusch_vars->ul_ch_magb,
|
|
l,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb*12,
|
|
Qm);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
//#ifdef DEBUG_ULSCH
|
|
// Inverse-Transform equalized outputs
|
|
// printf("Doing IDFTs\n");
|
|
lte_idft(frame_parms,
|
|
(uint32_t*)pusch_vars->rxdataF_comp[0],
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb*12);
|
|
// printf("Done\n");
|
|
//#endif //DEBUG_ULSCH
|
|
|
|
|
|
|
|
|
|
|
|
llrp = (int16_t*)&pusch_vars->llr[0];
|
|
|
|
T(T_ENB_PHY_PUSCH_IQ, T_INT(0), T_INT(ulsch[UE_id]->rnti), T_INT(proc->frame_rx),
|
|
T_INT(subframe), T_INT(ulsch[UE_id]->harq_processes[harq_pid]->nb_rb),
|
|
T_INT(frame_parms->N_RB_UL), T_INT(frame_parms->symbols_per_tti),
|
|
T_BUFFER(pusch_vars->rxdataF_comp[0],
|
|
2 * /* ulsch[UE_id]->harq_processes[harq_pid]->nb_rb */ frame_parms->N_RB_UL *12*frame_parms->symbols_per_tti*2));
|
|
|
|
for (l=0; l<frame_parms->symbols_per_tti-ulsch[UE_id]->harq_processes[harq_pid]->srs_active; l++) {
|
|
|
|
if (((frame_parms->Ncp == 0) && ((l==3) || (l==10)))|| // skip pilots
|
|
((frame_parms->Ncp == 1) && ((l==2) || (l==8)))) {
|
|
l++;
|
|
}
|
|
|
|
switch (Qm) {
|
|
case 2 :
|
|
ulsch_qpsk_llr(frame_parms,
|
|
pusch_vars->rxdataF_comp,
|
|
pusch_vars->llr,
|
|
l,
|
|
ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,
|
|
&llrp);
|
|
break;
|
|
|
|
case 4 :
|
|
ulsch_16qam_llr(frame_parms,
|
|
pusch_vars->rxdataF_comp,
|
|
pusch_vars->llr,
|
|
pusch_vars->ul_ch_mag,
|
|
l,ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,
|
|
&llrp);
|
|
break;
|
|
|
|
case 6 :
|
|
ulsch_64qam_llr(frame_parms,
|
|
pusch_vars->rxdataF_comp,
|
|
pusch_vars->llr,
|
|
pusch_vars->ul_ch_mag,
|
|
pusch_vars->ul_ch_magb,
|
|
l,ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,
|
|
&llrp);
|
|
break;
|
|
|
|
default:
|
|
#ifdef DEBUG_ULSCH
|
|
printf("ulsch_demodulation.c (rx_ulsch): Unknown Qm!!!!\n");
|
|
#endif //DEBUG_ULSCH
|
|
break;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
void rx_ulsch_emul(PHY_VARS_eNB *eNB,
|
|
eNB_rxtx_proc_t *proc,
|
|
uint8_t UE_index)
|
|
{
|
|
printf("[PHY] EMUL eNB %d rx_ulsch_emul : subframe %d, UE_index %d\n",eNB->Mod_id,proc->subframe_rx,UE_index);
|
|
eNB->pusch_vars[UE_index]->ulsch_power[0] = 31622; //=45dB;
|
|
eNB->pusch_vars[UE_index]->ulsch_power[1] = 31622; //=45dB;
|
|
|
|
}
|
|
|
|
|
|
void dump_ulsch(PHY_VARS_eNB *eNB,int frame,int subframe,uint8_t UE_id,int round) {
|
|
|
|
uint32_t nsymb = (eNB->frame_parms.Ncp == 0) ? 14 : 12;
|
|
uint8_t harq_pid;
|
|
char fname[100],vname[100];
|
|
|
|
harq_pid = subframe2harq_pid(&eNB->frame_parms,frame,subframe);
|
|
|
|
printf("Dumping ULSCH in subframe %d with harq_pid %d, round %d for NB_rb %d, TBS %d, Qm %d, N_symb %d\n",
|
|
subframe,harq_pid,round,eNB->ulsch[UE_id]->harq_processes[harq_pid]->nb_rb,
|
|
eNB->ulsch[UE_id]->harq_processes[harq_pid]->TBS,eNB->ulsch[UE_id]->harq_processes[harq_pid]->Qm,
|
|
eNB->ulsch[UE_id]->harq_processes[harq_pid]->Nsymb_pusch);
|
|
sprintf(fname,"/tmp/ulsch_r%d_d",round);
|
|
sprintf(vname,"/tmp/ulsch_r%d_dseq",round);
|
|
write_output(fname,vname,&eNB->ulsch[UE_id]->harq_processes[harq_pid]->d[0][96],
|
|
eNB->ulsch[UE_id]->harq_processes[harq_pid]->Kplus*3,1,0);
|
|
if (eNB->common_vars.rxdata) {
|
|
sprintf(fname,"/tmp/rxsig0_r%d.m",round);
|
|
sprintf(vname,"rxs0_r%d",round);
|
|
write_output(fname,vname, &eNB->common_vars.rxdata[0][0],eNB->frame_parms.samples_per_tti*10,1,1);
|
|
|
|
if (eNB->frame_parms.nb_antennas_rx>1)
|
|
if (eNB->common_vars.rxdata) {
|
|
sprintf(fname,"/tmp/rxsig1_r%d.m",round);
|
|
sprintf(vname,"rxs1_r%d",round);
|
|
write_output(fname,vname, &eNB->common_vars.rxdata[1][0],eNB->frame_parms.samples_per_tti*10,1,1);
|
|
}
|
|
}
|
|
|
|
sprintf(fname,"/tmp/rxsigF0_r%d.m",round);
|
|
sprintf(vname,"rxsF0_r%d",round);
|
|
write_output(fname,vname, (void*)&eNB->common_vars.rxdataF[0][0],eNB->frame_parms.ofdm_symbol_size*nsymb,1,1);
|
|
|
|
if (eNB->frame_parms.nb_antennas_rx>1) {
|
|
sprintf(fname,"/tmp/rxsigF1_r%d.m",round);
|
|
sprintf(vname,"rxsF1_r%d",round);
|
|
write_output(vname,fname, &eNB->common_vars.rxdataF[1][0],eNB->frame_parms.ofdm_symbol_size*nsymb,1,1);
|
|
}
|
|
|
|
sprintf(fname,"/tmp/rxsigF0_ext_r%d.m",round);
|
|
sprintf(vname,"rxsF0_ext_r%d",round);
|
|
write_output(fname,vname, &eNB->pusch_vars[UE_id]->rxdataF_ext[0][0],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
|
|
if (eNB->frame_parms.nb_antennas_rx>1) {
|
|
sprintf(fname,"/tmp/rxsigF1_ext_r%d.m",round);
|
|
sprintf(vname,"rxsF1_ext_r%d",round);
|
|
write_output(fname,vname,&eNB->pusch_vars[UE_id]->rxdataF_ext[1][0],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
}
|
|
/*
|
|
if (eNB->srs_vars[UE_id].srs_ch_estimates) write_output("/tmp/srs_est0.m","srsest0",eNB->srs_vars[UE_id].srs_ch_estimates[0],eNB->frame_parms.ofdm_symbol_size,1,1);
|
|
|
|
if (eNB->frame_parms.nb_antennas_rx>1)
|
|
if (eNB->srs_vars[UE_id].srs_ch_estimates) write_output("/tmp/srs_est1.m","srsest1",eNB->srs_vars[UE_id].srs_ch_estimates[1],eNB->frame_parms.ofdm_symbol_size,1,1);
|
|
*/
|
|
|
|
sprintf(fname,"/tmp/drs_est0_r%d.m",round);
|
|
sprintf(vname,"drsest0_r%d",round);
|
|
write_output(fname,vname,eNB->pusch_vars[UE_id]->drs_ch_estimates[0],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
|
|
if (eNB->frame_parms.nb_antennas_rx>1) {
|
|
sprintf(fname,"/tmp/drs_est1_r%d.m",round);
|
|
sprintf(vname,"drsest1_r%d",round);
|
|
write_output(fname,vname,eNB->pusch_vars[UE_id]->drs_ch_estimates[1],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
}
|
|
|
|
sprintf(fname,"/tmp/ulsch0_rxF_comp0_r%d.m",round);
|
|
sprintf(vname,"ulsch0_rxF_comp0_r%d",round);
|
|
write_output(fname,vname,&eNB->pusch_vars[UE_id]->rxdataF_comp[0][0],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
// write_output("ulsch_rxF_comp1.m","ulsch0_rxF_comp1",&eNB->pusch_vars[UE_id]->rxdataF_comp[0][1][0],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
sprintf(fname,"/tmp/ulsch_rxF_llr_r%d.m",round);
|
|
sprintf(vname,"ulsch_llr_r%d",round);
|
|
write_output(fname,vname,eNB->pusch_vars[UE_id]->llr,
|
|
eNB->ulsch[UE_id]->harq_processes[harq_pid]->nb_rb*12*eNB->ulsch[UE_id]->harq_processes[harq_pid]->Qm
|
|
*eNB->ulsch[UE_id]->harq_processes[harq_pid]->Nsymb_pusch,1,0);
|
|
sprintf(fname,"/tmp/ulsch_ch_mag_r%d.m",round);
|
|
sprintf(vname,"ulsch_ch_mag_r%d",round);
|
|
write_output(fname,vname,&eNB->pusch_vars[UE_id]->ul_ch_mag[0][0],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
// write_output("ulsch_ch_mag1.m","ulsch_ch_mag1",&eNB->pusch_vars[UE_id]->ul_ch_mag[1][0],eNB->frame_parms.N_RB_UL*12*nsymb,1,1);
|
|
//#endif
|
|
}
|
|
|