Commit 13645b1b authored by Parminder Singh's avatar Parminder Singh

Updated the sin cos table condition check

- Sin cos table quadrant condition checks are updated
- function are indented properly
- Debug prints are updated for double data type
parent c16e5831
...@@ -277,30 +277,30 @@ void nr_ptrs_cpe_estimation(uint8_t K_ptrs, ...@@ -277,30 +277,30 @@ void nr_ptrs_cpe_estimation(uint8_t K_ptrs,
/* loop over all sub carriers to get compensated RE on ptrs symbols*/ /* loop over all sub carriers to get compensated RE on ptrs symbols*/
for (int re = 0; re < nb_re_pdsch; re++) for (int re = 0; re < nb_re_pdsch; re++)
{
is_ptrs_re = is_ptrs_subcarrier(re,
rnti,
0,
dmrsConfigType,
K_ptrs,
nb_rb,
ptrsReOffset,
0,// start_re is 0 here
ofdm_symbol_size);
if(is_ptrs_re)
{ {
is_ptrs_re = is_ptrs_subcarrier(re, dmrs_comp_p[re_cnt*2] = rxF_comp[re *2];
rnti, dmrs_comp_p[(re_cnt*2)+1] = rxF_comp[(re *2)+1];
0, re_cnt++;
dmrsConfigType, }
K_ptrs, else
nb_rb, {
ptrsReOffset, /* Skip PTRS symbols and keep data in a continuous vector */
0,// start_re is 0 here rxF_comp[cnt *2]= rxF_comp[re *2];
ofdm_symbol_size); rxF_comp[(cnt *2)+1]= rxF_comp[(re *2)+1];
if(is_ptrs_re) cnt++;
{ }
dmrs_comp_p[re_cnt*2] = rxF_comp[re *2]; }/* RE loop */
dmrs_comp_p[(re_cnt*2)+1] = rxF_comp[(re *2)+1];
re_cnt++;
}
else
{
/* Skip PTRS symbols and keep data in a continuous vector */
rxF_comp[cnt *2]= rxF_comp[re *2];
rxF_comp[(cnt *2)+1]= rxF_comp[(re *2)+1];
cnt++;
}
}/* RE loop */
/* update the total ptrs RE in a symbol */ /* update the total ptrs RE in a symbol */
*ptrs_sc = re_cnt; *ptrs_sc = re_cnt;
...@@ -310,10 +310,10 @@ void nr_ptrs_cpe_estimation(uint8_t K_ptrs, ...@@ -310,10 +310,10 @@ void nr_ptrs_cpe_estimation(uint8_t K_ptrs,
/* loop over all ptrs sub carriers in a symbol */ /* loop over all ptrs sub carriers in a symbol */
/* sum the error vector */ /* sum the error vector */
for(int i = 0;i < sc_per_symbol; i++) for(int i = 0;i < sc_per_symbol; i++)
{ {
real+= ptrs_ch_p[(2*i)]; real+= ptrs_ch_p[(2*i)];
imag+= ptrs_ch_p[(2*i)+1]; imag+= ptrs_ch_p[(2*i)+1];
} }
#ifdef DEBUG_PTRS #ifdef DEBUG_PTRS
alpha = atan(imag/real); alpha = atan(imag/real);
printf("[PHY][PTRS]: Symbol %d atan(Im,real):= %f \n",symbol, alpha ); printf("[PHY][PTRS]: Symbol %d atan(Im,real):= %f \n",symbol, alpha );
...@@ -357,100 +357,100 @@ int8_t nr_ptrs_process_slot(uint16_t dmrsSymbPos, ...@@ -357,100 +357,100 @@ int8_t nr_ptrs_process_slot(uint16_t dmrsSymbPos,
uint16_t startSymbIdx, uint16_t startSymbIdx,
uint16_t noSymb) uint16_t noSymb)
{ {
int32_t slope = 0; double slope[2] = {0,0};
int16_t *slope_p = (int16_t*)&slope; double *slope_p = &slope[0];
uint8_t symbInSlot = startSymbIdx + noSymb; uint8_t symbInSlot = startSymbIdx + noSymb;
int8_t rightRef = 0; int8_t rightRef = 0;
int8_t leftRef = 0; int8_t leftRef = 0;
int8_t tmp = 0; int8_t tmp = 0;
for(uint8_t symb = startSymbIdx; symb <symbInSlot; symb ++) for(uint8_t symb = startSymbIdx; symb <symbInSlot; symb ++)
{
/* set DMRS estimates to 0 angle with magnitude 1 */
if(is_dmrs_symbol(symb,dmrsSymbPos))
{ {
/* set DMRS estimates to 0 angle with magnitude 1 */ /* set DMRS estimation */
if(is_dmrs_symbol(symb,dmrsSymbPos)) estPerSymb[symb*2]=(int16_t)((1<<15)-1); // 32767
{ estPerSymb[(symb*2)+1]= 0; // no angle
/* set DMRS estimation */
estPerSymb[symb*2]=(int16_t)((1<<15)-1); // 32767
estPerSymb[(symb*2)+1]= 0; // no angle
#ifdef DEBUG_PTRS #ifdef DEBUG_PTRS
printf("[PHY][PTRS]: DMRS Symbol %d :(%4d %4d)\n", symb, estPerSymb[symb*2],estPerSymb[(symb*2)+1]); printf("[PHY][PTRS]: DMRS Symbol %d :(%4d %4d)\n", symb, estPerSymb[symb*2],estPerSymb[(symb*2)+1]);
#endif #endif
} }
/* Update left and right reference from an estimated symbol */ /* Update left and right reference from an estimated symbol */
if((is_ptrs_symbol(symb, ptrsSymbPos)) || (is_dmrs_symbol(symb,dmrsSymbPos))) if((is_ptrs_symbol(symb, ptrsSymbPos)) || (is_dmrs_symbol(symb,dmrsSymbPos)))
{
leftRef = symb;
rightRef = get_next_estimate_in_slot(ptrsSymbPos,dmrsSymbPos,symb+1,symbInSlot);
}
else
{
/* The very first symbol must be a PTRS or DMRS */
if((symb == startSymbIdx) && (leftRef == -1) && (rightRef == -1))
{
printf("Wrong PTRS Setup, PTRS compensation will be skipped !");
return -1;
}
/* check for left side first */
/* right side a DMRS symbol then we need to left extrapolate */
if(is_dmrs_symbol(rightRef,dmrsSymbPos))
{
/* calculate slope from next valid estimates*/
tmp = get_next_estimate_in_slot(ptrsSymbPos,dmrsSymbPos,rightRef+1,symbInSlot);
/* Special case when DMRS is not followed by PTRS symbol then reuse old slope */
if(tmp!=-1)
{ {
leftRef = symb; get_slope_from_estimates(rightRef, tmp, estPerSymb, slope_p);
rightRef = get_next_estimate_in_slot(ptrsSymbPos,dmrsSymbPos,symb+1,symbInSlot);
} }
else ptrs_estimate_from_slope(estPerSymb,slope_p,leftRef, rightRef);
{ symb = rightRef -1;
/* The very first symbol must be a PTRS or DMRS */ }
if((symb == startSymbIdx) && (leftRef == -1) && (rightRef == -1)) else if(is_ptrs_symbol(rightRef,ptrsSymbPos))
{ {
printf("Wrong PTRS Setup, PTRS compensation will be skipped !"); /* calculate slope from next valid estimates */
return -1; get_slope_from_estimates(leftRef,rightRef,estPerSymb, slope_p);
} ptrs_estimate_from_slope(estPerSymb,slope_p,leftRef, rightRef);
/* check for left side first */ symb = rightRef -1;
/* right side a DMRS symbol then we need to left extrapolate */ }
if(is_dmrs_symbol(rightRef,dmrsSymbPos)) else if((rightRef ==-1) && (symb <symbInSlot))
{ {
/* calculate slope from next valid estimates*/ // in right extrapolation use the last slope
tmp = get_next_estimate_in_slot(ptrsSymbPos,dmrsSymbPos,rightRef+1,symbInSlot);
/* Special case when DMRS is not followed by PTRS symbol then reuse old slope */
if(tmp!=-1)
{
get_slope_from_estimates(rightRef, tmp, estPerSymb, slope_p);
}
ptrs_estimate_from_slope(estPerSymb,slope_p,leftRef, rightRef);
symb = rightRef -1;
}
else if(is_ptrs_symbol(rightRef,ptrsSymbPos))
{
/* calculate slope from next valid estimates */
get_slope_from_estimates(leftRef,rightRef,estPerSymb, slope_p);
ptrs_estimate_from_slope(estPerSymb,slope_p,leftRef, rightRef);
symb = rightRef -1;
}
else if((rightRef ==-1) && (symb <symbInSlot))
{
// in right extrapolation use the last slope
#ifdef DEBUG_PTRS #ifdef DEBUG_PTRS
printf("[PHY][PTRS]: Last Slop Reused :(%4d %4d)\n", slope_p[0],slope_p[1]); printf("[PHY][PTRS]: Last Slop Reused :(%4f %4f)\n", slope_p[0],slope_p[1]);
#endif #endif
ptrs_estimate_from_slope(estPerSymb,slope_p,symb-1,symbInSlot); ptrs_estimate_from_slope(estPerSymb,slope_p,symb-1,symbInSlot);
symb = symbInSlot; symb = symbInSlot;
} }
else else
{ {
printf("Wrong PTRS Setup, PTRS compensation will be skipped !"); printf("Wrong PTRS Setup, PTRS compensation will be skipped !");
return -1; return -1;
}
}
} }
}
}
return 0; return 0;
} }
/* Calculate slope from 2 reference points */ /* Calculate slope from 2 reference points */
void get_slope_from_estimates(uint8_t start, uint8_t end, int16_t *est_p, int16_t *slope_p) void get_slope_from_estimates(uint8_t start, uint8_t end, int16_t *est_p, double *slope_p)
{ {
uint8_t distance = end - start; uint8_t distance = end - start;
slope_p[0] = (est_p[end*2] - est_p[start*2]) /distance; slope_p[0] = (double)(est_p[end*2] - est_p[start*2]) /distance;
slope_p[1] = (est_p[(end*2)+1] - est_p[(start*2)+1]) /distance; slope_p[1] = (double)(est_p[(end*2)+1] - est_p[(start*2)+1]) /distance;
#ifdef DEBUG_PTRS #ifdef DEBUG_PTRS
printf("[PHY][PTRS]: Slop is :(%4d %4d) between Symbol %2d & Symbol %2d\n", slope_p[0],slope_p[1], start, end); printf("[PHY][PTRS]: Slop is :(%4f %4f) between Symbol %2d & Symbol %2d\n", slope_p[0],slope_p[1], start, end);
//printf("%d %d - %d %d\n",est_p[end*2],est_p[(end*2)+1],est_p[start*2],est_p[(start*2)+1]); //printf("%d %d - %d %d\n",est_p[end*2],est_p[(end*2)+1],est_p[start*2],est_p[(start*2)+1]);
#endif #endif
} }
/* estimate from slope */ /* estimate from slope */
void ptrs_estimate_from_slope(int16_t *error_est, int16_t *slope_p, uint8_t start, uint8_t end) void ptrs_estimate_from_slope(int16_t *error_est, double *slope_p, uint8_t start, uint8_t end)
{ {
for(uint8_t i = 1; i< (end -start);i++) for(uint8_t i = 1; i< (end -start);i++)
{ {
error_est[(start+i)*2] = (error_est[start*2] + (i * slope_p[0]));// real error_est[(start+i)*2] = (error_est[start*2] + (int16_t)(i * slope_p[0]));// real
error_est[((start +i)*2)+1] = (error_est[(start*2)+1] + ( i * slope_p[1])); //imag error_est[((start +i)*2)+1] = (error_est[(start*2)+1] + (int16_t)( i * slope_p[1])); //imag
#ifdef DEBUG_PTRS #ifdef DEBUG_PTRS
printf("[PHY][PTRS]: Estimated Symbol %2d -> %4d %4d from Slope (%4d %4d)\n", start+i,error_est[(start+i)*2],error_est[((start +i)*2)+1], printf("[PHY][PTRS]: Estimated Symbol %2d -> %4d %4d from Slope (%4f %4f)\n", start+i,error_est[(start+i)*2],error_est[((start +i)*2)+1],
slope_p[0],slope_p[1]); slope_p[0],slope_p[1]);
#endif #endif
} }
} }
...@@ -83,7 +83,7 @@ static inline uint8_t is_ptrs_symbol(uint8_t l, uint16_t ptrs_symbols) { return ...@@ -83,7 +83,7 @@ static inline uint8_t is_ptrs_symbol(uint8_t l, uint16_t ptrs_symbols) { return
uint8_t get_ptrs_symbols_in_slot(uint16_t l_prime_mask, uint16_t start_symb, uint16_t nb_symb); uint8_t get_ptrs_symbols_in_slot(uint16_t l_prime_mask, uint16_t start_symb, uint16_t nb_symb);
int8_t get_next_ptrs_symbol_in_slot(uint16_t ptrsSymbPos, uint8_t counter, uint8_t nb_symb); int8_t get_next_ptrs_symbol_in_slot(uint16_t ptrsSymbPos, uint8_t counter, uint8_t nb_symb);
int8_t get_next_estimate_in_slot(uint16_t ptrsSymbPos,uint16_t dmrsSymbPos, uint8_t counter,uint8_t nb_symb); int8_t get_next_estimate_in_slot(uint16_t ptrsSymbPos,uint16_t dmrsSymbPos, uint8_t counter,uint8_t nb_symb);
void get_slope_from_estimates(uint8_t leftSide, uint8_t rightSide, int16_t *est_p, int16_t *slope_p);
int8_t nr_ptrs_process_slot(uint16_t dmrsSymbPos, int8_t nr_ptrs_process_slot(uint16_t dmrsSymbPos,
uint16_t ptrsSymbPos, uint16_t ptrsSymbPos,
int16_t *estPerSymb, int16_t *estPerSymb,
...@@ -105,6 +105,6 @@ void nr_ptrs_cpe_estimation(uint8_t K_ptrs, ...@@ -105,6 +105,6 @@ void nr_ptrs_cpe_estimation(uint8_t K_ptrs,
int16_t *error_est, int16_t *error_est,
int32_t *ptrs_sc); int32_t *ptrs_sc);
void get_slope_from_estimates(uint8_t start, uint8_t end, int16_t *est_p, int16_t *slope_p); void get_slope_from_estimates(uint8_t start, uint8_t end, int16_t *est_p, double *slope_p);
void ptrs_estimate_from_slope(int16_t *error_est, int16_t *slope_p, uint8_t start, uint8_t end); void ptrs_estimate_from_slope(int16_t *error_est, double *slope_p, uint8_t start, uint8_t end);
#endif /* PTRS_NR_H */ #endif /* PTRS_NR_H */
...@@ -29,7 +29,7 @@ ...@@ -29,7 +29,7 @@
/* linear phase noise model */ /* linear phase noise model */
void phase_noise(double ts, int16_t * InRe, int16_t * InIm) void phase_noise(double ts, int16_t * InRe, int16_t * InIm)
{ {
static double i=0; static uint64_t i=0;
int32_t x=0 ,y=0; int32_t x=0 ,y=0;
double fd = 300;//0.01*30000 double fd = 300;//0.01*30000
int16_t SinValue = 0, CosValue= 0; int16_t SinValue = 0, CosValue= 0;
...@@ -39,33 +39,29 @@ void phase_noise(double ts, int16_t * InRe, int16_t * InIm) ...@@ -39,33 +39,29 @@ void phase_noise(double ts, int16_t * InRe, int16_t * InIm)
if(IdxModulo<2*ResolSinCos)//< 2 check for 1st and 2nd if(IdxModulo<2*ResolSinCos)//< 2 check for 1st and 2nd
{ {
if(IdxModulo>=ResolSinCos)//>= 1 is 2nd Quadrant if(IdxModulo < ResolSinCos)// 1st Quadrant
{
SinValue = LUTSin[2*ResolSinCos-IdxModulo];
CosValue = -LUTSin[IdxModulo-ResolSinCos];
}
else// 1st Quadrant
{ {
SinValue = LUTSin[IdxModulo]; SinValue = LUTSin[IdxModulo];
CosValue = LUTSin[ResolSinCos-IdxModulo]; CosValue = LUTSin[ResolSinCos-IdxModulo];
} }
} else// 2nd Quadrant
else if((IdxModulo>2*ResolSinCos))//> 2 check for 3rd and 4th
{
if(IdxModulo>=3*ResolSinCos)//> 3 is 4th Quadrant
{ {
SinValue = -LUTSin[4*ResolSinCos-IdxModulo]; SinValue = LUTSin[2*ResolSinCos-IdxModulo];
CosValue = LUTSin[IdxModulo-3*ResolSinCos]; CosValue = -LUTSin[IdxModulo-ResolSinCos];
} }
else//3rd Quadrant }
else // 3rd and 4th Quadrant
{
if(IdxModulo < 3*ResolSinCos)// 3rd Quadrant
{ {
SinValue = -LUTSin[IdxModulo-2*ResolSinCos]; SinValue = -LUTSin[IdxModulo-2*ResolSinCos];
CosValue = -LUTSin[3*ResolSinCos-IdxModulo]; CosValue = -LUTSin[3*ResolSinCos-IdxModulo];
} }
} else//4th Quadrant
else {
{ SinValue = -LUTSin[4*ResolSinCos-IdxModulo];
AssertFatal(0==1,"Error in look-up table of sine function!\n"); CosValue = LUTSin[IdxModulo-3*ResolSinCos];
}
} }
x = ( ((int32_t)InRe[0] * CosValue) - ((int32_t)InIm[0] * SinValue )); x = ( ((int32_t)InRe[0] * CosValue) - ((int32_t)InIm[0] * SinValue ));
y = ( ((int32_t)InIm[0] * CosValue) + ((int32_t)InRe[0] * SinValue )); y = ( ((int32_t)InIm[0] * CosValue) + ((int32_t)InRe[0] * SinValue ));
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment