maki/openairinterface5g
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
Files
56c3197b09aed282cb29fcdb63472df71684e5e8
openairinterface5g/openair1/PHY/MODULATION/ul_7_5_kHz.c
T
ghaddab 56c3197b09 License Corrected 
git-svn-id: http://svn.eurecom.fr/openair4G/trunk@5713 818b1a75-f10b-46b9-bf7c-635c3b92a50f
2014-08-13 16:22:56 +00:00

536 lines
16 KiB
C
Executable File
Raw Blame History

/*******************************************************************************
OpenAirInterface
Copyright(c) 1999 - 2014 Eurecom
OpenAirInterface is free software: you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.
OpenAirInterface is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with OpenAirInterface.The full GNU General Public License is
included in this distribution in the file called "COPYING". If not,
see <http://www.gnu.org/licenses/>.
Contact Information
OpenAirInterface Admin: openair_admin@eurecom.fr
OpenAirInterface Tech : openair_tech@eurecom.fr
OpenAirInterface Dev : openair4g-devel@eurecom.fr
Address : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
*******************************************************************************/
#ifdef __SSE2__
#include <emmintrin.h>
#include <xmmintrin.h>
#endif
#ifdef __SSE3__
#include <pmmintrin.h>
#include <tmmintrin.h>
#endif
#include "PHY/defs.h"
#include "PHY/extern.h"
#include "extern.h"
#include "kHz_7_5.h"
#include "prach625Hz.h"
#ifdef USER_MODE
#include <math.h>
#else
#include "rtai_math.h"
#endif
#ifndef __SSE3__
__m128i zero;
#define _mm_abs_epi16(xmmx) _mm_xor_si128((xmmx),_mm_cmpgt_epi16(zero,(xmmx)))
#define _mm_sign_epi16(xmmx,xmmy) _mm_xor_si128((xmmx),_mm_cmpgt_epi16(zero,(xmmy)))
#endif
short conjugate75[8]__attribute__((aligned(16))) = {-1,1,-1,1,-1,1,-1,1} ;
short conjugate75_2[8]__attribute__((aligned(16))) = {1,-1,1,-1,1,-1,1,-1} ;
short negate[8]__attribute__((aligned(16))) = {-1,-1,-1,-1,-1,-1,-1,-1};
void apply_7_5_kHz(PHY_VARS_UE *phy_vars_ue,int32_t*txdata,uint8_t slot) {
uint16_t len;
uint32_t *kHz7_5ptr;
__m128i *txptr128,*kHz7_5ptr128,mmtmp_re,mmtmp_im,mmtmp_re2,mmtmp_im2;
uint32_t slot_offset;
// uint8_t aa;
uint32_t i;
LTE_DL_FRAME_PARMS *frame_parms=&phy_vars_ue->lte_frame_parms;
switch (frame_parms->N_RB_UL) {
case 6:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s6n_kHz_7_5 : (uint32_t*)s6e_kHz_7_5;
break;
case 15:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s15n_kHz_7_5 : (uint32_t*)s15e_kHz_7_5;
break;
case 25:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s25n_kHz_7_5 : (uint32_t*)s25e_kHz_7_5;
break;
case 50:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s50n_kHz_7_5 : (uint32_t*)s50e_kHz_7_5;
break;
case 75:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s75n_kHz_7_5 : (uint32_t*)s75e_kHz_7_5;
break;
case 100:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s100n_kHz_7_5 : (uint32_t*)s100e_kHz_7_5;
break;
default:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s25n_kHz_7_5 : (uint32_t*)s25e_kHz_7_5;
break;
}
slot_offset = (uint32_t)slot * phy_vars_ue->lte_frame_parms.samples_per_tti/2;
// if ((slot&1)==1)
// slot_offset += (len/4);
len = phy_vars_ue->lte_frame_parms.samples_per_tti/2;
//for (aa=0;aa<phy_vars_ue->lte_frame_parms.nb_antennas_tx;aa++) {
txptr128 = (__m128i *)&txdata[slot_offset];
kHz7_5ptr128 = (__m128i *)kHz7_5ptr;
// apply 7.5 kHz
// if (((slot>>1)&1) == 0) { // apply the sinusoid from the table directly
for (i=0;i<(len>>2);i++) {
mmtmp_re = _mm_madd_epi16(*txptr128,*kHz7_5ptr128);
// Real part of complex multiplication (note: 7_5kHz signal is conjugated for this to work)
mmtmp_im = _mm_shufflelo_epi16(*kHz7_5ptr128,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_shufflehi_epi16(mmtmp_im,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_sign_epi16(mmtmp_im,*(__m128i*)&conjugate75[0]);
mmtmp_im = _mm_madd_epi16(mmtmp_im,txptr128[0]);
mmtmp_re = _mm_srai_epi32(mmtmp_re,15);
mmtmp_im = _mm_srai_epi32(mmtmp_im,15);
mmtmp_re2 = _mm_unpacklo_epi32(mmtmp_re,mmtmp_im);
mmtmp_im2 = _mm_unpackhi_epi32(mmtmp_re,mmtmp_im);
/*
printf("%d: (%d,%d) (%d,%d) (%d,%d) (%d,%d) x (%d,%d) (%d,%d) (%d,%d) (%d,%d) => ",
i,
((short*)txptr128)[0],
((short*)txptr128)[1],
((short*)txptr128)[2],
((short*)txptr128)[3],
((short*)txptr128)[4],
((short*)txptr128)[5],
((short*)txptr128)[6],
((short*)txptr128)[7],
((short*)kHz7_5ptr128)[0],
((short*)kHz7_5ptr128)[1],
((short*)kHz7_5ptr128)[2],
((short*)kHz7_5ptr128)[3],
((short*)kHz7_5ptr128)[4],
((short*)kHz7_5ptr128)[5],
((short*)kHz7_5ptr128)[6],
((short*)kHz7_5ptr128)[7]);*/
txptr128[0] = _mm_packs_epi32(mmtmp_re2,mmtmp_im2);
/* printf("%(%d,%d) (%d,%d) (%d,%d) (%d,%d)\n",
((short*)txptr128)[0],
((short*)txptr128)[1],
((short*)txptr128)[2],
((short*)txptr128)[3],
((short*)txptr128)[4],
((short*)txptr128)[5],
((short*)txptr128)[6],
((short*)txptr128)[7]);*/
txptr128++;
kHz7_5ptr128++;
}
//}
}
void remove_7_5_kHz(PHY_VARS_eNB *phy_vars_eNB,uint8_t slot) {
int32_t **rxdata=phy_vars_eNB->lte_eNB_common_vars.rxdata[0];
int32_t **rxdata_7_5kHz=phy_vars_eNB->lte_eNB_common_vars.rxdata_7_5kHz[0];
uint16_t len;
uint32_t *kHz7_5ptr;
__m128i *rxptr128,*rxptr128_7_5kHz,*kHz7_5ptr128,kHz7_5_2,mmtmp_re,mmtmp_im,mmtmp_re2,mmtmp_im2;
uint32_t slot_offset,slot_offset2;
uint8_t aa;
uint32_t i;
LTE_DL_FRAME_PARMS *frame_parms=&phy_vars_eNB->lte_frame_parms;
switch (phy_vars_eNB->lte_frame_parms.N_RB_UL) {
case 6:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s6n_kHz_7_5 : (uint32_t*)s6e_kHz_7_5;
break;
case 15:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s15n_kHz_7_5 : (uint32_t*)s15e_kHz_7_5;
break;
case 25:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s25n_kHz_7_5 : (uint32_t*)s25e_kHz_7_5;
break;
case 50:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s50n_kHz_7_5 : (uint32_t*)s50e_kHz_7_5;
break;
case 75:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s75n_kHz_7_5 : (uint32_t*)s75e_kHz_7_5;
break;
case 100:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s100n_kHz_7_5 : (uint32_t*)s100e_kHz_7_5;
break;
default:
kHz7_5ptr = (frame_parms->Ncp==0) ? (uint32_t*)s25n_kHz_7_5 : (uint32_t*)s25e_kHz_7_5;
break;
}
slot_offset = (uint32_t)slot * phy_vars_eNB->lte_frame_parms.samples_per_tti/2;
slot_offset2 = (uint32_t)(slot&1) * phy_vars_eNB->lte_frame_parms.samples_per_tti/2;
len = phy_vars_eNB->lte_frame_parms.samples_per_tti/2;
for (aa=0;aa<phy_vars_eNB->lte_frame_parms.nb_antennas_rx;aa++) {
rxptr128 = (__m128i *)&rxdata[aa][slot_offset];
rxptr128_7_5kHz = (__m128i *)&rxdata_7_5kHz[aa][slot_offset2];
kHz7_5ptr128 = (__m128i *)kHz7_5ptr;
// apply 7.5 kHz
// if (((slot>>1)&1) == 0) { // apply the sinusoid from the table directly
for (i=0;i<(len>>2);i++) {
kHz7_5_2 = _mm_sign_epi16(*kHz7_5ptr128,*(__m128i*)&conjugate75_2[0]);
mmtmp_re = _mm_madd_epi16(*rxptr128,kHz7_5_2);
// Real part of complex multiplication (note: 7_5kHz signal is conjugated for this to work)
mmtmp_im = _mm_shufflelo_epi16(kHz7_5_2,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_shufflehi_epi16(mmtmp_im,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_sign_epi16(mmtmp_im,*(__m128i*)&conjugate75[0]);
mmtmp_im = _mm_madd_epi16(mmtmp_im,rxptr128[0]);
mmtmp_re = _mm_srai_epi32(mmtmp_re,15);
mmtmp_im = _mm_srai_epi32(mmtmp_im,15);
mmtmp_re2 = _mm_unpacklo_epi32(mmtmp_re,mmtmp_im);
mmtmp_im2 = _mm_unpackhi_epi32(mmtmp_re,mmtmp_im);
rxptr128_7_5kHz[0] = _mm_packs_epi32(mmtmp_re2,mmtmp_im2);
rxptr128++;
rxptr128_7_5kHz++;
kHz7_5ptr128++;
}
}
}
void apply_625_Hz(PHY_VARS_UE *phy_vars_ue,int16_t *prach) {
uint32_t *Hz625ptr;
__m128i *txptr128,*Hz625ptr128,mmtmp_re,mmtmp_im,mmtmp_re2,mmtmp_im2;
uint8_t aa;
uint32_t Ncp,len;
uint32_t i;
LTE_DL_FRAME_PARMS *frame_parms=&phy_vars_ue->lte_frame_parms;
uint8_t frame_type = phy_vars_ue->lte_frame_parms.frame_type;
uint8_t prach_ConfigIndex = phy_vars_ue->lte_frame_parms.prach_config_common.prach_ConfigInfo.prach_ConfigIndex;
uint8_t prach_fmt = get_prach_fmt(prach_ConfigIndex,frame_type);
switch (prach_fmt) {
case 0:
Ncp = 3168;
break;
case 1:
case 3:
Ncp = 21024;
break;
case 2:
Ncp = 6240;
break;
case 4:
Ncp = 448;
break;
default:
Ncp = 3168;
break;
}
switch (frame_parms->N_RB_UL) {
case 6:
Hz625ptr = (uint32_t*)sig625_1_25MHz;
len = 1536 + (Ncp>>4);
break;
case 15:
Hz625ptr = (uint32_t*)sig625_2_5MHz;
len = 3072 + (Ncp>>3);
break;
case 25:
Hz625ptr = (uint32_t*)sig625_5MHz;
len = 6144+(Ncp>>2);
break;
case 50:
Hz625ptr = (uint32_t*)sig625_10MHz;
len = 12288+(Ncp>>1);
break;
case 75:
Hz625ptr = (uint32_t*)sig625_15MHz;
len = 18432+((2*Ncp)/3);
break;
case 100:
Hz625ptr = (uint32_t*)sig625_20MHz;
len = 24576+Ncp;
break;
default:
Hz625ptr = (uint32_t*)sig625_5MHz;
len = 6144+(Ncp>>2);
break;
}
for (aa=0;aa<phy_vars_ue->lte_frame_parms.nb_antennas_tx;aa++) {
txptr128 = (__m128i *)prach;
Hz625ptr128 = (__m128i *)Hz625ptr;
// apply 7.5 kHz
// if (((slot>>1)&1) == 0) { // apply the sinusoid from the table directly
for (i=0;i<(len>>2);i++) {
mmtmp_re = _mm_madd_epi16(*txptr128,*Hz625ptr128);
// Real part of complex multiplication (note: 7_5kHz signal is conjugated for this to work)
mmtmp_im = _mm_shufflelo_epi16(*Hz625ptr128,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_shufflehi_epi16(mmtmp_im,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_sign_epi16(mmtmp_im,*(__m128i*)&conjugate75[0]);
mmtmp_im = _mm_madd_epi16(mmtmp_im,txptr128[0]);
mmtmp_re = _mm_srai_epi32(mmtmp_re,15);
mmtmp_im = _mm_srai_epi32(mmtmp_im,15);
mmtmp_re2 = _mm_unpacklo_epi32(mmtmp_re,mmtmp_im);
mmtmp_im2 = _mm_unpackhi_epi32(mmtmp_re,mmtmp_im);
/*
printf("%d: (%d,%d) (%d,%d) (%d,%d) (%d,%d) x (%d,%d) (%d,%d) (%d,%d) (%d,%d) => ",
i,
((short*)txptr128)[0],
((short*)txptr128)[1],
((short*)txptr128)[2],
((short*)txptr128)[3],
((short*)txptr128)[4],
((short*)txptr128)[5],
((short*)txptr128)[6],
((short*)txptr128)[7],
((short*)Hz625ptr128)[0],
((short*)Hz625ptr128)[1],
((short*)Hz625ptr128)[2],
((short*)Hz625ptr128)[3],
((short*)Hz625ptr128)[4],
((short*)Hz625ptr128)[5],
((short*)Hz625ptr128)[6],
((short*)Hz625ptr128)[7]);*/
txptr128[0] = _mm_packs_epi32(mmtmp_re2,mmtmp_im2);
/* printf("%(%d,%d) (%d,%d) (%d,%d) (%d,%d)\n",
((short*)txptr128)[0],
((short*)txptr128)[1],
((short*)txptr128)[2],
((short*)txptr128)[3],
((short*)txptr128)[4],
((short*)txptr128)[5],
((short*)txptr128)[6],
((short*)txptr128)[7]);*/
txptr128++;
Hz625ptr128++;
}
}
}
void remove_625_Hz(PHY_VARS_eNB *phy_vars_eNB,int16_t *prach) {
uint32_t *Hz625ptr;
__m128i *txptr128,*Hz625ptr128,Hz625_2,mmtmp_re,mmtmp_im,mmtmp_re2,mmtmp_im2;
uint8_t aa;
uint32_t i,Ncp,len;
LTE_DL_FRAME_PARMS *frame_parms=&phy_vars_eNB->lte_frame_parms;
uint8_t frame_type = frame_parms->frame_type;
uint8_t prach_ConfigIndex = frame_parms->prach_config_common.prach_ConfigInfo.prach_ConfigIndex;
uint8_t prach_fmt = get_prach_fmt(prach_ConfigIndex,frame_type);
switch (prach_fmt) {
case 0:
Ncp = 3168;
break;
case 1:
case 3:
Ncp = 21024;
break;
case 2:
Ncp = 6240;
break;
case 4:
Ncp = 448;
break;
default:
Ncp = 3168;
break;
}
switch (frame_parms->N_RB_UL) {
case 6:
Hz625ptr = (uint32_t*)sig625_1_25MHz;
len = 1536 + (Ncp>>4);
break;
case 15:
Hz625ptr = (uint32_t*)sig625_2_5MHz;
len = 3072 + (Ncp>>3) ;
break;
case 25:
Hz625ptr = (uint32_t*)sig625_5MHz;
len = 6144+(Ncp>>2);
break;
case 50:
Hz625ptr = (uint32_t*)sig625_10MHz;
len = 12288+(Ncp>>1);
break;
case 75:
Hz625ptr = (uint32_t*)sig625_15MHz;
len = 18432+((2*Ncp)/3);
break;
case 100:
Hz625ptr = (uint32_t*)sig625_20MHz;
len = 24576+Ncp;
break;
default:
Hz625ptr = (uint32_t*)sig625_5MHz;
len = 11400;
break;
}
for (aa=0;aa<phy_vars_eNB->lte_frame_parms.nb_antennas_tx;aa++) {
txptr128 = (__m128i *)prach;
Hz625ptr128 = (__m128i *)Hz625ptr;
// apply 7.5 kHz
// if (((slot>>1)&1) == 0) { // apply the sinusoid from the table directly
for (i=0;i<(len>>2);i++) {
Hz625_2 = _mm_sign_epi16(*Hz625ptr128,*(__m128i*)&conjugate75_2[0]);
mmtmp_re = _mm_madd_epi16(*txptr128,Hz625_2);
// Real part of complex multiplication (note: 7_5kHz signal is conjugated for this to work)
mmtmp_im = _mm_shufflelo_epi16(Hz625_2,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_shufflehi_epi16(mmtmp_im,_MM_SHUFFLE(2,3,0,1));
mmtmp_im = _mm_sign_epi16(mmtmp_im,*(__m128i*)&conjugate75[0]);
mmtmp_im = _mm_madd_epi16(mmtmp_im,txptr128[0]);
mmtmp_re = _mm_srai_epi32(mmtmp_re,15);
mmtmp_im = _mm_srai_epi32(mmtmp_im,15);
mmtmp_re2 = _mm_unpacklo_epi32(mmtmp_re,mmtmp_im);
mmtmp_im2 = _mm_unpackhi_epi32(mmtmp_re,mmtmp_im);
/*
printf("%d: (%d,%d) (%d,%d) (%d,%d) (%d,%d) x (%d,%d) (%d,%d) (%d,%d) (%d,%d) => ",
i,
((short*)txptr128)[0],
((short*)txptr128)[1],
((short*)txptr128)[2],
((short*)txptr128)[3],
((short*)txptr128)[4],
((short*)txptr128)[5],
((short*)txptr128)[6],
((short*)txptr128)[7],
((short*)Hz625ptr128)[0],
((short*)Hz625ptr128)[1],
((short*)Hz625ptr128)[2],
((short*)Hz625ptr128)[3],
((short*)Hz625ptr128)[4],
((short*)Hz625ptr128)[5],
((short*)Hz625ptr128)[6],
((short*)Hz625ptr128)[7]);*/
txptr128[0] = _mm_packs_epi32(mmtmp_re2,mmtmp_im2);
/* printf("%(%d,%d) (%d,%d) (%d,%d) (%d,%d)\n",
((short*)txptr128)[0],
((short*)txptr128)[1],
((short*)txptr128)[2],
((short*)txptr128)[3],
((short*)txptr128)[4],
((short*)txptr128)[5],
((short*)txptr128)[6],
((short*)txptr128)[7]);*/
txptr128++;
Hz625ptr128++;
}
}
}
void init_prach625(LTE_DL_FRAME_PARMS *frame_parms) {
uint32_t len,i,Ncp;
double fs;
int16_t *Hz625ptr;
uint8_t frame_type = frame_parms->frame_type;
uint8_t prach_ConfigIndex = frame_parms->prach_config_common.prach_ConfigInfo.prach_ConfigIndex;
uint8_t prach_fmt = get_prach_fmt(prach_ConfigIndex,frame_type);
switch (prach_fmt) {
case 0:
Ncp = 3168;
break;
case 1:
case 3:
Ncp = 21024;
break;
case 2:
Ncp = 6240;
break;
case 4:
Ncp = 448;
break;
default:
Ncp = 3168;
break;
}
switch (frame_parms->N_RB_UL) {
case 6:
len = 1536 + (Ncp>>4);
fs = 1920000.0;
Hz625ptr = sig625_1_25MHz;
break;
case 15:
len = 3072 + (Ncp>>3) ;
fs = 3840000.0;
Hz625ptr = sig625_2_5MHz;
break;
case 25:
len = 6144+(Ncp>>2);
fs = 7680000.0;
Hz625ptr = sig625_5MHz;
break;
case 50:
len = 12288+(Ncp>>1);
fs = 15360000.0;
Hz625ptr = sig625_10MHz;
break;
case 75:
len = 18432+((2*Ncp)/3);
fs = 23040000.0;
Hz625ptr = sig625_15MHz;
break;
case 100:
len = 24576+Ncp;
fs = 30720000.0;
Hz625ptr = sig625_20MHz;
break;
default:
len = 6144+(Ncp>>2);
fs = 7680000.0;
Hz625ptr = sig625_5MHz;
break;
}
for (i=0;i<len;i++) {
Hz625ptr[i<<1] = (int16_t)floor(32767.0*cos(2*M_PI*625*i/fs));
Hz625ptr[1+(i<<1)] = (int16_t)floor(32767.0*sin(2*M_PI*625*i/fs));
// printf("prach625 %d: (%d,%d)\n",i,Hz625ptr[i<<1],Hz625ptr[1+(i<<1)]);
}
}
Reference in New Issue View Git Blame Copy Permalink