lte-softmodem.c 135 KB
Newer Older
1
/*******************************************************************************
2 3
    OpenAirInterface 
    Copyright(c) 1999 - 2014 Eurecom
4

5 6 7 8
    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.
9 10


11 12 13 14
    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.
15

16 17 18 19
    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/>.
20

21 22 23 24 25
   Contact Information
   OpenAirInterface Admin: openair_admin@eurecom.fr
   OpenAirInterface Tech : openair_tech@eurecom.fr
   OpenAirInterface Dev  : openair4g-devel@eurecom.fr
  
ghaddab's avatar
ghaddab committed
26
   Address      : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
27

knopp's avatar
 
knopp committed
28
*******************************************************************************/
29 30

/*! \file lte-softmodem.c
knopp's avatar
 
knopp committed
31
 * \brief main program to control HW and scheduling
32
 * \author R. Knopp, F. Kaltenberger, Navid Nikaein
knopp's avatar
 
knopp committed
33 34 35
 * \date 2012
 * \version 0.1
 * \company Eurecom
36
 * \email: knopp@eurecom.fr,florian.kaltenberger@eurecom.fr, navid.nikaein@eurecom.fr
knopp's avatar
 
knopp committed
37 38 39
 * \note
 * \warning
 */
knopp's avatar
 
knopp committed
40
#define _GNU_SOURCE
41 42 43 44 45 46 47 48 49 50
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <sys/ioctl.h>
#include <sys/types.h>
#include <sys/mman.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sched.h>
51
#include <linux/sched.h>
52 53 54
#include <signal.h>
#include <execinfo.h>
#include <getopt.h>
55
#include <syscall.h>
56 57

#include "rt_wrapper.h"
58 59
#undef MALLOC //there are two conflicting definitions, so we better make sure we don't use it at all

knopp's avatar
knopp committed
60
#ifndef EXMIMO
knopp's avatar
 
knopp committed
61
static int hw_subframe;
knopp's avatar
 
knopp committed
62
#endif
knopp's avatar
 
knopp committed
63

64
#include "assertions.h"
65 66 67 68 69 70

#ifdef EMOS
#include <gps.h>
#endif

#include "PHY/types.h"
71

72
#include "PHY/defs.h"
73
#undef MALLOC //there are two conflicting definitions, so we better make sure we don't use it at all
knopp's avatar
 
knopp committed
74
//#undef FRAME_LENGTH_COMPLEX_SAMPLES //there are two conflicting definitions, so we better make sure we don't use it at all
75

knopp's avatar
knopp committed
76
#ifdef EXMIMO
77
#include "openair0_lib.h"
knopp's avatar
 
knopp committed
78 79 80 81
#else
#include "../../ARCH/COMMON/common_lib.h"
#endif

knopp's avatar
 
knopp committed
82
//#undef FRAME_LENGTH_COMPLEX_SAMPLES //there are two conflicting definitions, so we better make sure we don't use it at all
83 84 85

#include "PHY/vars.h"
#include "MAC_INTERFACE/vars.h"
86
//#include "SCHED/defs.h"
87 88 89 90 91 92 93 94 95 96 97 98
#include "SCHED/vars.h"
#include "LAYER2/MAC/vars.h"

#include "../../SIMU/USER/init_lte.h"

#ifdef EMOS
#include "SCHED/phy_procedures_emos.h"
#endif

#ifdef OPENAIR2
#include "LAYER2/MAC/defs.h"
#include "LAYER2/MAC/vars.h"
99
#include "LAYER2/MAC/proto.h"
100 101 102 103 104 105 106 107 108 109 110
#ifndef CELLULAR
#include "RRC/LITE/vars.h"
#endif
#include "PHY_INTERFACE/vars.h"
#endif

#ifdef SMBV
#include "PHY/TOOLS/smbv.h"
unsigned short config_frames[4] = {2,9,11,13};
#endif
#include "UTIL/LOG/log_extern.h"
nikaeinn's avatar
nikaeinn committed
111
#include "UTIL/OTG/otg_tx.h"
112
#include "UTIL/OTG/otg_externs.h"
113 114
#include "UTIL/MATH/oml.h"
#include "UTIL/LOG/vcd_signal_dumper.h"
115
#include "UTIL/OPT/opt.h"
116
#include "enb_config.h"
nikaeinn's avatar
nikaeinn committed
117
//#include "PHY/TOOLS/time_meas.h"
118

119 120
#if defined(ENABLE_ITTI)
# include "intertask_interface_init.h"
121
# include "create_tasks.h"
122 123 124
# if defined(ENABLE_USE_MME)
#   include "s1ap_eNB.h"
# endif
125 126
#endif

127 128 129
#ifdef XFORMS
#include "PHY/TOOLS/lte_phy_scope.h"
#include "stats.h"
130 131 132 133 134
#endif

#define FRAME_PERIOD    100000000ULL
#define DAQ_PERIOD      66667ULL

knopp's avatar
 
knopp committed
135
#define DEBUG_THREADS 1
knopp's avatar
 
knopp committed
136

knopp's avatar
 
knopp committed
137 138
//#define USRP_DEBUG 1

139 140 141 142 143 144 145
struct timing_info_t {
  //unsigned int frame, hw_slot, last_slot, next_slot;
  RTIME time_min, time_max, time_avg, time_last, time_now;
  //unsigned int mbox0, mbox1, mbox2, mbox_target;
  unsigned int n_samples;
} timing_info;

gauthier's avatar
gauthier committed
146 147
extern int16_t* sync_corr_ue0;
extern int16_t prach_ifft[4][1024*2];
148 149 150

int init_dlsch_threads(void);
void cleanup_dlsch_threads(void);
gauthier's avatar
gauthier committed
151
int32_t init_rx_pdsch_thread(void);
152
void cleanup_rx_pdsch_thread(void);
knopp's avatar
 
knopp committed
153

154
openair0_config_t openair0_cfg[MAX_CARDS];
knopp's avatar
 
knopp committed
155

knopp's avatar
 
knopp committed
156 157
int32_t **rxdata;
int32_t **txdata;
158 159
int setup_ue_buffers(PHY_VARS_UE **phy_vars_ue, openair0_config_t *openair0_cfg, openair0_rf_map rf_map[MAX_NUM_CCs]);
int setup_eNB_buffers(PHY_VARS_eNB **phy_vars_eNB, openair0_config_t *openair0_cfg, openair0_rf_map rf_map[MAX_NUM_CCs]);
160 161

#ifdef XFORMS
162 163 164 165
// current status is that every UE has a DL scope for a SINGLE eNB (eNB_id=0)
// at eNB 0, an UL scope for every UE 
FD_lte_phy_scope_ue  *form_ue[NUMBER_OF_UE_MAX];
FD_lte_phy_scope_enb *form_enb[NUMBER_OF_UE_MAX];
166
FD_stats_form                  *form_stats=NULL,*form_stats_l2=NULL;
167
char title[255];
168
unsigned char                   scope_enb_num_ue = 1;
169 170 171
#endif //XFORMS

#ifdef RTAI
172
static SEM                     *mutex;
173 174
//static CND *cond;

175 176
static long                      main_eNB_thread;
static long                      main_ue_thread;
knopp's avatar
 
knopp committed
177
static SEM *sync_sem; // to sync rx & tx streaming
178

179 180
//static int sync_thread;
#else
knopp's avatar
 
knopp committed
181 182
pthread_t                       main_eNB_thread;
pthread_t                       main_ue_thread;
183
pthread_attr_t                  attr_dlsch_threads;
184 185
pthread_attr_t                  attr_UE_thread;

186
#ifndef LOWLATENCY
187
struct sched_param              sched_param_dlsch;
188
#endif 
knopp's avatar
 
knopp committed
189

knopp's avatar
 
knopp committed
190 191
pthread_cond_t sync_cond;
pthread_mutex_t sync_mutex;
192
int sync_var=-1;
193
#endif
194

knopp's avatar
 
knopp committed
195
RTIME T0;
196

knopp's avatar
 
knopp committed
197 198 199 200 201 202
pthread_attr_t                  attr_UE_init_synch;
pthread_attr_t                  attr_UE_thread_tx;
pthread_attr_t                  attr_UE_thread_rx;
struct sched_param              sched_param_UE_init_synch;
struct sched_param              sched_param_UE_thread_tx;
struct sched_param              sched_param_UE_thread_rx;
203 204 205 206

pthread_attr_t                  attr_eNB_proc_tx[MAX_NUM_CCs][10];
pthread_attr_t                  attr_eNB_proc_rx[MAX_NUM_CCs][10];
#ifndef LOWLATENCY
knopp's avatar
 
knopp committed
207 208
struct sched_param              sched_param_eNB_proc_tx[MAX_NUM_CCs][10];
struct sched_param              sched_param_eNB_proc_rx[MAX_NUM_CCs][10];
209
#endif
210
#ifdef XFORMS
knopp's avatar
 
knopp committed
211
static pthread_t                forms_thread; //xforms
212 213 214 215
#endif
#ifdef EMOS
static pthread_t                thread3; //emos
#endif
216

knopp's avatar
 
knopp committed
217 218 219
openair0_device openair0;
openair0_timestamp timestamp;

220
/*
knopp's avatar
 
knopp committed
221 222 223
  static int instance_cnt=-1; //0 means worker is busy, -1 means its free
  int instance_cnt_ptr_kern,*instance_cnt_ptr_user;
  int pci_interface_ptr_kern;
224 225 226 227
*/
//extern unsigned int bigphys_top;
//extern unsigned int mem_base;

228
int                             card = 0;
knopp's avatar
 
knopp committed
229

230

231
#if defined(ENABLE_ITTI)
232 233
static volatile int             start_eNB = 0;
static volatile int             start_UE = 0;
234
#endif
235 236 237 238 239 240
volatile int                    oai_exit = 0;

//static int                      time_offset[4] = {-138,-138,-138,-138};
//static int                      time_offset[4] = {-145,-145,-145,-145};
static int                      time_offset[4] = {0,0,0,0};

knopp's avatar
 
knopp committed
241

242
static char                     UE_flag=0;
243
static uint8_t                  eNB_id=0,UE_id=0;
244

245
//uint32_t                        carrier_freq[MAX_NUM_CCs][4] =           {{1907600000,1907600000,1907600000,1907600000}}; /* For UE! */
246 247 248
static uint32_t                 downlink_frequency[MAX_NUM_CCs][4] =     {{1907600000,1907600000,1907600000,1907600000},
									  {1907600000,1907600000,1907600000,1907600000}};
static int32_t                  uplink_frequency_offset[MAX_NUM_CCs][4]= {{0,0,0,0},{0,0,0,0}};
249 250

openair0_rf_map rf_map[MAX_NUM_CCs];
251

252
static char                    *conf_config_file_name = NULL;
253
#if defined(ENABLE_ITTI)
254
static char                    *itti_dump_file = NULL;
knopp's avatar
 
knopp committed
255 256
#endif

knopp's avatar
 
knopp committed
257
#ifdef EXMIMO
258 259
double tx_gain[MAX_NUM_CCs][4] = {{20,20,0,0},{20,20,0,0}};
double rx_gain[MAX_NUM_CCs][4] = {{20,20,0,0},{20,20,0,0}};
260
// these are for EXMIMO2 target only
261
/*
knopp's avatar
 
knopp committed
262 263 264
  static unsigned int             rxg_max[4] =    {133,133,133,133};
  static unsigned int             rxg_med[4] =    {127,127,127,127};
  static unsigned int             rxg_byp[4] =    {120,120,120,120};
265 266 267 268 269 270 271 272
*/
// these are for EXMIMO2 card 39
static unsigned int             rxg_max[4] =    {128,128,128,126};
static unsigned int             rxg_med[4] =    {122,123,123,120};
static unsigned int             rxg_byp[4] =    {116,117,116,116};
static unsigned int             nf_max[4] =    {7,9,16,12};
static unsigned int             nf_med[4] =    {12,13,22,17};
static unsigned int             nf_byp[4] =    {15,20,29,23};
273
static rx_gain_t                rx_gain_mode[MAX_NUM_CCs][4] = {{max_gain,max_gain,max_gain,max_gain},{max_gain,max_gain,max_gain,max_gain}};
gauthier's avatar
gauthier committed
274
#else
275
double tx_gain[MAX_NUM_CCs][4] = {{120,0,0,0}};
knopp's avatar
 
knopp committed
276
double rx_gain[MAX_NUM_CCs][4] = {{125,0,0,0}};
gauthier's avatar
gauthier committed
277
#endif
knopp's avatar
 
knopp committed
278

knopp's avatar
 
knopp committed
279 280
double sample_rate=30.72e6;
double bw = 14e6;
281

282
static int                      tx_max_power[MAX_NUM_CCs] =  {0,0};
283

knopp's avatar
knopp committed
284
#ifndef EXMIMO
knopp's avatar
 
knopp committed
285 286 287
char ref[128] = "internal";
char channels[128] = "0";

knopp's avatar
 
knopp committed
288 289 290
unsigned int samples_per_frame = 307200;
unsigned int samples_per_packets = 2048; // samples got every recv or send
unsigned int tx_forward_nsamps;
knopp's avatar
 
knopp committed
291

knopp's avatar
 
knopp committed
292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307
#ifndef USRP
//256 sample blocks
int sf_bounds_1_5[10]    = {8, 15, 23, 30, 38, 45, 53, 60, 68, 75};
int sf_bounds_1_5_tx[10] = {4, 11, 19, 26, 34, 41, 49, 56, 64, 71};

int sf_bounds_5[10] = {5,10,15,20,25,30,35,40,45,50};
int sf_bounds_5_tx[10] = {3,8,13,18,23,28,33,38,43,48};

int sf_bounds_10[10]    = {10, 20, 30, 40, 50, 60, 70, 80, 90, 100};
int sf_bounds_10_tx[10] = {5, 15, 25, 35, 45, 55, 65, 75, 85,95};

int sf_bounds_20[10] = {20, 40, 60, 80, 100, 120, 140, 160, 180, 200};
int sf_bounds_20_tx[10] = {10, 30, 50, 70, 90, 110, 130, 150, 170, 190};

#else

knopp's avatar
 
knopp committed
308 309 310
int sf_bounds_1_5[10]    = {8, 15, 23, 30, 38, 45, 53, 60, 68, 75};
int sf_bounds_1_5_tx[10] = {4, 11, 19, 26, 34, 41, 49, 56, 64, 71};

knopp's avatar
 
knopp committed
311 312 313
int sf_bounds_5[10]    = {8, 15, 23, 30, 38, 45, 53, 60, 68, 75};
int sf_bounds_5_tx[10] = {4, 11, 19, 26, 34, 41, 49, 56, 64, 71};

knopp's avatar
 
knopp committed
314
int sf_bounds_10[10] = {8, 15, 23, 30, 38, 45, 53, 60, 68, 75};
knopp's avatar
 
knopp committed
315 316
int sf_bounds_10_tx[10] = {4, 11, 19, 26, 34, 41, 49, 56, 64, 71};

knopp's avatar
 
knopp committed
317
int sf_bounds_20[10] = {15, 30, 45, 60, 75, 90, 105, 120, 135, 150};
knopp's avatar
 
knopp committed
318
int sf_bounds_20_tx[10] = {7, 22, 37, 52, 67, 82, 97, 112, 127, 142};
knopp's avatar
 
knopp committed
319
#endif
knopp's avatar
 
knopp committed
320

knopp's avatar
 
knopp committed
321
int *sf_bounds;
knopp's avatar
 
knopp committed
322 323
int *sf_bounds_tx;

knopp's avatar
 
knopp committed
324 325 326 327
int max_cnt;
int tx_delay;

#endif
328
/*
knopp's avatar
 
knopp committed
329 330 331
  uint32_t rf_mode_max[4]     = {55759,55759,55759,55759};
  uint32_t rf_mode_med[4]     = {39375,39375,39375,39375};
  uint32_t rf_mode_byp[4]     = {22991,22991,22991,22991};
332
*/
knopp's avatar
 
knopp committed
333 334
//static uint32_t                      rf_mode[4] =        {MY_RF_MODE,0,0,0};
//static uint32_t                      rf_local[4] =       {8255000,8255000,8255000,8255000}; // UE zepto
knopp's avatar
 
knopp committed
335 336
//{8254617, 8254617, 8254617, 8254617}; //eNB khalifa
//{8255067,8254810,8257340,8257340}; // eNB PETRONAS
337

knopp's avatar
 
knopp committed
338 339 340 341 342
//static uint32_t                      rf_vcocal[4] =      {910,910,910,910};
//static uint32_t                      rf_vcocal_850[4] =  {2015, 2015, 2015, 2015};
//static uint32_t                      rf_rxdc[4] =        {32896,32896,32896,32896};
//static uint32_t                      rxgain[4] =         {20,20,20,20};
//static uint32_t                      txgain[4] =         {20,20,20,20};
343 344 345

static runmode_t                mode;
static int                      rx_input_level_dBm;
346
static int                      online_log_messages=0;
347
#ifdef XFORMS
348
extern int                      otg_enabled;
349
static char                     do_forms=0;
350
#else
351
int                             otg_enabled;
352
#endif
knopp's avatar
 
knopp committed
353
//int                             number_of_cards =   1;
knopp's avatar
 
knopp committed
354
#ifdef EXMIMO
355 356
static int                      mbox_bounds[20] =   {8,16,24,30,38,46,54,60,68,76,84,90,98,106,114,120,128,136,144, 0}; ///boundaries of slots in terms ob mbox counter rounded up to even numbers
//static int                      mbox_bounds[20] =   {6,14,22,28,36,44,52,58,66,74,82,88,96,104,112,118,126,134,142, 148}; ///boundaries of slots in terms ob mbox counter rounded up to even numbers
knopp's avatar
 
knopp committed
357
#endif
358

knopp's avatar
 
knopp committed
359
static LTE_DL_FRAME_PARMS      *frame_parms[MAX_NUM_CCs];
360

knopp's avatar
 
knopp committed
361
int multi_thread=1;
Florian Kaltenberger's avatar
Florian Kaltenberger committed
362
uint32_t target_dl_mcs = 28; //maximum allowed mcs
363
uint32_t target_ul_mcs = 10;
364 365
uint8_t exit_missed_slots=1;
uint64_t num_missed_slots=0; // counter for the number of missed slots
366

knopp's avatar
 
knopp committed
367

368
time_stats_t softmodem_stats_mt; // main thread
knopp's avatar
 
knopp committed
369
time_stats_t softmodem_stats_hw; //  hw acquisition
370 371
time_stats_t softmodem_stats_tx_sf[10]; // total tx time 
time_stats_t softmodem_stats_rx_sf[10]; // total rx time 
nikaeinn's avatar
nikaeinn committed
372 373
void reset_opp_meas(void);
void print_opp_meas(void);
374
int transmission_mode=1;
knopp's avatar
 
knopp committed
375

knopp's avatar
 
knopp committed
376

gauthier's avatar
 
gauthier committed
377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396
int16_t           glog_level         = LOG_DEBUG;
int16_t           glog_verbosity     = LOG_MED;
int16_t           hw_log_level       = LOG_DEBUG;
int16_t           hw_log_verbosity   = LOG_MED;
int16_t           phy_log_level      = LOG_DEBUG;
int16_t           phy_log_verbosity  = LOG_MED;
int16_t           mac_log_level      = LOG_DEBUG;
int16_t           mac_log_verbosity  = LOG_MED;
int16_t           rlc_log_level      = LOG_DEBUG;
int16_t           rlc_log_verbosity  = LOG_MED;
int16_t           pdcp_log_level     = LOG_DEBUG;
int16_t           pdcp_log_verbosity = LOG_MED;
int16_t           rrc_log_level      = LOG_DEBUG;
int16_t           rrc_log_verbosity  = LOG_MED;
# if defined(ENABLE_USE_MME)
int16_t           gtpu_log_level     = LOG_DEBUG;
int16_t           gtpu_log_verbosity = LOG_MED;
int16_t           udp_log_level      = LOG_DEBUG;
int16_t           udp_log_verbosity  = LOG_MED;
#endif
397 398 399 400
#if defined (ENABLE_SECURITY)
int16_t           osa_log_level      = LOG_INFO;
int16_t           osa_log_verbosity  = LOG_MED;
#endif 
401

knopp's avatar
 
knopp committed
402 403 404 405 406 407 408 409 410 411

#ifdef ETHERNET
char rrh_eNB_ip[20] = "127.0.0.1";
int rrh_eNB_port = 1500;
char *rrh_UE_ip = "127.0.0.1";
int rrh_UE_port = 1600;
#endif

char uecap_xer[1024],uecap_xer_in=0;

412
unsigned int build_rflocal(int txi, int txq, int rxi, int rxq)
413
{
knopp's avatar
 
knopp committed
414
  return (txi + (txq<<6) + (rxi<<12) + (rxq<<18));
415 416 417
}
unsigned int build_rfdc(int dcoff_i_rxfe, int dcoff_q_rxfe)
{
knopp's avatar
 
knopp committed
418
  return (dcoff_i_rxfe + (dcoff_q_rxfe<<8));
419 420
}

421 422 423 424 425 426 427 428 429 430 431 432
#ifdef LOWLATENCY
int sched_setattr(pid_t pid, const struct sched_attr *attr, unsigned int flags) {

  return syscall(__NR_sched_setattr, pid, attr, flags);
}


int sched_getattr(pid_t pid,struct sched_attr *attr,unsigned int size, unsigned int flags){

  return syscall(__NR_sched_getattr, pid, attr, size, flags);
}
#endif 
433
#if !defined(ENABLE_ITTI)
434 435 436 437 438 439 440 441 442 443 444 445 446 447 448
void signal_handler(int sig)
{
  void *array[10];
  size_t size;

  if (sig==SIGSEGV) {
    // get void*'s for all entries on the stack
    size = backtrace(array, 10);
    
    // print out all the frames to stderr
    fprintf(stderr, "Error: signal %d:\n", sig);
    backtrace_symbols_fd(array, size, 2);
    exit(-1);
  }
  else {
449
    printf("trying to exit gracefully...\n"); 
450
    oai_exit = 1;
451 452
  }
}
453
#endif
454 455 456

void exit_fun(const char* s)
{
457
  if (s != NULL) {
458
    printf("%s %s() Exiting OAI softmodem: %s\n",__FILE__, __FUNCTION__, s);
459 460 461 462 463
  }

  oai_exit = 1;

#if defined(ENABLE_ITTI)
Florian Kaltenberger's avatar
Florian Kaltenberger committed
464
  sleep(1); //allow lte-softmodem threads to exit first
465
  itti_terminate_tasks (TASK_UNKNOWN);
466
#endif
467 468 469 470 471 472

  //rt_sleep_ns(FRAME_PERIOD);

  //exit (-1);
}

knopp's avatar
 
knopp committed
473 474 475
static int latency_target_fd = -1;
static int32_t latency_target_value = 0;
/* Latency trick - taken from cyclictest.c 
knopp's avatar
 
knopp committed
476 477 478 479 480 481 482 483 484
 * if the file /dev/cpu_dma_latency exists,
 * open it and write a zero into it. This will tell
 * the power management system not to transition to
 * a high cstate (in fact, the system acts like idle=poll)
 * When the fd to /dev/cpu_dma_latency is closed, the behavior
 * goes back to the system default.
 *
 * Documentation/power/pm_qos_interface.txt
 */
knopp's avatar
 
knopp committed
485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
static void set_latency_target(void)
{
  struct stat s;
  int ret;
  if (stat("/dev/cpu_dma_latency", &s) == 0) {
    latency_target_fd = open("/dev/cpu_dma_latency", O_RDWR);
    if (latency_target_fd == -1)
      return;
    ret = write(latency_target_fd, &latency_target_value, 4);
    if (ret == 0) {
      printf("# error setting cpu_dma_latency to %d!: %s\n", latency_target_value, strerror(errno));
      close(latency_target_fd);
      return;
    }
    printf("# /dev/cpu_dma_latency set to %dus\n", latency_target_value);
  }
}
knopp's avatar
 
knopp committed
502
 
503
#ifdef XFORMS
504 505 506 507

void reset_stats(FL_OBJECT *button, long arg) {
  int i,j,k;
  PHY_VARS_eNB *phy_vars_eNB = PHY_vars_eNB_g[0][0];
508 509 510 511 512 513 514 515 516 517 518 519
  for (i=0;i<NUMBER_OF_UE_MAX;i++) {
    for (k=0;k<8;k++) {//harq_processes
      for (j=0;j<phy_vars_eNB->dlsch_eNB[i][0]->Mdlharq;j++) {
	phy_vars_eNB->eNB_UE_stats[i].dlsch_NAK[k][j]=0;
	phy_vars_eNB->eNB_UE_stats[i].dlsch_ACK[k][j]=0;
	phy_vars_eNB->eNB_UE_stats[i].dlsch_trials[k][j]=0;
      }
      phy_vars_eNB->eNB_UE_stats[i].dlsch_l2_errors[k]=0;
      phy_vars_eNB->eNB_UE_stats[i].ulsch_errors[k]=0;
      phy_vars_eNB->eNB_UE_stats[i].ulsch_consecutive_errors=0;
      for (j=0;j<phy_vars_eNB->ulsch_eNB[i]->Mdlharq;j++) {
	phy_vars_eNB->eNB_UE_stats[i].ulsch_decoding_attempts[k][j]=0;
knopp's avatar
 
knopp committed
520 521 522
	phy_vars_eNB->eNB_UE_stats[i].ulsch_decoding_attempts_last[k][j]=0;
	phy_vars_eNB->eNB_UE_stats[i].ulsch_round_errors[k][j]=0;
	phy_vars_eNB->eNB_UE_stats[i].ulsch_round_fer[k][j]=0;
523
      }
524
    }
525 526 527
    phy_vars_eNB->eNB_UE_stats[i].dlsch_sliding_cnt=0;
    phy_vars_eNB->eNB_UE_stats[i].dlsch_NAK_round0=0;
    phy_vars_eNB->eNB_UE_stats[i].dlsch_mcs_offset=0;
528 529 530
  }
}

531
static void *scope_thread(void *arg) {
knopp's avatar
 
knopp committed
532
  char stats_buffer[16384];
533
# ifdef ENABLE_XFORMS_WRITE_STATS
knopp's avatar
 
knopp committed
534 535
  FILE *UE_stats, *eNB_stats;
  int len = 0;
536
# endif
knopp's avatar
 
knopp committed
537
  struct sched_param sched_param;
538

knopp's avatar
 
knopp committed
539 540
  sched_param.sched_priority = sched_get_priority_min(SCHED_FIFO)+1; 
  sched_setscheduler(0, SCHED_FIFO,&sched_param);
541

knopp's avatar
 
knopp committed
542
  printf("Scope thread has priority %d\n",sched_param.sched_priority);
543
    
544 545
# ifdef ENABLE_XFORMS_WRITE_STATS
  if (UE_flag==1) 
knopp's avatar
 
knopp committed
546
    UE_stats  = fopen("UE_stats.txt", "w");
547
  else 
knopp's avatar
 
knopp committed
548
    eNB_stats = fopen("eNB_stats.txt", "w");
549
#endif
550
    
knopp's avatar
 
knopp committed
551 552
  while (!oai_exit) {
    if (UE_flag==1) {
553
# ifdef ENABLE_XFORMS_WRITE_STATS
knopp's avatar
 
knopp committed
554
      len =
555
# endif
556
	dump_ue_stats (PHY_vars_UE_g[0][0], stats_buffer, 0, mode,rx_input_level_dBm);
knopp's avatar
 
knopp committed
557
      fl_set_object_label(form_stats->stats_text, stats_buffer);
558

knopp's avatar
 
knopp committed
559
      phy_scope_UE(form_ue[UE_id], 
560
		   PHY_vars_UE_g[UE_id][0],
knopp's avatar
 
knopp committed
561 562
		   eNB_id,
		   UE_id,7);
563
            
knopp's avatar
 
knopp committed
564
    } else {
565
# ifdef ENABLE_XFORMS_WRITE_STATS
knopp's avatar
 
knopp committed
566
      len =
567
# endif
knopp's avatar
 
knopp committed
568
	dump_eNB_l2_stats (stats_buffer, 0);
569
      fl_set_object_label(form_stats_l2->stats_text, stats_buffer);
570 571 572 573 574 575 576

# ifdef ENABLE_XFORMS_WRITE_STATS
      len =
# endif
	dump_eNB_stats (PHY_vars_eNB_g[0][0], stats_buffer, 0);
      fl_set_object_label(form_stats->stats_text, stats_buffer);

knopp's avatar
 
knopp committed
577 578
      for(UE_id=0;UE_id<scope_enb_num_ue;UE_id++) {
	phy_scope_eNB(form_enb[UE_id], 
knopp's avatar
 
knopp committed
579
		      PHY_vars_eNB_g[eNB_id][0],
knopp's avatar
 
knopp committed
580 581
		      UE_id);
      }
582 583
              
    }
knopp's avatar
 
knopp committed
584
    //printf("doing forms\n");
Florian Kaltenberger's avatar
Florian Kaltenberger committed
585 586
    //usleep(100000); // 100 ms
    sleep(1);
knopp's avatar
 
knopp committed
587
  }
588 589

  printf("%s",stats_buffer);
590
    
591
# ifdef ENABLE_XFORMS_WRITE_STATS
592 593 594 595 596 597 598 599 600 601 602 603 604 605
  if (UE_flag==1) {
    if (UE_stats) {
      rewind (UE_stats);
      fwrite (stats_buffer, 1, len, UE_stats);
      fclose (UE_stats);
    }
  }
  else {
    if (eNB_stats) {
      rewind (eNB_stats);
      fwrite (stats_buffer, 1, len, eNB_stats);
      fclose (eNB_stats);
    }
  }
606
# endif
607
    
knopp's avatar
 
knopp committed
608
  pthread_exit((void*)arg);
609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633
}
#endif

#ifdef EMOS
#define NO_ESTIMATES_DISK 100 //No. of estimates that are aquired before dumped to disk

void *emos_thread (void *arg)
{
  char c;
  char *fifo2file_buffer, *fifo2file_ptr;

  int fifo, counter=0, bytes;

  FILE  *dumpfile_id;
  char  dumpfile_name[1024];
  time_t starttime_tmp;
  struct tm starttime;
  
  int channel_buffer_size;
  
  time_t timer;
  struct tm *now;

  struct gps_data_t *gps_data = NULL;
  struct gps_fix_t dummy_gps_data;
634 635 636 637 638 639 640

  struct sched_param sched_param;
  
  sched_param.sched_priority = sched_get_priority_max(SCHED_FIFO)-1; 
  sched_setscheduler(0, SCHED_FIFO,&sched_param);
  
  printf("EMOS thread has priority %d\n",sched_param.sched_priority);
641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662
 
  timer = time(NULL);
  now = localtime(&timer);

  memset(&dummy_gps_data,1,sizeof(struct gps_fix_t));
  
  gps_data = gps_open("127.0.0.1","2947");
  if (gps_data == NULL) 
    {
      printf("[EMOS] Could not open GPS\n");
      //exit(-1);
    }
#if GPSD_API_MAJOR_VERSION>=4
  else if (gps_stream(gps_data, WATCH_ENABLE,NULL) != 0)
#else
  else if (gps_query(gps_data, "w+x") != 0)
#endif
    {
      //sprintf(tmptxt,"Error sending command to GPS, gps_data = %x", gps_data);
      printf("[EMOS] Error sending command to GPS\n");
      //exit(-1);
    }
663 664
  else 
    printf("[EMOS] Opened GPS, gps_data=%p\n");
665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709
  
  if (UE_flag==0)
    channel_buffer_size = sizeof(fifo_dump_emos_eNB);
  else
    channel_buffer_size = sizeof(fifo_dump_emos_UE);

  // allocate memory for NO_FRAMES_DISK channes estimations
  fifo2file_buffer = malloc(NO_ESTIMATES_DISK*channel_buffer_size);
  fifo2file_ptr = fifo2file_buffer;

  if (fifo2file_buffer == NULL)
    {
      printf("[EMOS] Cound not allocate memory for fifo2file_buffer\n");
      exit(EXIT_FAILURE);
    }

  if ((fifo = open(CHANSOUNDER_FIFO_DEV, O_RDONLY)) < 0)
    {
      fprintf(stderr, "[EMOS] Error opening the fifo\n");
      exit(EXIT_FAILURE);
    }


  time(&starttime_tmp);
  localtime_r(&starttime_tmp,&starttime);
  snprintf(dumpfile_name,1024,"/tmp/%s_data_%d%02d%02d_%02d%02d%02d.EMOS",
	   (UE_flag==0) ? "eNB" : "UE",
	   1900+starttime.tm_year, starttime.tm_mon+1, starttime.tm_mday, starttime.tm_hour, starttime.tm_min, starttime.tm_sec);

  dumpfile_id = fopen(dumpfile_name,"w");
  if (dumpfile_id == NULL)
    {
      fprintf(stderr, "[EMOS] Error opening dumpfile %s\n",dumpfile_name);
      exit(EXIT_FAILURE);
    }


  printf("[EMOS] starting dump, channel_buffer_size=%d ...\n",channel_buffer_size);
  while (!oai_exit)
    {
      bytes = rtf_read_timed(fifo, fifo2file_ptr, channel_buffer_size,100);
      if (bytes==0)
	continue;

      /*
knopp's avatar
 
knopp committed
710
	if (UE_flag==0)
711
	printf("eNB: count %d, frame %d, read: %d bytes from the fifo\n",counter, ((fifo_dump_emos_eNB*)fifo2file_ptr)->frame_tx,bytes);
knopp's avatar
 
knopp committed
712
	else
713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773
	printf("UE: count %d, frame %d, read: %d bytes from the fifo\n",counter, ((fifo_dump_emos_UE*)fifo2file_ptr)->frame_rx,bytes);
      */

      fifo2file_ptr += channel_buffer_size;
      counter ++;

      if (counter == NO_ESTIMATES_DISK)
        {
          //reset stuff
          fifo2file_ptr = fifo2file_buffer;
          counter = 0;

          //flush buffer to disk
	  if (UE_flag==0)
	    printf("[EMOS] eNB: count %d, frame %d, flushing buffer to disk\n",
		   counter, ((fifo_dump_emos_eNB*)fifo2file_ptr)->frame_tx);
	  else
	    printf("[EMOS] UE: count %d, frame %d, flushing buffer to disk\n",
		   counter, ((fifo_dump_emos_UE*)fifo2file_ptr)->frame_rx);


          if (fwrite(fifo2file_buffer, sizeof(char), NO_ESTIMATES_DISK*channel_buffer_size, dumpfile_id) != NO_ESTIMATES_DISK*channel_buffer_size)
            {
              fprintf(stderr, "[EMOS] Error writing to dumpfile\n");
              exit(EXIT_FAILURE);
            }
	  if (gps_data)
	    {
	      if (gps_poll(gps_data) != 0) {
		printf("[EMOS] problem polling data from gps\n");
	      }
	      else {
		printf("[EMOS] lat %g, lon %g\n",gps_data->fix.latitude,gps_data->fix.longitude);
	      }
	      if (fwrite(&(gps_data->fix), sizeof(char), sizeof(struct gps_fix_t), dumpfile_id) != sizeof(struct gps_fix_t))
		{
		  printf("[EMOS] Error writing to dumpfile, stopping recording\n");
		  exit(EXIT_FAILURE);
		}
	    }
	  else
	    {
	      printf("[EMOS] WARNING: No GPS data available, storing dummy packet\n");
	      if (fwrite(&(dummy_gps_data), sizeof(char), sizeof(struct gps_fix_t), dumpfile_id) != sizeof(struct gps_fix_t))
		{
		  printf("[EMOS] Error writing to dumpfile, stopping recording\n");
		  exit(EXIT_FAILURE);
		}
	    } 
        }
    }
  
  free(fifo2file_buffer);
  fclose(dumpfile_id);
  close(fifo);
  
  pthread_exit((void*) arg);

}
#endif

774 775


776
#if defined(ENABLE_ITTI)
777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794
static void wait_system_ready (char *message, volatile int *start_flag)
{
  /* Wait for eNB application initialization to be complete (eNB registration to MME) */
  {
    static char *indicator[] = {".    ", "..   ", "...  ", ".... ", ".....",
                                " ....", "  ...", "   ..", "    .", "     "};
    int i = 0;

    while ((!oai_exit) && (*start_flag == 0)) {
      LOG_N(EMU, message, indicator[i]);
      i = (i + 1) % (sizeof(indicator) / sizeof(indicator[0]));
      usleep(200000);
    }
    LOG_D(EMU,"\n");
  }
}
#endif

knopp's avatar
 
knopp committed
795
#if defined(ENABLE_ITTI)
796
void *l2l1_task(void *arg)
797
{
knopp's avatar
 
knopp committed
798 799 800 801 802
  MessageDef *message_p = NULL;
  int         result;

  itti_set_task_real_time(TASK_L2L1);
  itti_mark_task_ready(TASK_L2L1);
803

knopp's avatar
 
knopp committed
804 805
  if (UE_flag == 0) {
    /* Wait for the initialize message */
806
    do {
knopp's avatar
 
knopp committed
807 808 809 810
      if (message_p != NULL) {
	result = itti_free (ITTI_MSG_ORIGIN_ID(message_p), message_p);
	AssertFatal (result == EXIT_SUCCESS, "Failed to free memory (%d)!\n", result);
      }
811 812 813
      itti_receive_msg (TASK_L2L1, &message_p);

      switch (ITTI_MSG_ID(message_p)) {
knopp's avatar
 
knopp committed
814 815 816 817 818 819 820 821 822 823 824 825 826 827
      case INITIALIZE_MESSAGE:
	/* Start eNB thread */
	LOG_D(EMU, "L2L1 TASK received %s\n", ITTI_MSG_NAME(message_p));
	start_eNB = 1;
	break;

      case TERMINATE_MESSAGE:
	oai_exit=1;
	itti_exit_task ();
	break;

      default:
	LOG_E(EMU, "Received unexpected message %s\n", ITTI_MSG_NAME(message_p));
	break;
828
      }
knopp's avatar
 
knopp committed
829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850
    } while (ITTI_MSG_ID(message_p) != INITIALIZE_MESSAGE);
    result = itti_free (ITTI_MSG_ORIGIN_ID(message_p), message_p);
    AssertFatal (result == EXIT_SUCCESS, "Failed to free memory (%d)!\n", result);
  }

  do {
    // Wait for a message
    itti_receive_msg (TASK_L2L1, &message_p);

    switch (ITTI_MSG_ID(message_p)) {
    case TERMINATE_MESSAGE:
      oai_exit=1;
      itti_exit_task ();
      break;

    case ACTIVATE_MESSAGE:
      start_UE = 1;
      break;

    case DEACTIVATE_MESSAGE:
      start_UE = 0;
      break;
851

knopp's avatar
 
knopp committed
852 853 854 855 856 857 858 859 860 861 862 863
    case MESSAGE_TEST:
      LOG_I(EMU, "Received %s\n", ITTI_MSG_NAME(message_p));
      break;

    default:
      LOG_E(EMU, "Received unexpected message %s\n", ITTI_MSG_NAME(message_p));
      break;
    }

    result = itti_free (ITTI_MSG_ORIGIN_ID(message_p), message_p);
    AssertFatal (result == EXIT_SUCCESS, "Failed to free memory (%d)!\n", result);
  } while(1);
864

knopp's avatar
 
knopp committed
865
  return NULL;
866 867 868
}
#endif

knopp's avatar
 
knopp committed
869

knopp's avatar
 
knopp committed
870
void do_OFDM_mod_rt(int subframe,PHY_VARS_eNB *phy_vars_eNB) {
knopp's avatar
 
knopp committed
871 872 873 874

  unsigned int aa,slot_offset, slot_offset_F;
  int dummy_tx_b[7680*4] __attribute__((aligned(16)));
  int i, tx_offset;
knopp's avatar
 
knopp committed
875
  int slot_sizeF = (phy_vars_eNB->lte_frame_parms.ofdm_symbol_size)*
knopp's avatar
 
knopp committed
876
    ((phy_vars_eNB->lte_frame_parms.Ncp==1) ? 6 : 7);
knopp's avatar
 
knopp committed
877 878 879

  slot_offset_F = (subframe<<1)*slot_sizeF;
    
knopp's avatar
 
knopp committed
880 881
  slot_offset = subframe*phy_vars_eNB->lte_frame_parms.samples_per_tti;

knopp's avatar
 
knopp committed
882 883
  if ((subframe_select(&phy_vars_eNB->lte_frame_parms,subframe)==SF_DL)||
      ((subframe_select(&phy_vars_eNB->lte_frame_parms,subframe)==SF_S))) {
knopp's avatar
 
knopp committed
884
    //	  LOG_D(HW,"Frame %d: Generating slot %d\n",frame,next_slot);
knopp's avatar
 
knopp committed
885

knopp's avatar
 
knopp committed
886
    
knopp's avatar
 
knopp committed
887 888 889 890 891 892 893 894 895 896
    for (aa=0; aa<phy_vars_eNB->lte_frame_parms.nb_antennas_tx; aa++) {
      if (phy_vars_eNB->lte_frame_parms.Ncp == EXTENDED){ 
	PHY_ofdm_mod(&phy_vars_eNB->lte_eNB_common_vars.txdataF[0][aa][slot_offset_F],
		     dummy_tx_b,
		     phy_vars_eNB->lte_frame_parms.log2_symbol_size,
		     6,
		     phy_vars_eNB->lte_frame_parms.nb_prefix_samples,
		     phy_vars_eNB->lte_frame_parms.twiddle_ifft,
		     phy_vars_eNB->lte_frame_parms.rev,
		     CYCLIC_PREFIX);
knopp's avatar
 
knopp committed
897 898 899 900 901 902 903 904
	PHY_ofdm_mod(&phy_vars_eNB->lte_eNB_common_vars.txdataF[0][aa][slot_offset_F+slot_sizeF],
		     dummy_tx_b+(phy_vars_eNB->lte_frame_parms.samples_per_tti>>1),
		     phy_vars_eNB->lte_frame_parms.log2_symbol_size,
		     6,
		     phy_vars_eNB->lte_frame_parms.nb_prefix_samples,
		     phy_vars_eNB->lte_frame_parms.twiddle_ifft,
		     phy_vars_eNB->lte_frame_parms.rev,
		     CYCLIC_PREFIX);
knopp's avatar
 
knopp committed
905 906 907 908 909 910
      }
      else {
	normal_prefix_mod(&phy_vars_eNB->lte_eNB_common_vars.txdataF[0][aa][slot_offset_F],
			  dummy_tx_b,
			  7,
			  &(phy_vars_eNB->lte_frame_parms));
knopp's avatar
 
knopp committed
911 912 913 914
	normal_prefix_mod(&phy_vars_eNB->lte_eNB_common_vars.txdataF[0][aa][slot_offset_F+slot_sizeF],
			  dummy_tx_b+(phy_vars_eNB->lte_frame_parms.samples_per_tti>>1),
			  7,
			  &(phy_vars_eNB->lte_frame_parms));
knopp's avatar
 
knopp committed
915
      }
knopp's avatar
 
knopp committed
916 917

      for (i=0; i<phy_vars_eNB->lte_frame_parms.samples_per_tti; i++) {
knopp's avatar
 
knopp committed
918 919 920 921 922 923
	tx_offset = (int)slot_offset+time_offset[aa]+i;
	if (tx_offset<0)
	  tx_offset += LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*phy_vars_eNB->lte_frame_parms.samples_per_tti;
	if (tx_offset>=(LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*phy_vars_eNB->lte_frame_parms.samples_per_tti))
	  tx_offset -= LTE_NUMBER_OF_SUBFRAMES_PER_FRAME*phy_vars_eNB->lte_frame_parms.samples_per_tti;
	((short*)&phy_vars_eNB->lte_eNB_common_vars.txdata[0][aa][tx_offset])[0]=
knopp's avatar
 
knopp committed
924
#ifdef EXMIMO
knopp's avatar
 
knopp committed
925
	  ((short*)dummy_tx_b)[2*i]<<4;
knopp's avatar
 
knopp committed
926 927 928
#else
	  ((short*)dummy_tx_b)[2*i]<<5;
#endif
knopp's avatar
 
knopp committed
929
	((short*)&phy_vars_eNB->lte_eNB_common_vars.txdata[0][aa][tx_offset])[1]=
knopp's avatar
 
knopp committed
930
#ifdef EXMIMO
knopp's avatar
 
knopp committed
931
	  ((short*)dummy_tx_b)[2*i+1]<<4;
knopp's avatar
 
knopp committed
932 933 934
#else
	  ((short*)dummy_tx_b)[2*i+1]<<5;
#endif
knopp's avatar
 
knopp committed
935 936 937 938 939 940 941 942
      }
    }
  }
}


int eNB_thread_tx_status[10];
static void * eNB_thread_tx(void *param) {
knopp's avatar
 
knopp committed
943 944 945

  //unsigned long cpuid;
  eNB_proc_t *proc = (eNB_proc_t*)param;
knopp's avatar
 
knopp committed
946
  //  RTIME time_in,time_out;
knopp's avatar
 
knopp committed
947 948
#ifdef RTAI
  RT_TASK *task;
949
  char task_name[8];
950 951 952 953
#else 
#ifdef LOWLATENCY
  struct sched_attr attr;
  unsigned int flags = 0;
knopp's avatar
 
knopp committed
954
#endif
955
#endif 
knopp's avatar
 
knopp committed
956 957

 
knopp's avatar
 
knopp committed
958
  /*#if defined(ENABLE_ITTI)
Florian Kaltenberger's avatar
Florian Kaltenberger committed
959
  // Wait for eNB application initialization to be complete (eNB registration to MME)
knopp's avatar
 
knopp committed
960
  wait_system_ready ("Waiting for eNB application to be ready %s\r", &start_eNB);
knopp's avatar
 
knopp committed
961
  #endif*/
knopp's avatar
 
knopp committed
962

knopp's avatar
 
knopp committed
963
#ifdef RTAI
964
  sprintf(task_name,"TXC%dS%d",proc->CC_id,proc->subframe);
knopp's avatar
 
knopp committed
965 966 967
  task = rt_task_init_schmod(nam2num(task_name), 0, 0, 0, SCHED_FIFO, 0xF);

  if (task==NULL) {
knopp's avatar
 
knopp committed
968 969 970
  LOG_E(PHY,"[SCHED][eNB] Problem starting eNB_proc_TX thread_index %d (%s)!!!!\n",proc->subframe,task_name);
  return 0;
}
knopp's avatar
 
knopp committed
971
  else {
knopp's avatar
 
knopp committed
972 973 974 975 976
  LOG_I(PHY,"[SCHED][eNB] eNB TX thread CC %d SF %d started with id %p\n",
    proc->CC_id,
    proc->subframe,
    task);
}
knopp's avatar
 
knopp committed
977
#else
978 979 980 981 982 983
#ifdef LOWLATENCY
  attr.size = sizeof(attr);
  attr.sched_flags = 0;
  attr.sched_nice = 0;
  attr.sched_priority = 0;
  
nikaeinn's avatar
nikaeinn committed
984
  /* This creates a 1ms reservation every 10ms period*/
985 986 987 988 989 990 991 992 993 994 995 996 997
  attr.sched_policy = SCHED_DEADLINE;
  attr.sched_runtime = 1 * 1000000;  // each tx thread requires 1ms to finish its job
  attr.sched_deadline =1 * 1000000; // each tx thread will finish within 1ms
  attr.sched_period = 1 * 10000000; // each tx thread has a period of 10ms from the starting point
  
  if (sched_setattr(0, &attr, flags) < 0 ){
  perror("[SCHED] eNB tx thread: sched_setattr failed\n");
  exit(-1);
}
  LOG_I(HW,"[SCHED] eNB TX deadline thread %d(id %ld) started on CPU %d\n",
    proc->subframe, gettid(),sched_getcpu());
#else 
  LOG_I(HW,"[SCHED] eNB TX thread %d started on CPU %d\n",
knopp's avatar
 
knopp committed
998
    proc->subframe,sched_getcpu());
999 1000
#endif

knopp's avatar
 
knopp committed
1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012
#endif

  mlockall(MCL_CURRENT | MCL_FUTURE);

  //rt_set_runnable_on_cpuid(task,1);
  //cpuid = rtai_cpuid();

#ifdef HARD_RT
  rt_make_hard_real_time();
#endif

  while (!oai_exit){
knopp's avatar
 
knopp committed
1013
    
knopp's avatar
 
knopp committed
1014
  vcd_signal_dumper_dump_function_by_name(VCD_SIGNAL_DUMPER_FUNCTIONS_eNB_PROC_TX0+(2*proc->subframe),0);
knopp's avatar
 
knopp committed
1015
    
knopp's avatar
 
knopp committed
1016 1017
  //LOG_I(PHY,"Locking mutex for eNB proc %d (IC %d,mutex %p)\n",proc->subframe,proc->instance_cnt,&proc->mutex);
  //    printf("Locking mutex for eNB proc %d (subframe_tx %d))\n",proc->subframe,proc->instance_cnt_tx);
knopp's avatar
 
knopp committed
1018

knopp's avatar
 
knopp committed
1019 1020 1021 1022 1023
  if (pthread_mutex_lock(&proc->mutex_tx) != 0) {
  LOG_E(PHY,"[SCHED][eNB] error locking mutex for eNB TX proc %d\n",proc->subframe);
  oai_exit=1;
}
  else {
knopp's avatar
 
knopp committed
1024
      
knopp's avatar
 
knopp committed
1025 1026 1027
  while (proc->instance_cnt_tx < 0) {
  //	LOG_I(PHY,"Waiting and unlocking mutex for eNB proc %d (IC %d,lock %d)\n",proc->subframe,proc->instance_cnt,pthread_mutex_trylock(&proc->mutex));
  //printf("Waiting and unlocking mutex for eNB proc %d (subframe_tx %d)\n",proc->subframe,proc->instance_cnt_tx);
knopp's avatar
 
knopp committed
1028
	
knopp's avatar
 
knopp committed
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039
  pthread_cond_wait(&proc->cond_tx,&proc->mutex_tx);
}
  //      LOG_I(PHY,"Waking up and unlocking mutex for eNB proc %d instance_cnt_tx %d\n",proc->subframe,proc->instance_cnt_tx);
  if (pthread_mutex_unlock(&proc->mutex_tx) != 0) {	
  LOG_E(PHY,"[SCHED][eNB] error unlocking mutex for eNB TX proc %d\n",proc->subframe);
  oai_exit=1;
}
}
  vcd_signal_dumper_dump_function_by_name(VCD_SIGNAL_DUMPER_FUNCTIONS_eNB_PROC_TX0+(2*proc->subframe),1);    
  vcd_signal_dumper_dump_variable_by_name(VCD_SIGNAL_DUMPER_VARIABLES_FRAME_NUMBER_TX_ENB, proc->frame_tx);
  start_meas(&softmodem_stats_tx_sf[proc->subframe]);
1040

knopp's avatar
 
knopp committed
1041
  if (oai_exit) break;
knopp's avatar
 
knopp committed
1042

knopp's avatar
 
knopp committed
1043
    
knopp's avatar
 
knopp committed
1044 1045 1046
  if ((((PHY_vars_eNB_g[0][proc->CC_id]->lte_frame_parms.frame_type == TDD)&&
    (subframe_select(&PHY_vars_eNB_g[0][proc->CC_id]->lte_frame_parms,proc->subframe_tx)==SF_DL))||
    (PHY_vars_eNB_g[0][proc->CC_id]->lte_frame_parms.frame_type == FDD))) {
ghaddab's avatar
ghaddab committed
1047

knopp's avatar
 
knopp committed
1048
  phy_procedures_eNB_TX(proc->subframe,PHY_vars_eNB_g[0][proc->CC_id],0,no_relay,NULL);
knopp's avatar
 
knopp committed
1049
      
knopp's avatar
 
knopp committed
1050 1051 1052 1053
}
  if ((subframe_select(&PHY_vars_eNB_g[0][proc->CC_id]->lte_frame_parms,proc->subframe_tx)==SF_S)) {
  phy_procedures_eNB_TX(proc->subframe,PHY_vars_eNB_g[0][proc->CC_id],0,no_relay,NULL);
}
knopp's avatar