lte-softmodem.c 138 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;
knopp's avatar
knopp committed
346
static int                      UE_scan=1;
347
static int                      online_log_messages=0;
348
#ifdef XFORMS
349
extern int                      otg_enabled;
350
static char                     do_forms=0;
351
#else
352
int                             otg_enabled;
353
#endif
knopp's avatar
 
knopp committed
354
//int                             number_of_cards =   1;
knopp's avatar
 
knopp committed
355
#ifdef EXMIMO
356 357
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
358
#endif
359

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

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

knopp's avatar
 
knopp committed
368

369
time_stats_t softmodem_stats_mt; // main thread
knopp's avatar
 
knopp committed
370
time_stats_t softmodem_stats_hw; //  hw acquisition
371 372
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
373 374
void reset_opp_meas(void);
void print_opp_meas(void);
375
int transmission_mode=1;
knopp's avatar
 
knopp committed
376

knopp's avatar
 
knopp committed
377

gauthier's avatar
 
gauthier committed
378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397
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
398 399 400 401
#if defined (ENABLE_SECURITY)
int16_t           osa_log_level      = LOG_INFO;
int16_t           osa_log_verbosity  = LOG_MED;
#endif 
402

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

#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;

knopp's avatar
knopp committed
413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464
#define KHz (1000UL)
#define MHz (1000 * KHz)

typedef struct eutra_band_s {
  int16_t band;
  uint32_t ul_min;
  uint32_t ul_max;
  uint32_t dl_min;
  uint32_t dl_max;
  lte_frame_type_t frame_type;
} eutra_band_t;

typedef struct band_info_s {
  int nbands;
  eutra_band_t band_info[100];
} band_info_t;

band_info_t bands_to_scan;

static const eutra_band_t eutra_bands[] =
  {
    { 1, 1920    * MHz, 1980    * MHz, 2110    * MHz, 2170    * MHz, FDD},
    { 2, 1850    * MHz, 1910    * MHz, 1930    * MHz, 1990    * MHz, FDD},
    { 3, 1710    * MHz, 1785    * MHz, 1805    * MHz, 1880    * MHz, FDD},
    { 4, 1710    * MHz, 1755    * MHz, 2110    * MHz, 2155    * MHz, FDD},
    { 5,  824    * MHz,  849    * MHz,  869    * MHz,  894    * MHz, FDD},
    { 6,  830    * MHz,  840    * MHz,  875    * MHz,  885    * MHz, FDD},
    { 7, 2500    * MHz, 2570    * MHz, 2620    * MHz, 2690    * MHz, FDD},
    { 8,  880    * MHz,  915    * MHz,  925    * MHz,  960    * MHz, FDD},
    { 9, 1749900 * KHz, 1784900 * KHz, 1844900 * KHz, 1879900 * KHz, FDD},
    {10, 1710    * MHz, 1770    * MHz, 2110    * MHz, 2170    * MHz, FDD},
    {11, 1427900 * KHz, 1452900 * KHz, 1475900 * KHz, 1500900 * KHz, FDD},
    {12,  698    * MHz,  716    * MHz,  728    * MHz,  746    * MHz, FDD},
    {13,  777    * MHz,  787    * MHz,  746    * MHz,  756    * MHz, FDD},
    {14,  788    * MHz,  798    * MHz,  758    * MHz,  768    * MHz, FDD},

    {17,  704    * MHz,  716    * MHz,  734    * MHz,  746    * MHz, FDD},

    {33, 1900    * MHz, 1920    * MHz, 1900    * MHz, 1920    * MHz, TDD},
    {34, 2010    * MHz, 2025    * MHz, 2010    * MHz, 2025    * MHz, TDD},
    {35, 1850    * MHz, 1910    * MHz, 1850    * MHz, 1910    * MHz, TDD},
    {36, 1930    * MHz, 1990    * MHz, 1930    * MHz, 1990    * MHz, TDD},
    {37, 1910    * MHz, 1930    * MHz, 1910    * MHz, 1930    * MHz, TDD},
    {38, 2570    * MHz, 2620    * MHz, 2570    * MHz, 2630    * MHz, TDD},
    {39, 1880    * MHz, 1920    * MHz, 1880    * MHz, 1920    * MHz, TDD},
    {40, 2300    * MHz, 2400    * MHz, 2300    * MHz, 2400    * MHz, TDD},
    {41, 2496    * MHz, 2690    * MHz, 2496    * MHz, 2690    * MHz, TDD},
    {42, 3400    * MHz, 3600    * MHz, 3400    * MHz, 3600    * MHz, TDD},
    {43, 3600    * MHz, 3800    * MHz, 3600    * MHz, 3800    * MHz, TDD},
    {44, 703    * MHz, 803    * MHz, 703    * MHz, 803    * MHz, TDD},
  };

465
unsigned int build_rflocal(int txi, int txq, int rxi, int rxq)
466
{
knopp's avatar
 
knopp committed
467
  return (txi + (txq<<6) + (rxi<<12) + (rxq<<18));
468 469 470
}
unsigned int build_rfdc(int dcoff_i_rxfe, int dcoff_q_rxfe)
{
knopp's avatar
 
knopp committed
471
  return (dcoff_i_rxfe + (dcoff_q_rxfe<<8));
472 473
}

474 475 476 477 478 479 480 481 482 483 484 485
#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 
486
#if !defined(ENABLE_ITTI)
487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
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 {
502
    printf("trying to exit gracefully...\n"); 
503
    oai_exit = 1;
504 505
  }
}
506
#endif
507 508 509

void exit_fun(const char* s)
{
510
  if (s != NULL) {
511
    printf("%s %s() Exiting OAI softmodem: %s\n",__FILE__, __FUNCTION__, s);
512 513 514 515 516
  }

  oai_exit = 1;

#if defined(ENABLE_ITTI)
Florian Kaltenberger's avatar
Florian Kaltenberger committed
517
  sleep(1); //allow lte-softmodem threads to exit first
518
  itti_terminate_tasks (TASK_UNKNOWN);
519
#endif
520 521 522 523 524 525

  //rt_sleep_ns(FRAME_PERIOD);

  //exit (-1);
}

knopp's avatar
 
knopp committed
526 527 528
static int latency_target_fd = -1;
static int32_t latency_target_value = 0;
/* Latency trick - taken from cyclictest.c 
knopp's avatar
 
knopp committed
529 530 531 532 533 534 535 536 537
 * 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
538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554
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
555
 
556
#ifdef XFORMS
557 558 559 560

void reset_stats(FL_OBJECT *button, long arg) {
  int i,j,k;
  PHY_VARS_eNB *phy_vars_eNB = PHY_vars_eNB_g[0][0];
561 562 563 564 565 566 567 568 569 570 571 572
  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
573 574 575
	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;
576
      }
577
    }
578 579 580
    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;
581 582 583
  }
}

584
static void *scope_thread(void *arg) {
knopp's avatar
 
knopp committed
585
  char stats_buffer[16384];
586
# ifdef ENABLE_XFORMS_WRITE_STATS
knopp's avatar
 
knopp committed
587 588
  FILE *UE_stats, *eNB_stats;
  int len = 0;
589
# endif
knopp's avatar
 
knopp committed
590
  struct sched_param sched_param;
591

knopp's avatar
 
knopp committed
592 593
  sched_param.sched_priority = sched_get_priority_min(SCHED_FIFO)+1; 
  sched_setscheduler(0, SCHED_FIFO,&sched_param);
594

knopp's avatar
 
knopp committed
595
  printf("Scope thread has priority %d\n",sched_param.sched_priority);
596
    
597 598
# ifdef ENABLE_XFORMS_WRITE_STATS
  if (UE_flag==1) 
knopp's avatar
 
knopp committed
599
    UE_stats  = fopen("UE_stats.txt", "w");
600
  else 
knopp's avatar
 
knopp committed
601
    eNB_stats = fopen("eNB_stats.txt", "w");
602
#endif
603
    
knopp's avatar
 
knopp committed
604 605
  while (!oai_exit) {
    if (UE_flag==1) {
606
# ifdef ENABLE_XFORMS_WRITE_STATS
knopp's avatar
 
knopp committed
607
      len =
608
# endif
609
	dump_ue_stats (PHY_vars_UE_g[0][0], stats_buffer, 0, mode,rx_input_level_dBm);
knopp's avatar
 
knopp committed
610
      fl_set_object_label(form_stats->stats_text, stats_buffer);
611

knopp's avatar
 
knopp committed
612
      phy_scope_UE(form_ue[UE_id], 
613
		   PHY_vars_UE_g[UE_id][0],
knopp's avatar
 
knopp committed
614 615
		   eNB_id,
		   UE_id,7);
616
            
knopp's avatar
 
knopp committed
617
    } else {
618
# ifdef ENABLE_XFORMS_WRITE_STATS
knopp's avatar
 
knopp committed
619
      len =
620
# endif
knopp's avatar
 
knopp committed
621
	dump_eNB_l2_stats (stats_buffer, 0);
622
      fl_set_object_label(form_stats_l2->stats_text, stats_buffer);
623 624 625 626 627 628 629

# 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
630 631
      for(UE_id=0;UE_id<scope_enb_num_ue;UE_id++) {
	phy_scope_eNB(form_enb[UE_id], 
knopp's avatar
 
knopp committed
632
		      PHY_vars_eNB_g[eNB_id][0],
knopp's avatar
 
knopp committed
633 634
		      UE_id);
      }
635 636
              
    }
knopp's avatar
 
knopp committed
637
    //printf("doing forms\n");
Florian Kaltenberger's avatar
Florian Kaltenberger committed
638 639
    //usleep(100000); // 100 ms
    sleep(1);
knopp's avatar
 
knopp committed
640
  }
641 642

  printf("%s",stats_buffer);
643
    
644
# ifdef ENABLE_XFORMS_WRITE_STATS
645 646 647 648 649 650 651 652 653 654 655 656 657 658
  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);
    }
  }
659
# endif
660
    
knopp's avatar
 
knopp committed
661
  pthread_exit((void*)arg);
662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
}
#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;
687 688 689 690 691 692 693

  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);
694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715
 
  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);
    }
716 717
  else 
    printf("[EMOS] Opened GPS, gps_data=%p\n");
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
  
  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
763
	if (UE_flag==0)
764
	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
765
	else
766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826
	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

827 828


829
#if defined(ENABLE_ITTI)
830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847
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
848
#if defined(ENABLE_ITTI)
849
void *l2l1_task(void *arg)
850
{
knopp's avatar
 
knopp committed
851 852 853 854 855
  MessageDef *message_p = NULL;
  int         result;

  itti_set_task_real_time(TASK_L2L1);
  itti_mark_task_ready(TASK_L2L1);
856

knopp's avatar
 
knopp committed
857 858
  if (UE_flag == 0) {
    /* Wait for the initialize message */
859
    do {
knopp's avatar
 
knopp committed
860 861 862 863
      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);
      }
864 865 866
      itti_receive_msg (TASK_L2L1, &message_p);

      switch (ITTI_MSG_ID(message_p)) {
knopp's avatar
 
knopp committed
867 868 869 870 871 872 873 874 875 876 877 878 879 880
      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;
881
      }
knopp's avatar
 
knopp committed
882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903
    } 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;
904

knopp's avatar
 
knopp committed
905 906 907 908 909 910 911 912 913 914 915 916
    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);
917

knopp's avatar
 
knopp committed
918
  return NULL;
919 920 921
}
#endif

knopp's avatar
 
knopp committed
922

knopp's avatar
 
knopp committed
923
void do_OFDM_mod_rt(int subframe,PHY_VARS_eNB *phy_vars_eNB) {
knopp's avatar
 
knopp committed
924 925 926 927

  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
928
  int slot_sizeF = (phy_vars_eNB->lte_frame_parms.ofdm_symbol_size)*
knopp's avatar
 
knopp committed
929
    ((phy_vars_eNB->lte_frame_parms.Ncp==1) ? 6 : 7);
knopp's avatar
 
knopp committed
930 931 932

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

knopp's avatar
 
knopp committed
935 936
  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
937
    //	  LOG_D(HW,"Frame %d: Generating slot %d\n",frame,next_slot);
knopp's avatar
 
knopp committed
938

knopp's avatar
 
knopp committed
939
    
knopp's avatar
 
knopp committed
940 941 942 943 944 945 946 947 948 949
    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
950 951 952 953 954 955 956 957
	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
958 959 960 961 962 963
      }
      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
964 965 966 967
	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
968
      }
knopp's avatar
 
knopp committed
969 970

      for (i=0; i<phy_vars_eNB->lte_frame_parms.samples_per_tti; i++) {
knopp's avatar
 
knopp committed
971 972 973 974 975 976
	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
977
#ifdef EXMIMO
knopp's avatar
 
knopp committed
978
	  ((short*)dummy_tx_b)[2*i]<<4;
knopp's avatar
 
knopp committed
979
#else
knopp's avatar
knopp committed
980
	((short*)dummy_tx_b)[2*i]<<5;
knopp's avatar
 
knopp committed
981
#endif
knopp's avatar
 
knopp committed
982
	((short*)&phy_vars_eNB->lte_eNB_common_vars.txdata[0][aa][tx_offset])[1]=
knopp's avatar
 
knopp committed
983
#ifdef EXMIMO
knopp's avatar
 
knopp committed
984
	  ((short*)dummy_tx_b)[2*i+1]<<4;
knopp's avatar
 
knopp committed
985
#else
knopp's avatar
knopp committed
986
	((short*)dummy_tx_b)[2*i+1]<<5;
knopp's avatar
 
knopp committed
987
#endif
knopp's avatar
 
knopp committed
988 989 990 991 992 993 994 995
      }
    }
  }
}


int eNB_thread_tx_status[10];
static void * eNB_thread_tx(void *param) {
knopp's avatar
 
knopp committed
996 997 998

  //unsigned long cpuid;
  eNB_proc_t *proc = (eNB_proc_t*)param;
knopp's avatar
 
knopp committed
999
  //  RTIME time_in,time_out;
knopp's avatar
 
knopp committed
1000 1001
#ifdef RTAI
  RT_TASK *task;
1002
  char task_name[8];
1003 1004 1005 1006
#else 
#ifdef LOWLATENCY
  struct sched_attr attr;
  unsigned int flags = 0;
knopp's avatar
 
knopp committed
1007
#endif
1008
#endif 
knopp's avatar
 
knopp committed
1009 1010

 
knopp's avatar
 
knopp committed
1011
  /*#if defined(ENABLE_ITTI)
Florian Kaltenberger's avatar
Florian Kaltenberger committed
1012
  // Wait for eNB application initialization to be complete (eNB registration to MME)
knopp's avatar
 
knopp committed
1013
  wait_system_ready ("Waiting for eNB application to be ready %s\r", &start_eNB);
knopp's avatar
 
knopp committed
1014
  #endif*/
knopp's avatar
 
knopp committed
1015

knopp's avatar
 
knopp committed
1016
#ifdef RTAI
1017
  sprintf(task_name,"TXC%dS%d",proc->CC_id,proc->subframe);
knopp's avatar
 
knopp committed
1018 1019 1020
  task = rt_task_init_schmod(nam2num(task_name), 0, 0, 0, SCHED_FIFO, 0xF);

  if (task==NULL) {
knopp's avatar
knopp committed
1021 1022 1023
    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
1024
  else {
knopp's avatar
knopp committed
1025 1026 1027 1028 1029
    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
1030
#else
1031 1032 1033 1034 1035 1036
#ifdef LOWLATENCY
  attr.size = sizeof(attr);
  attr.sched_flags = 0;
  attr.sched_nice = 0;
  attr.sched_priority = 0;
  
nikaeinn's avatar
nikaeinn committed
1037
  /* This creates a 1ms reservation every 10ms period*/
1038 1039 1040 1041 1042 1043
  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 ){
knopp's avatar
knopp committed
1044 1045 1046
    perror("[SCHED] eNB tx thread: sched_setattr failed\n");
    exit(-1);
  }
1047
  LOG_I(HW,"[SCHED] eNB TX deadline thread %d(id %ld) started on CPU %d\n",
knopp's avatar
knopp committed
1048
	proc->subframe, gettid(),sched_getcpu());
1049 1050
#else 
  LOG_I(HW,"[SCHED] eNB TX thread %d started on CPU %d\n",
knopp's avatar
knopp committed
1051
	proc->subframe,sched_getcpu());
1052 1053
#endif

knopp's avatar
 
knopp committed
1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065
#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
1066
    
knopp's avatar
knopp committed
1067
    vcd_signal_dumper_dump_function_by_name(VCD_SIGNAL_DUMPER_FUNCTIONS_eNB_PROC_TX0+(2*proc->subframe),0);
knopp's avatar
 
knopp committed
1068
    
knopp's avatar
knopp committed
1069 1070
    //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
1071

knopp's avatar
knopp committed
1072 1073 1074 1075 1076
    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
1077
      
knopp's avatar
knopp committed
1078 1079 1080
      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
1081
	
knopp's avatar
knopp committed
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092
	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]);
1093

knopp's avatar
knopp committed
1094
    if (oai_exit) break;
knopp's avatar
 
knopp committed
1095

knopp's avatar
 
knopp committed
1096
    
knopp's avatar
knopp committed
1097 1098