ru_procedures.c 19.8 KB
Newer Older
1 2 3 4 5
/*
 * 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
6
 * the OAI Public License, Version 1.1  (the "License"); you may not use this file
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
 * 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 ru_procedures.c
 * \brief Implementation of RU procedures
 * \author R. Knopp, F. Kaltenberger, N. Nikaein, X. Foukas
 * \date 2011
 * \version 0.1
 * \company Eurecom
 * \email: knopp@eurecom.fr,florian.kaltenberger@eurecom.fr,navid.nikaein@eurecom.fr, x.foukas@sms.ed.ac.uk
 * \note
 * \warning
 */

33 34 35
#include "PHY/defs_eNB.h"
#include "PHY/phy_extern.h"
#include "SCHED/sched_eNB.h"
36
#include "PHY/MODULATION/modulation_eNB.h"
37 38
#include "PHY/LTE_TRANSPORT/if4_tools.h"
#include "PHY/LTE_TRANSPORT/if5_tools.h"
39
#include "PHY/LTE_TRANSPORT/transport_common_proto.h"
40

41
#include "LAYER2/MAC/mac.h"
42 43 44 45 46 47 48 49 50
#include "UTIL/LOG/log.h"
#include "UTIL/LOG/vcd_signal_dumper.h"

#include "T.h"

#include "assertions.h"
#include "msc.h"

#include <time.h>
Raymond Knopp's avatar
Raymond Knopp committed
51

52 53
#include "targets/RT/USER/rt_wrapper.h"

Raymond Knopp's avatar
Raymond Knopp committed
54 55
// RU OFDM Modulator, used in IF4p5 RRU, RCC/RAU with IF5, eNodeB

56 57
extern openair0_config_t openair0_cfg[MAX_CARDS];

58 59 60 61 62 63
extern int oai_exit;


void feptx0(RU_t *ru,int slot) {

  LTE_DL_FRAME_PARMS *fp = &ru->frame_parms;
64
  //int dummy_tx_b[7680*2] __attribute__((aligned(32)));
65 66 67 68 69 70

  unsigned int aa,slot_offset;
  int slot_sizeF = (fp->ofdm_symbol_size)*
                   ((fp->Ncp==1) ? 6 : 7);
  int subframe = ru->proc.subframe_tx;

71 72 73

  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM+slot , 1 );

74 75
  slot_offset = subframe*fp->samples_per_tti + (slot*(fp->samples_per_tti>>1));

76
  //LOG_D(PHY,"SFN/SF:RU:TX:%d/%d Generating slot %d\n",ru->proc.frame_tx, ru->proc.subframe_tx,slot);
77 78 79

  for (aa=0; aa<ru->nb_tx; aa++) {
    if (fp->Ncp == EXTENDED) PHY_ofdm_mod(&ru->common.txdataF_BF[aa][slot*slot_sizeF],
80 81 82 83 84
					                      (int*)&ru->common.txdata[aa][slot_offset],
					                      fp->ofdm_symbol_size,
					                      6,
					                      fp->nb_prefix_samples,
					                      CYCLIC_PREFIX);
85
    else                     normal_prefix_mod(&ru->common.txdataF_BF[aa][slot*slot_sizeF],
86 87 88
					                           (int*)&ru->common.txdata[aa][slot_offset],
					                           7,
					                           fp);
89
    
90
   /* 
91 92
    len = fp->samples_per_tti>>1;

93
    
94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
    if ((slot_offset+len)>(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti)) {
      tx_offset = (int)slot_offset;
      txdata = (int16_t*)&ru->common.txdata[aa][tx_offset];
      len2 = -tx_offset+LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti;
      for (i=0; i<(len2<<1); i++) {
	txdata[i] = ((int16_t*)dummy_tx_b)[i];
      }
      txdata = (int16_t*)&ru->common.txdata[aa][0];
      for (j=0; i<(len<<1); i++,j++) {
	txdata[j++] = ((int16_t*)dummy_tx_b)[i];
      }
    }
    else {
      tx_offset = (int)slot_offset;
      txdata = (int16_t*)&ru->common.txdata[aa][tx_offset];
109
      memcpy((void*)txdata,(void*)dummy_tx_b,len<<2);   
110
    }
111
*/
112
    // TDD: turn on tx switch N_TA_offset before by setting buffer in these samples to 0    
113
/*    if ((slot == 0) &&
114 115 116 117 118 119
        (fp->frame_type == TDD) && 
        ((fp->tdd_config==0) ||
         (fp->tdd_config==1) ||
         (fp->tdd_config==2) ||
         (fp->tdd_config==6)) &&  
        ((subframe==0) || (subframe==5))) {
120 121 122 123 124 125 126 127 128 129
      for (i=0; i<ru->N_TA_offset; i++) {
	tx_offset = (int)slot_offset+i-ru->N_TA_offset/2;
	if (tx_offset<0)
	  tx_offset += LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti;
	
	if (tx_offset>=(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti))
	  tx_offset -= LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti;
	
	ru->common.txdata[aa][tx_offset] = 0x00000000;
      }
130
    }*/
131
  }
132
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM+slot , 0);
133 134 135 136 137 138
}

static void *feptx_thread(void *param) {

  RU_t *ru = (RU_t *)param;
  RU_proc_t *proc  = &ru->proc;
139 140
  cpu_set_t cpuset;
  CPU_ZERO(&cpuset);
141 142 143 144 145 146
  
  thread_top_init("feptx_thread",1,85000,120000,500000);
  pthread_setname_np( pthread_self(),"feptx processing");
  LOG_I(PHY,"thread feptx created id=%ld\n", syscall(__NR_gettid));
  //CPU_SET(6, &cpuset);
  //pthread_setaffinity_np(pthread_self(), sizeof(cpu_set_t), &cpuset);
147
  //wait_sync("feptx_thread");
148

149
  
150 151 152 153

  while (!oai_exit) {

    if (wait_on_condition(&proc->mutex_feptx,&proc->cond_feptx,&proc->instance_cnt_feptx,"feptx thread")<0) break;  
154
    //stop_meas(&ru->ofdm_mod_wakeup_stats);
155 156 157 158 159 160 161 162
    feptx0(ru,1);
    if (release_thread(&proc->mutex_feptx,&proc->instance_cnt_feptx,"feptx thread")<0) break;

    if (pthread_cond_signal(&proc->cond_feptx) != 0) {
      printf("[eNB] ERROR pthread_cond_signal for feptx thread exit\n");
      exit_fun( "ERROR pthread_cond_signal" );
      return NULL;
    }
163 164 165 166
	/*if(opp_enabled == 1 && ru->ofdm_mod_wakeup_stats.diff_now>30*3000){
      print_meas_now(&ru->ofdm_mod_wakeup_stats,"fep wakeup",stderr);
      printf("delay in fep wakeup in frame_tx: %d  subframe_rx: %d \n",proc->frame_tx,proc->subframe_tx);
    }*/
167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182
  }



  return(NULL);
}

void feptx_ofdm_2thread(RU_t *ru) {

  LTE_DL_FRAME_PARMS *fp=&ru->frame_parms;
  RU_proc_t *proc = &ru->proc;
  struct timespec wait;
  int subframe = ru->proc.subframe_tx;

  wait.tv_sec=0;
  wait.tv_nsec=5000000L;
183
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM , 1 );
184
  start_meas(&ru->ofdm_mod_stats);
185 186 187

  if (subframe_select(fp,subframe) == SF_UL) return;

188 189
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM , 1 );

190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212
  if (subframe_select(fp,subframe)==SF_DL) {
    // If this is not an S-subframe
    if (pthread_mutex_timedlock(&proc->mutex_feptx,&wait) != 0) {
      printf("[RU] ERROR pthread_mutex_lock for feptx thread (IC %d)\n", proc->instance_cnt_feptx);
      exit_fun( "error locking mutex_feptx" );
      return;
    }
    
    if (proc->instance_cnt_feptx==0) {
      printf("[RU] FEPtx thread busy\n");
      exit_fun("FEPtx thread busy");
      pthread_mutex_unlock( &proc->mutex_feptx );
      return;
    }
    
    ++proc->instance_cnt_feptx;
    
    
    if (pthread_cond_signal(&proc->cond_feptx) != 0) {
      printf("[RU] ERROR pthread_cond_signal for feptx thread\n");
      exit_fun( "ERROR pthread_cond_signal" );
      return;
    }
213
	//start_meas(&ru->ofdm_mod_wakeup_stats);
214 215 216 217 218 219
    
    pthread_mutex_unlock( &proc->mutex_feptx );
  }

  // call first slot in this thread
  feptx0(ru,0);
220
  start_meas(&ru->ofdm_mod_wait_stats);
221
  wait_on_busy_condition(&proc->mutex_feptx,&proc->cond_feptx,&proc->instance_cnt_feptx,"feptx thread");  
222
  stop_meas(&ru->ofdm_mod_wait_stats);
Wang Tsu-Han's avatar
Wang Tsu-Han committed
223
  /*if(opp_enabled == 1 && ru->ofdm_mod_wait_stats.diff_now>30*3000){
224 225
    print_meas_now(&ru->ofdm_mod_wait_stats,"fep wakeup",stderr);
    printf("delay in feptx wait on codition in frame_rx: %d  subframe_rx: %d \n",proc->frame_tx,proc->subframe_tx);
Wang Tsu-Han's avatar
Wang Tsu-Han committed
226
  }*/
227

228 229
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM , 0 );

230
  stop_meas(&ru->ofdm_mod_stats);
231
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM , 0 );
232 233 234

}

235
void feptx_ofdm(RU_t *ru) {
Raymond Knopp's avatar
Raymond Knopp committed
236 237 238 239 240 241 242 243 244 245
     
  LTE_DL_FRAME_PARMS *fp=&ru->frame_parms;

  unsigned int aa,slot_offset, slot_offset_F;
  int dummy_tx_b[7680*4] __attribute__((aligned(32)));
  int i,j, tx_offset;
  int slot_sizeF = (fp->ofdm_symbol_size)*
                   ((fp->Ncp==1) ? 6 : 7);
  int len,len2;
  int16_t *txdata;
246 247
  int subframe = ru->proc.subframe_tx;

Raymond Knopp's avatar
Raymond Knopp committed
248 249
//  int CC_id = ru->proc.CC_id;

250
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM , 1 );
Raymond Knopp's avatar
Raymond Knopp committed
251

Cedric Roux's avatar
Cedric Roux committed
252
  slot_offset_F = 0;
Raymond Knopp's avatar
Raymond Knopp committed
253 254 255 256 257 258 259

  slot_offset = subframe*fp->samples_per_tti;

  if ((subframe_select(fp,subframe)==SF_DL)||
      ((subframe_select(fp,subframe)==SF_S))) {
    //    LOG_D(HW,"Frame %d: Generating slot %d\n",frame,next_slot);

260 261
    start_meas(&ru->ofdm_mod_stats);

Raymond Knopp's avatar
Raymond Knopp committed
262 263
    for (aa=0; aa<ru->nb_tx; aa++) {
      if (fp->Ncp == EXTENDED) {
264
        PHY_ofdm_mod(&ru->common.txdataF_BF[aa][0],
Raymond Knopp's avatar
Raymond Knopp committed
265 266 267 268 269
                     dummy_tx_b,
                     fp->ofdm_symbol_size,
                     6,
                     fp->nb_prefix_samples,
                     CYCLIC_PREFIX);
270
        PHY_ofdm_mod(&ru->common.txdataF_BF[aa][slot_sizeF],
Raymond Knopp's avatar
Raymond Knopp committed
271 272 273 274 275 276
                     dummy_tx_b+(fp->samples_per_tti>>1),
                     fp->ofdm_symbol_size,
                     6,
                     fp->nb_prefix_samples,
                     CYCLIC_PREFIX);
      } else {
277
        normal_prefix_mod(&ru->common.txdataF_BF[aa][slot_offset_F],
Raymond Knopp's avatar
Raymond Knopp committed
278 279 280 281 282
                          dummy_tx_b,
                          7,
                          fp);
	// if S-subframe generate first slot only
	if (subframe_select(fp,subframe) == SF_DL) 
283
	  normal_prefix_mod(&ru->common.txdataF_BF[aa][slot_offset_F+slot_sizeF],
Raymond Knopp's avatar
Raymond Knopp committed
284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
			    dummy_tx_b+(fp->samples_per_tti>>1),
			    7,
			    fp);
      }

      // if S-subframe generate first slot only
      if (subframe_select(fp,subframe) == SF_S)
	len = fp->samples_per_tti>>1;
      else
	len = fp->samples_per_tti;
      /*
      for (i=0;i<len;i+=4) {
	dummy_tx_b[i] = 0x100;
	dummy_tx_b[i+1] = 0x01000000;
	dummy_tx_b[i+2] = 0xff00;
	dummy_tx_b[i+3] = 0xff000000;
	}*/
      
302 303 304
      if (slot_offset<0) {
	txdata = (int16_t*)&ru->common.txdata[aa][(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti)+tx_offset];
        len2 = -(slot_offset);
Raymond Knopp's avatar
Raymond Knopp committed
305 306
	len2 = (len2>len) ? len : len2;
	for (i=0; i<(len2<<1); i++) {
307
	  txdata[i] = ((int16_t*)dummy_tx_b)[i];
Raymond Knopp's avatar
Raymond Knopp committed
308 309
	}
	if (len2<len) {
310
	  txdata = (int16_t*)&ru->common.txdata[aa][0];
Raymond Knopp's avatar
Raymond Knopp committed
311
	  for (j=0; i<(len<<1); i++,j++) {
312
	    txdata[j++] = ((int16_t*)dummy_tx_b)[i];
Raymond Knopp's avatar
Raymond Knopp committed
313 314 315
	  }
	}
      }  
316 317 318
      else if ((slot_offset+len)>(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti)) {
	tx_offset = (int)slot_offset;
	txdata = (int16_t*)&ru->common.txdata[aa][tx_offset];
Raymond Knopp's avatar
Raymond Knopp committed
319 320
	len2 = -tx_offset+LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti;
	for (i=0; i<(len2<<1); i++) {
321
	  txdata[i] = ((int16_t*)dummy_tx_b)[i];
Raymond Knopp's avatar
Raymond Knopp committed
322
	}
323
	txdata = (int16_t*)&ru->common.txdata[aa][0];
Raymond Knopp's avatar
Raymond Knopp committed
324
	for (j=0; i<(len<<1); i++,j++) {
325
          txdata[j++] = ((int16_t*)dummy_tx_b)[i];
Raymond Knopp's avatar
Raymond Knopp committed
326 327 328
	}
      }
      else {
329
	//LOG_D(PHY,"feptx_ofdm: Writing to position %d\n",slot_offset);
330 331
	tx_offset = (int)slot_offset;
	txdata = (int16_t*)&ru->common.txdata[aa][tx_offset];
Raymond Knopp's avatar
Raymond Knopp committed
332 333

	for (i=0; i<(len<<1); i++) {
334
	  txdata[i] = ((int16_t*)dummy_tx_b)[i];
Raymond Knopp's avatar
Raymond Knopp committed
335 336 337 338 339 340 341 342 343 344 345
	}
      }
      
     // if S-subframe switch to RX in second subframe
      /*
     if (subframe_select(fp,subframe) == SF_S) {
       for (i=0; i<len; i++) {
	 ru->common_vars.txdata[0][aa][tx_offset++] = 0x00010001;
       }
     }
      */
346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366

//     if ((fp->frame_type == TDD) &&
//         ((fp->tdd_config==0) ||
//	   (fp->tdd_config==1) ||
//	   (fp->tdd_config==2) ||
//	   (fp->tdd_config==6)) &&
//	     ((subframe==0) || (subframe==5))) {
//       // turn on tx switch N_TA_offset before
//       //LOG_D(HW,"subframe %d, time to switch to tx (N_TA_offset %d, slot_offset %d) \n",subframe,ru->N_TA_offset,slot_offset);
//       for (i=0; i<ru->N_TA_offset; i++) {
//         tx_offset = (int)slot_offset+i-ru->N_TA_offset/2;
//         if (tx_offset<0)
//           tx_offset += LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti;
//
//         if (tx_offset>=(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti))
//           tx_offset -= LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*fp->samples_per_tti;
//
//         ru->common.txdata[aa][tx_offset] = 0x00000000;
//       }
//     }

367
     stop_meas(&ru->ofdm_mod_stats);
368
     LOG_D(PHY,"feptx_ofdm (TXPATH): frame %d, subframe %d: txp (time %p) %d dB, txp (freq) %d dB\n",
Raymond Knopp's avatar
Raymond Knopp committed
369
	   ru->proc.frame_tx,subframe,txdata,dB_fixed(signal_energy((int32_t*)txdata,fp->samples_per_tti)),
370
	   dB_fixed(signal_energy_nodc(ru->common.txdataF_BF[aa],2*slot_sizeF)));
Raymond Knopp's avatar
Raymond Knopp committed
371 372
    }
  }
373
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_OFDM , 0 );
Raymond Knopp's avatar
Raymond Knopp committed
374 375
}

376 377 378 379 380 381 382 383
void feptx_prec(RU_t *ru) {

  int l,i,aa;
  PHY_VARS_eNB **eNB_list = ru->eNB_list,*eNB;
  LTE_DL_FRAME_PARMS *fp;
  int32_t ***bw;
  int subframe = ru->proc.subframe_tx;

384 385
  if (ru->num_eNB == 1) {
    eNB = eNB_list[0];
386
    fp  = &eNB->frame_parms;
387
    
388 389
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_PREC , 1);

390 391 392 393
    for (aa=0;aa<ru->nb_tx;aa++)
      memcpy((void*)ru->common.txdataF_BF[aa],
	     (void*)&eNB->common_vars.txdataF[aa][subframe*fp->symbols_per_tti*fp->ofdm_symbol_size],
	     fp->symbols_per_tti*fp->ofdm_symbol_size*sizeof(int32_t));
394 395

    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPTX_PREC , 0);
396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412
  }
  else {
    for (i=0;i<ru->num_eNB;i++) {
      eNB = eNB_list[i];
      fp  = &eNB->frame_parms;
      bw  = ru->beam_weights[i];
      
      for (l=0;l<fp->symbols_per_tti;l++) {
	for (aa=0;aa<ru->nb_tx;aa++) {
	  beam_precoding(eNB->common_vars.txdataF,
			 ru->common.txdataF_BF,
			 fp,
			 bw,
			 subframe<<1,
			 l,
			 aa);
	}
413 414 415 416
      }
    }
  }
}
Raymond Knopp's avatar
Raymond Knopp committed
417 418 419

void fep0(RU_t *ru,int slot) {

420 421
  RU_proc_t *proc       = &ru->proc;
  LTE_DL_FRAME_PARMS *fp = &ru->frame_parms;
Raymond Knopp's avatar
Raymond Knopp committed
422 423 424 425
  int l;

  //  printf("fep0: slot %d\n",slot);

426 427
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX+slot, 1);

Raymond Knopp's avatar
Raymond Knopp committed
428 429
  remove_7_5_kHz(ru,(slot&1)+(proc->subframe_rx<<1));
  for (l=0; l<fp->symbols_per_tti/2; l++) {
430
    slot_fep_ul(ru,
Raymond Knopp's avatar
Raymond Knopp committed
431
		l,
432
		(slot&1),
Raymond Knopp's avatar
Raymond Knopp committed
433 434 435
		0
		);
  }
436
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX+slot, 0);
Raymond Knopp's avatar
Raymond Knopp committed
437 438 439 440 441 442 443
}



static void *fep_thread(void *param) {

  RU_t *ru = (RU_t *)param;
444
  RU_proc_t *proc  = &ru->proc;
445

446 447 448
  thread_top_init("fep_thread",1,100000,120000,5000000);
  pthread_setname_np( pthread_self(),"fep processing");
  LOG_I(PHY,"thread fep created id=%ld\n", syscall(__NR_gettid));
449

450 451
  cpu_set_t cpuset;
  CPU_ZERO(&cpuset);
452 453
  //CPU_SET(2, &cpuset);
  //pthread_setaffinity_np(pthread_self(), sizeof(cpu_set_t), &cpuset);
454
  //wait_sync("fep_thread");
455

Raymond Knopp's avatar
Raymond Knopp committed
456 457
  while (!oai_exit) {

458
    if (wait_on_condition(&proc->mutex_fep,&proc->cond_fep,&proc->instance_cnt_fep,"fep thread")<0) break; 
459
	//stop_meas(&ru->ofdm_demod_wakeup_stats);
460
	VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX1, 1 ); 
Raymond Knopp's avatar
Raymond Knopp committed
461
    fep0(ru,0);
462
	VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX1, 0 ); 
Raymond Knopp's avatar
Raymond Knopp committed
463 464 465 466 467 468 469
    if (release_thread(&proc->mutex_fep,&proc->instance_cnt_fep,"fep thread")<0) break;

    if (pthread_cond_signal(&proc->cond_fep) != 0) {
      printf("[eNB] ERROR pthread_cond_signal for fep thread exit\n");
      exit_fun( "ERROR pthread_cond_signal" );
      return NULL;
    }
470 471 472 473
    /*if(opp_enabled == 1 && ru->ofdm_demod_wakeup_stats.diff_now>30*3000){
      print_meas_now(&ru->ofdm_demod_wakeup_stats,"fep wakeup",stderr);
      printf("delay in fep wakeup in frame_rx: %d  subframe_rx: %d \n",proc->frame_rx,proc->subframe_rx);
    }*/
Raymond Knopp's avatar
Raymond Knopp committed
474 475 476 477 478 479 480
  }



  return(NULL);
}

481 482 483 484 485 486 487 488 489 490 491 492 493 494
void init_feptx_thread(RU_t *ru,pthread_attr_t *attr_feptx) {

  RU_proc_t *proc = &ru->proc;

  proc->instance_cnt_feptx         = -1;
    
  pthread_mutex_init( &proc->mutex_feptx, NULL);
  pthread_cond_init( &proc->cond_feptx, NULL);

  pthread_create(&proc->pthread_feptx, attr_feptx, feptx_thread, (void*)ru);


}

495
void init_fep_thread(RU_t *ru,pthread_attr_t *attr_fep) {
Raymond Knopp's avatar
Raymond Knopp committed
496

497
  RU_proc_t *proc = &ru->proc;
Raymond Knopp's avatar
Raymond Knopp committed
498 499 500 501 502 503

  proc->instance_cnt_fep         = -1;
    
  pthread_mutex_init( &proc->mutex_fep, NULL);
  pthread_cond_init( &proc->cond_fep, NULL);

504
  pthread_create(&proc->pthread_fep, attr_fep, fep_thread, (void*)ru);
Raymond Knopp's avatar
Raymond Knopp committed
505 506 507 508 509


}
void ru_fep_full_2thread(RU_t *ru) {

510
  RU_proc_t *proc = &ru->proc;
Raymond Knopp's avatar
Raymond Knopp committed
511 512 513

  struct timespec wait;

514 515 516 517 518 519 520
  LTE_DL_FRAME_PARMS *fp=&ru->frame_parms;

  if ((fp->frame_type == TDD) &&
     (subframe_select(fp,proc->subframe_rx) != SF_UL)) return;

  if (ru->idx == 0) VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX, 1 );

Raymond Knopp's avatar
Raymond Knopp committed
521 522 523
  wait.tv_sec=0;
  wait.tv_nsec=5000000L;

524
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX, 1 );
Raymond Knopp's avatar
Raymond Knopp committed
525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547
  start_meas(&ru->ofdm_demod_stats);

  if (pthread_mutex_timedlock(&proc->mutex_fep,&wait) != 0) {
    printf("[RU] ERROR pthread_mutex_lock for fep thread (IC %d)\n", proc->instance_cnt_fep);
    exit_fun( "error locking mutex_fep" );
    return;
  }

  if (proc->instance_cnt_fep==0) {
    printf("[RU] FEP thread busy\n");
    exit_fun("FEP thread busy");
    pthread_mutex_unlock( &proc->mutex_fep );
    return;
  }
  
  ++proc->instance_cnt_fep;


  if (pthread_cond_signal(&proc->cond_fep) != 0) {
    printf("[RU] ERROR pthread_cond_signal for fep thread\n");
    exit_fun( "ERROR pthread_cond_signal" );
    return;
  }
548
  //start_meas(&ru->ofdm_demod_wakeup_stats);
Raymond Knopp's avatar
Raymond Knopp committed
549 550 551 552 553 554
  
  pthread_mutex_unlock( &proc->mutex_fep );

  // call second slot in this symbol
  fep0(ru,1);

555
  start_meas(&ru->ofdm_demod_wait_stats);
Raymond Knopp's avatar
Raymond Knopp committed
556
  wait_on_busy_condition(&proc->mutex_fep,&proc->cond_fep,&proc->instance_cnt_fep,"fep thread");  
557 558 559 560 561
  stop_meas(&ru->ofdm_demod_wait_stats);
  if(opp_enabled == 1 && ru->ofdm_demod_wakeup_stats.diff_now>30*3000){
    print_meas_now(&ru->ofdm_demod_wakeup_stats,"fep wakeup",stderr);
    printf("delay in fep wait on codition in frame_rx: %d  subframe_rx: %d \n",proc->frame_rx,proc->subframe_rx);
  }
Raymond Knopp's avatar
Raymond Knopp committed
562 563

  stop_meas(&ru->ofdm_demod_stats);
564
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX, 0 );
Raymond Knopp's avatar
Raymond Knopp committed
565 566 567 568
}



569
void fep_full(RU_t *ru) {
Raymond Knopp's avatar
Raymond Knopp committed
570

571
  RU_proc_t *proc = &ru->proc;
Raymond Knopp's avatar
Raymond Knopp committed
572
  int l;
573
  LTE_DL_FRAME_PARMS *fp=&ru->frame_parms;
Raymond Knopp's avatar
Raymond Knopp committed
574

575 576
  if ((fp->frame_type == TDD) && 
     (subframe_select(fp,proc->subframe_rx) != SF_UL)) return;
Raymond Knopp's avatar
Raymond Knopp committed
577

578 579
  start_meas(&ru->ofdm_demod_stats);
  if (ru->idx == 0) VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX, 1 );
Raymond Knopp's avatar
Raymond Knopp committed
580 581 582

  remove_7_5_kHz(ru,proc->subframe_rx<<1);
  remove_7_5_kHz(ru,1+(proc->subframe_rx<<1));
583

Raymond Knopp's avatar
Raymond Knopp committed
584
  for (l=0; l<fp->symbols_per_tti/2; l++) {
585
    slot_fep_ul(ru,
Raymond Knopp's avatar
Raymond Knopp committed
586
		l,
587
		0,
Raymond Knopp's avatar
Raymond Knopp committed
588 589
		0
		);
590
    slot_fep_ul(ru,
Raymond Knopp's avatar
Raymond Knopp committed
591
		l,
592
		1,
Raymond Knopp's avatar
Raymond Knopp committed
593 594 595
		0
		);
  }
596
  if (ru->idx == 0) VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_PHY_PROCEDURES_RU_FEPRX, 0 );
Raymond Knopp's avatar
Raymond Knopp committed
597 598 599 600 601 602 603 604
  stop_meas(&ru->ofdm_demod_stats);
  
  
}


void do_prach_ru(RU_t *ru) {

605 606
  RU_proc_t *proc = &ru->proc;
  LTE_DL_FRAME_PARMS *fp=&ru->frame_parms;
Raymond Knopp's avatar
Raymond Knopp committed
607 608

  // check if we have to detect PRACH first
609
  if (is_prach_subframe(fp,proc->frame_prach,proc->subframe_prach)>0) { 
610
    //accept some delay in processing - up to 5ms
Raymond Knopp's avatar
Raymond Knopp committed
611 612
    int i;
    for (i = 0; i < 10 && proc->instance_cnt_prach == 0; i++) {
613 614
      LOG_W(PHY,"Frame %d Subframe %d, PRACH thread busy (IC %d)!!\n", proc->frame_prach,proc->subframe_prach,
	    proc->instance_cnt_prach);
Raymond Knopp's avatar
Raymond Knopp committed
615 616 617 618 619 620 621 622 623
      usleep(500);
    }
    if (proc->instance_cnt_prach == 0) {
      exit_fun( "PRACH thread busy" );
      return;
    }
    
    // wake up thread for PRACH RX
    if (pthread_mutex_lock(&proc->mutex_prach) != 0) {
624
      LOG_E( PHY, "ERROR pthread_mutex_lock for PRACH thread (IC %d)\n", proc->instance_cnt_prach );
Raymond Knopp's avatar
Raymond Knopp committed
625 626 627 628 629 630 631 632
      exit_fun( "error locking mutex_prach" );
      return;
    }
    
    ++proc->instance_cnt_prach;
    
    // the thread can now be woken up
    if (pthread_cond_signal(&proc->cond_prach) != 0) {
633
      LOG_E( PHY, "ERROR pthread_cond_signal for PRACH thread\n");
Raymond Knopp's avatar
Raymond Knopp committed
634 635 636 637 638 639 640 641
      exit_fun( "ERROR pthread_cond_signal" );
      return;
    }
    
    pthread_mutex_unlock( &proc->mutex_prach );
  }

}