ue_procedures.c 102 KB
Newer Older
1
/*
2 3 4 5 6 7 8
 * 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 the OAI Public License, Version 1.1
 * (the "License"); you may not use this file except in compliance
 * with the License.  You may obtain a copy of the License at
9 10 11 12 13 14 15 16 17 18 19 20
 *
 *      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
 */
21 22

/*! \file ue_procedures.c
23
 * \brief procedures related to UE
24 25 26
 * \author  Navid Nikaein and Raymond Knopp
 * \date 2010 - 2014
 * \version 1
27 28
 * \email: navid.nikaein@eurecom.fr
 * @ingroup _mac
29

30
 */
31

32 33 34 35
#ifdef EXMIMO
#include <pthread.h>
#endif

36 37
#include "extern.h"
#include "defs.h"
38
#include "proto.h"
39
#ifdef PHY_EMUL
Cedric Roux's avatar
Cedric Roux committed
40
# include "SIMULATION/PHY_EMULATION/impl_defs.h"
41
#else
Cedric Roux's avatar
Cedric Roux committed
42 43
# include "SCHED/defs.h"
# include "PHY/impl_defs_top.h"
44 45 46
#endif
#include "PHY_INTERFACE/extern.h"
#include "COMMON/mac_rrc_primitives.h"
Cedric Roux's avatar
Cedric Roux committed
47 48

#include "RRC/L2_INTERFACE/openair_rrc_L2_interface.h"
49 50 51
#include "RRC/LITE/extern.h"
#include "UTIL/LOG/log.h"
#include "UTIL/LOG/vcd_signal_dumper.h"
Cedric Roux's avatar
Cedric Roux committed
52
#include "UTIL/OPT/opt.h"
53 54
#include "OCG.h"
#include "OCG_extern.h"
55
#include "openair2/PHY_INTERFACE/phy_stub_UE.h"
Cedric Roux's avatar
Cedric Roux committed
56

57
#ifdef PHY_EMUL
Cedric Roux's avatar
Cedric Roux committed
58
# include "SIMULATION/simulation_defs.h"
59
#endif
60
#include "pdcp.h"
61

62 63 64 65
#if defined(ENABLE_ITTI)
# include "intertask_interface.h"
#endif

66 67
#include "assertions.h"

68 69
#include "SIMULATION/TOOLS/defs.h" // for taus

70
#define DEBUG_HEADER_PARSING 1
71
#define ENABLE_MAC_PAYLOAD_DEBUG 1
72

fnabet's avatar
fnabet committed
73 74
extern uint8_t usim_test;

75 76
extern UL_IND_t *UL_INFO;

77 78
extern uint8_t  nfapi_mode;

79 80 81 82
/*
#ifndef USER_MODE
#define msg debug_msg
#endif
83
 */
84
mapping BSR_names[] = {
85 86 87 88 89 90
  {"NONE", 0},
  {"SHORT BSR", 1},
  {"TRUNCATED BSR", 2},
  {"LONG BSR", 3},
  {"PADDING BSR", 4},
  {NULL, -1}
91 92 93
};


94 95
void ue_init_mac(module_id_t module_idP)
{
96 97
  int i;
  // default values as deined in 36.331 sec 9.2.2
98 99
  LOG_I(MAC,"[UE%d] Applying default macMainConfig\n",module_idP);
  //UE_mac_inst[module_idP].scheduling_info.macConfig=NULL;
Cedric Roux's avatar
Cedric Roux committed
100 101
  UE_mac_inst[module_idP].scheduling_info.retxBSR_Timer= RetxBSR_Timer_r12_sf10240;
  UE_mac_inst[module_idP].scheduling_info.periodicBSR_Timer=PeriodicBSR_Timer_r12_infinity;
102 103 104 105 106 107 108 109 110
  UE_mac_inst[module_idP].scheduling_info.periodicPHR_Timer = MAC_MainConfig__phr_Config__setup__periodicPHR_Timer_sf20;
  UE_mac_inst[module_idP].scheduling_info.prohibitPHR_Timer = MAC_MainConfig__phr_Config__setup__prohibitPHR_Timer_sf20;
  UE_mac_inst[module_idP].scheduling_info.PathlossChange_db = MAC_MainConfig__phr_Config__setup__dl_PathlossChange_dB1;
  UE_mac_inst[module_idP].PHR_state = MAC_MainConfig__phr_Config_PR_setup;
  UE_mac_inst[module_idP].scheduling_info.SR_COUNTER=0;
  UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer=0;
  UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer_Running=0;
  UE_mac_inst[module_idP].scheduling_info.maxHARQ_Tx=MAC_MainConfig__ul_SCH_Config__maxHARQ_Tx_n5;
  UE_mac_inst[module_idP].scheduling_info.ttiBundling=0;
fnabet's avatar
fnabet committed
111 112
  UE_mac_inst[module_idP].scheduling_info.extendedBSR_Sizes_r10=0;
  UE_mac_inst[module_idP].scheduling_info.extendedPHR_r10=0;
113 114
  UE_mac_inst[module_idP].scheduling_info.drx_config=NULL;
  UE_mac_inst[module_idP].scheduling_info.phr_config=NULL;
calvin wang's avatar
calvin wang committed
115
  // set init value 0xFFFF, make sure periodic timer and retx time counters are NOT active, after bsr transmission set the value configured by the NW.
hbilel's avatar
hbilel committed
116 117
  UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF  =  MAC_UE_BSR_TIMER_NOT_RUNNING;
  UE_mac_inst[module_idP].scheduling_info.retxBSR_SF     =  MAC_UE_BSR_TIMER_NOT_RUNNING;
118
  UE_mac_inst[module_idP].BSR_reporting_active = BSR_TRIGGER_NONE;
calvin wang's avatar
calvin wang committed
119
  
120 121 122
  UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF =  get_sf_perioidicPHR_Timer(UE_mac_inst[module_idP].scheduling_info.periodicPHR_Timer);
  UE_mac_inst[module_idP].scheduling_info.prohibitPHR_SF =  get_sf_prohibitPHR_Timer(UE_mac_inst[module_idP].scheduling_info.prohibitPHR_Timer);
  UE_mac_inst[module_idP].scheduling_info.PathlossChange_db =  get_db_dl_PathlossChange(UE_mac_inst[module_idP].scheduling_info.PathlossChange);
fnabet's avatar
fnabet committed
123
  UE_mac_inst[module_idP].PHR_reporting_active = 0;
124 125

  for (i=0; i < MAX_NUM_LCID; i++) {
Raymond Knopp's avatar
 
Raymond Knopp committed
126 127
    LOG_D(MAC,"[UE%d] Applying default logical channel config for LCGID %d\n",module_idP,i);
    UE_mac_inst[module_idP].scheduling_info.Bj[i]=-1;
128 129
    UE_mac_inst[module_idP].scheduling_info.bucket_size[i]=-1;

130
    if (i < DTCH) { // initilize all control channels lcgid to 0
131
      UE_mac_inst[module_idP].scheduling_info.LCGID[i]=0;
132
    } else { // initialize all the data channels lcgid to 1
133
      UE_mac_inst[module_idP].scheduling_info.LCGID[i]=1;
134
    }
135

fnabet's avatar
fnabet committed
136
    UE_mac_inst[module_idP].scheduling_info.LCID_status[i]=LCID_EMPTY;
hbilel's avatar
hbilel committed
137
    UE_mac_inst[module_idP].scheduling_info.LCID_buffer_remain[i] = 0;
138
  }
139

140 141
  if(nfapi_mode == 3) {
	  pthread_mutex_init(&UE_mac_inst[module_idP].UL_INFO_mutex,NULL);
142
	  UE_mac_inst[module_idP].UE_mode[0] = NOT_SYNCHED; //PRACH;
143 144 145 146 147 148 149
	  UE_mac_inst[module_idP].first_ULSCH_Tx =0;
	  UE_mac_inst[module_idP].dl_config_req = NULL;
	  UE_mac_inst[module_idP].ul_config_req = NULL;
	  UE_mac_inst[module_idP].hi_dci0_req = NULL;
	  UE_mac_inst[module_idP].tx_req = NULL;
  }

150
#ifdef CBA
151

152
  for (i=0; i <NUM_MAX_CBA_GROUP; i++) {
153
    UE_mac_inst[module_idP].cba_last_access[i]= round(uniform_rngen(1,30));
154
  }
155 156

#endif
157 158
}

Raymond Knopp's avatar
 
Raymond Knopp committed
159

160
unsigned char *parse_header(unsigned char *mac_header,
161 162 163 164 165 166 167
                            unsigned char *num_ce,
                            unsigned char *num_sdu,
                            unsigned char *rx_ces,
                            unsigned char *rx_lcids,
                            unsigned short *rx_lengths,
                            unsigned short tb_length)
{
168

fnabet's avatar
fnabet committed
169
  unsigned char not_done=1,num_ces=0,num_cont_res = 0,num_padding = 0,num_sdus=0,lcid, num_sdu_cnt;
170 171 172 173 174
  unsigned char *mac_header_ptr = mac_header;
  unsigned short length,ce_len=0;

  while (not_done==1) {

175 176 177 178 179 180 181 182 183 184 185 186 187
    if (((SCH_SUBHEADER_FIXED *)mac_header_ptr)->E == 0) {
      //      printf("E=0\n");
      not_done = 0;
    }

    lcid = ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->LCID;

    if (lcid < UE_CONT_RES) {
      //printf("[MAC][UE] header %x.%x.%x\n",mac_header_ptr[0],mac_header_ptr[1],mac_header_ptr[2]);
      if (not_done==0) {// last MAC SDU, length is implicit
        mac_header_ptr++;
        length = tb_length-(mac_header_ptr-mac_header)-ce_len;

188
        for (num_sdu_cnt=0; num_sdu_cnt < num_sdus ; num_sdu_cnt++) {
189
          length -= rx_lengths[num_sdu_cnt];
190
        }
191 192 193 194
      } else {
        if (((SCH_SUBHEADER_LONG *)mac_header_ptr)->F == 1) {
          length = ((((SCH_SUBHEADER_LONG *)mac_header_ptr)->L_MSB & 0x7f ) << 8 ) | (((SCH_SUBHEADER_LONG *)mac_header_ptr)->L_LSB & 0xff);
          mac_header_ptr += 3;
195
#ifdef DEBUG_HEADER_PARSING
196
          LOG_D(MAC,"[UE] parse long sdu, size %x \n",length);
197
#endif
198

199 200 201 202 203 204
        }  else { //if (((SCH_SUBHEADER_SHORT *)mac_header_ptr)->F == 0) {
          length = ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->L;
          mac_header_ptr += 2;
        }
      }

205
#ifdef DEBUG_HEADER_PARSING
Cedric Roux's avatar
Cedric Roux committed
206
      LOG_D(MAC,"[UE] sdu %d lcid %d length %d (offset now %ld)\n",
207
            num_sdus,lcid,length,mac_header_ptr-mac_header);
208
#endif
209 210 211 212 213
      rx_lcids[num_sdus] = lcid;
      rx_lengths[num_sdus] = length;
      num_sdus++;
    } else { // This is a control element subheader
      if (lcid == SHORT_PADDING) {
fnabet's avatar
fnabet committed
214
    	num_padding ++;
215 216 217 218 219 220
        mac_header_ptr++;
      } else {
        rx_ces[num_ces] = lcid;
        num_ces++;
        mac_header_ptr ++;

221
        if (lcid==TIMING_ADV_CMD) {
222
          ce_len++;
223
        } else if (lcid==UE_CONT_RES) {
fnabet's avatar
fnabet committed
224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240

        	// FNA: check MAC Header is one of thoses defined in Annex B of 36.321
        	// Check there is only 1 Contention Resolution
        	if (num_cont_res) {
        		LOG_W(MAC,"[UE] Msg4 Wrong received format: More than 1 Contention Resolution\n");
        		// exit parsing
        		return NULL;

        	}

        	// UE_CONT_RES shall never be the last subheader unless this is the only MAC subheader
        	if ((not_done == 0) && ((num_sdus) || (num_ces > 1) || (num_padding))) {
        		LOG_W(MAC,"[UE] Msg4 Wrong received format: Contention Resolution after num_ces=%d num_sdus=%d num_padding=%d\n",num_ces,num_sdus,num_padding);
        		// exit parsing
        		return NULL;
        	}
          num_cont_res ++;
241
          ce_len+=6;
242
        }
243
      }
244

245
#ifdef DEBUG_HEADER_PARSING
Cedric Roux's avatar
Cedric Roux committed
246
      LOG_D(MAC,"[UE] ce %d lcid %d (offset now %ld)\n",num_ces,lcid,mac_header_ptr-mac_header);
247
#endif
248
    }
249
  }
250

251 252 253 254 255 256
  *num_ce = num_ces;
  *num_sdu = num_sdus;

  return(mac_header_ptr);
}

257 258
uint32_t ue_get_SR(module_id_t module_idP,int CC_id,frame_t frameP,uint8_t eNB_id,uint16_t rnti, sub_frame_t subframe)
{
259 260 261

  // no UL-SCH resources available for this tti && UE has a valid PUCCH resources for SR configuration for this tti
  //  int MGL=6;// measurement gap length in ms
262 263 264
  int MGRP       = 0; // measurement gap repetition period in ms
  int gapOffset  = -1;
  int T          = 0;
265

266
  DevCheck(module_idP < (int)NB_UE_INST, module_idP, NB_UE_INST, 0);
267

268 269
  AssertFatal(CC_id==0,
	      "Transmission on secondary CCs is not supported yet\n");
Raymond Knopp's avatar
 
Raymond Knopp committed
270

271
  // determin the measurement gap
272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291
  if (UE_mac_inst[module_idP].measGapConfig !=NULL) {
    if (UE_mac_inst[module_idP].measGapConfig->choice.setup.gapOffset.present == MeasGapConfig__setup__gapOffset_PR_gp0) {
      MGRP= 40;
      gapOffset= UE_mac_inst[module_idP].measGapConfig->choice.setup.gapOffset.choice.gp0;
    } else if (UE_mac_inst[module_idP].measGapConfig->choice.setup.gapOffset.present == MeasGapConfig__setup__gapOffset_PR_gp1) {
      MGRP= 80;
      gapOffset= UE_mac_inst[module_idP].measGapConfig->choice.setup.gapOffset.choice.gp1;
    } else {
      LOG_W(MAC, "Measurement GAP offset is unknown\n");
    }

    T=MGRP/10;
    DevAssert( T != 0 );

    //check the measurement gap and sr prohibit timer
    if ((subframe ==  gapOffset %10) && ((frameP %T) == (floor(gapOffset/10)))
        && (UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer_Running ==0)) {
      UE_mac_inst[module_idP].scheduling_info.SR_pending=1;
      return(0);
    }
292
  }
293 294

  if ((UE_mac_inst[module_idP].physicalConfigDedicated != NULL) &&
295
      (UE_mac_inst[module_idP].scheduling_info.SR_pending==1) &&
296
      (UE_mac_inst[module_idP].scheduling_info.SR_COUNTER <
297 298
       (1<<(2+UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig->choice.setup.dsr_TransMax)))
     ) {
299
    LOG_D(MAC,"[UE %d][SR %x] Frame %d subframe %d PHY asks for SR (SR_COUNTER/dsr_TransMax %d/%d), SR_pending %d\n",
300
          module_idP,rnti,frameP,subframe,
301 302 303 304
          UE_mac_inst[module_idP].scheduling_info.SR_COUNTER,
          (1<<(2+UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig->choice.setup.dsr_TransMax)),
          UE_mac_inst[module_idP].scheduling_info.SR_pending);

305
    UE_mac_inst[module_idP].scheduling_info.SR_COUNTER++;
306

307 308 309 310
    // start the sr-prohibittimer : rel 9 and above
    if (UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer > 0) { // timer configured
      UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer--;
      UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer_Running=1;
311
    } else {
312
      UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer_Running=0;
313
    }
314 315 316 317 318 319 320 321 322 323 324 325 326

    LOG_D(MAC,"[UE %d][SR %x] Frame %d subframe %d send SR indication (SR_COUNTER/dsr_TransMax %d/%d), SR_pending %d\n",
          module_idP,rnti,frameP,subframe,
          UE_mac_inst[module_idP].scheduling_info.SR_COUNTER,
          (1<<(2+UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig->choice.setup.dsr_TransMax)),
          UE_mac_inst[module_idP].scheduling_info.SR_pending);

    //UE_mac_inst[module_idP].ul_active =1;
    return(1); //instruct phy to signal SR
  } else {
    // notify RRC to relase PUCCH/SRS
    // clear any configured dl/ul
    // initiate RA
hbilel's avatar
hbilel committed
327 328 329 330
      if (UE_mac_inst[module_idP].scheduling_info.SR_pending){
          // release all pucch resource
          UE_mac_inst[module_idP].physicalConfigDedicated = NULL;
          UE_mac_inst[module_idP].ul_active=0;
331
          UE_mac_inst[module_idP].BSR_reporting_active=BSR_TRIGGER_NONE;
hbilel's avatar
hbilel committed
332 333 334

          LOG_I(MAC,"[UE %d] Release all SRs \n", module_idP);
      }
335 336 337
    UE_mac_inst[module_idP].scheduling_info.SR_pending=0;
    UE_mac_inst[module_idP].scheduling_info.SR_COUNTER=0;
    return(0);
338 339 340
  }
}

341 342
//------------------------------------------------------------------------------
void
fnabet's avatar
fnabet committed
343 344
ue_send_sdu(
  module_id_t module_idP,
345 346
	    uint8_t CC_id,
	    frame_t frameP,
347
        sub_frame_t subframeP,
348 349
	    uint8_t* sdu,
	    uint16_t sdu_len,
fnabet's avatar
fnabet committed
350 351 352 353
  uint8_t eNB_index
)
//------------------------------------------------------------------------------
{
354 355 356 357 358

  unsigned char rx_ces[MAX_NUM_CE],num_ce,num_sdu,i,*payload_ptr;
  unsigned char rx_lcids[NB_RB_MAX];
  unsigned short rx_lengths[NB_RB_MAX];
  unsigned char *tx_sdu;
gabrielC's avatar
gabrielC committed
359
#if UE_TIMING_TRACE
360
  start_meas(&UE_mac_inst[module_idP].rx_dlsch_sdu);
gabrielC's avatar
gabrielC committed
361
#endif
362
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_SDU, VCD_FUNCTION_IN);
363 364 365

  LOG_T(MAC,"sdu: %x.%x.%x\n",sdu[0],sdu[1],sdu[2]);

366
  if (opt_enabled) {
367
    trace_pdu(1, sdu, sdu_len, module_idP, 3, UE_mac_inst[module_idP].crnti,
368
        frameP, subframeP, 0, 0);
navid's avatar
navid committed
369 370
    LOG_D(OPT,"[UE %d][DLSCH] Frame %d trace pdu for rnti %x  with size %d\n",
          module_idP, frameP, UE_mac_inst[module_idP].crnti, sdu_len);
371 372 373 374 375
  }

  payload_ptr = parse_header(sdu,&num_ce,&num_sdu,rx_ces,rx_lcids,rx_lengths,sdu_len);

#ifdef DEBUG_HEADER_PARSING
376
  LOG_D(MAC,"[UE %d] ue_send_sdu : Frame %d eNB_index %d : num_ce %d num_sdu %d\n",module_idP,
377
        frameP,eNB_index,num_ce,num_sdu);
378 379 380
#endif

#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
Cedric Roux's avatar
Cedric Roux committed
381
  LOG_T(MAC,"[UE %d] First 32 bytes of DLSCH : \n", module_idP);
382

383
  for (i=0; i<32; i++) {
384
    LOG_T(MAC,"%x.",sdu[i]);
385
  }
386

387
  LOG_T(MAC,"\n");
388 389
#endif

fnabet's avatar
fnabet committed
390 391
  if (payload_ptr != NULL) {

392 393 394 395
  for (i=0; i<num_ce; i++) {
    //    printf("ce %d : %d\n",i,rx_ces[i]);
    switch (rx_ces[i]) {
    case UE_CONT_RES:
396

397
      LOG_I(MAC,"[UE %d][RAPROC] Frame %d : received contention resolution msg: %x.%x.%x.%x.%x.%x, Terminating RA procedure\n",
398
            module_idP,frameP,payload_ptr[0],payload_ptr[1],payload_ptr[2],payload_ptr[3],payload_ptr[4],payload_ptr[5]);
399 400

      if (UE_mac_inst[module_idP].RA_active == 1) {
Cedric Roux's avatar
Cedric Roux committed
401
        LOG_I(MAC,"[UE %d][RAPROC] Frame %d : Clearing RA_active flag\n", module_idP, frameP);
402 403 404 405 406 407 408 409
        UE_mac_inst[module_idP].RA_active=0;
        // check if RA procedure has finished completely (no contention)
        tx_sdu = &UE_mac_inst[module_idP].CCCH_pdu.payload[3];

        //Note: 3 assumes sizeof(SCH_SUBHEADER_SHORT) + PADDING CE, which is when UL-Grant has TBS >= 9 (64 bits)
        // (other possibility is 1 for TBS=7 (SCH_SUBHEADER_FIXED), or 2 for TBS=8 (SCH_SUBHEADER_FIXED+PADDING or SCH_SUBHEADER_SHORT)
        for (i=0; i<6; i++)
          if (tx_sdu[i] != payload_ptr[i]) {
410 411 412 413 414 415 416 417 418 419
        	  LOG_E(MAC,"[UE %d][RAPROC] Contention detected, RA failed\n",module_idP);
        	  if(nfapi_mode == 3) { // Panos: phy_stub mode
        		  // Panos: Modification for phy_stub mode operation here. We only need to make sure that the ue_mode is back to
        		  // PRACH state.
        		  UE_mac_inst[module_idP].UE_mode[eNB_index] = PRACH;
        		  //ra_failed(module_idP,CC_id,eNB_index);UE_mac_inst[module_idP].RA_contention_resolution_timer_active = 0;
        	  }
        	  else { // Full stack mode
        		  ra_failed(module_idP,CC_id,eNB_index);
        	  }
420
            VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_SDU, VCD_FUNCTION_OUT);
421 422 423
            return;
          }

Cedric Roux's avatar
Cedric Roux committed
424
        LOG_I(MAC,"[UE %d][RAPROC] Frame %d : Clearing contention resolution timer\n", module_idP, frameP);
425
        UE_mac_inst[module_idP].RA_contention_resolution_timer_active = 0;
426

427 428 429 430 431 432 433 434
        if(nfapi_mode == 3) // phy_stub mode
        {
        	//Panos: Modification for phy_stub mode operation here. We only need to change the ue_mode to PUSCH
        	UE_mac_inst[module_idP].UE_mode[eNB_index] = PUSCH;
        }
        else { // Full stack mode
        	ra_succeeded(module_idP,CC_id,eNB_index);
        }
435 436 437 438 439 440
      }

      payload_ptr+=6;
      break;

    case TIMING_ADV_CMD:
441
#ifdef DEBUG_HEADER_PARSING
442
      LOG_D(MAC,"[UE] CE %d : UE Timing Advance : %d\n",i,payload_ptr[0]);
443
#endif
444
      // Panos: Eliminate call to process_timing_advance for the phy_stub UE operation mode. Is this correct?
445 446 447 448
      if (nfapi_mode!=3)
      {
    	  process_timing_advance(module_idP,CC_id,payload_ptr[0]);
      }
449 450 451 452
      payload_ptr++;
      break;

    case DRX_CMD:
453
#ifdef DEBUG_HEADER_PARSING
454
      LOG_D(MAC,"[UE] CE %d : UE DRX :",i);
455
#endif
456 457 458
      payload_ptr++;
      break;
    }
459
  }
460 461

  for (i=0; i<num_sdu; i++) {
462
#ifdef DEBUG_HEADER_PARSING
463
    LOG_D(MAC,"[UE] SDU %d : LCID %d, length %d\n",i,rx_lcids[i],rx_lengths[i]);
464
#endif
465
    
466 467
    if (rx_lcids[i] == CCCH) {

468 469 470 471 472 473
      LOG_D(MAC,"[UE %d] rnti %x Frame %d : DLSCH -> DL-CCCH, RRC message (eNB %d, %d bytes)\n",
            module_idP,
            UE_mac_inst[module_idP].crnti,
            frameP,
            eNB_index,
            rx_lengths[i]);
474 475

#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
476
      int j;
477

478
      for (j=0; j<rx_lengths[i]; j++) {
479
        LOG_T(MAC,"%x.",(uint8_t)payload_ptr[j]);
480
      }
481 482 483 484

      LOG_T(MAC,"\n");
#endif
      mac_rrc_data_ind(module_idP,
485
                       CC_id,
486
                       frameP,subframeP,
487
                       UE_mac_inst[module_idP].crnti,
488
                       CCCH,
489 490 491 492 493
                       (uint8_t*)payload_ptr,
                       rx_lengths[i],
                       ENB_FLAG_NO,
                       eNB_index,
                       0);
494

495
    } else if ((rx_lcids[i] == DCCH) || (rx_lcids[i] == DCCH1)) {
496
      LOG_D(MAC,"[UE %d] Frame %d : DLSCH -> DL-DCCH%d, RRC message (eNB %d, %d bytes)\n", module_idP, frameP, rx_lcids[i],eNB_index,rx_lengths[i]);
497 498
      mac_rlc_data_ind(module_idP,
                       UE_mac_inst[module_idP].crnti,
499
		       eNB_index,
500 501 502
                       frameP,
                       ENB_FLAG_NO,
                       MBMS_FLAG_NO,
503
                       rx_lcids[i],
504 505 506 507
                       (char *)payload_ptr,
                       rx_lengths[i],
                       1,
                       NULL);
508 509 510
 
    } else if ((rx_lcids[i]  < NB_RB_MAX) && (rx_lcids[i] > DCCH1 )) {
      
511
      LOG_D(MAC,"[UE %d] Frame %d : DLSCH -> DL-DTCH%d (eNB %d, %d bytes)\n", module_idP, frameP,rx_lcids[i], eNB_index,rx_lengths[i]);
512 513

#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
514
      int j;
515 516
      for (j=0;j<rx_lengths[i];j++)
	LOG_T(MAC,"%x.",(unsigned char)payload_ptr[j]);
517
      LOG_T(MAC,"\n");
518
#endif
519
      mac_rlc_data_ind(module_idP,
520
		       UE_mac_inst[module_idP].crnti,
521 522
		       eNB_index,
		       frameP,
523 524 525 526 527 528 529 530 531
		       ENB_FLAG_NO,
		       MBMS_FLAG_NO,
		       rx_lcids[i],
		       (char *)payload_ptr,
		       rx_lengths[i],
		       1,
		       NULL);
    } else {
      LOG_E(MAC,"[UE %d] Frame %d : unknown LCID %d (eNB %d)\n", module_idP, frameP,rx_lcids[i], eNB_index);
532 533
    }
    payload_ptr+= rx_lengths[i];
534
  }
fnabet's avatar
fnabet committed
535
  } // end if (payload_ptr != NULL)
536
  
537
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_SDU, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
538
#if UE_TIMING_TRACE
539
  stop_meas(&UE_mac_inst[module_idP].rx_dlsch_sdu);
gabrielC's avatar
gabrielC committed
540
#endif
541 542
}

543 544
void ue_decode_si(module_id_t module_idP,int CC_id,frame_t frameP, uint8_t eNB_index, void *pdu,uint16_t len)
{
gabrielC's avatar
gabrielC committed
545 546 547
#if UE_TIMING_TRACE
    start_meas(&UE_mac_inst[module_idP].rx_si);
#endif
548
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_DECODE_SI, VCD_FUNCTION_IN);
549

550
  LOG_D(MAC,"[UE %d] Frame %d Sending SI to RRC (LCID Id %d,len %d)\n",module_idP,frameP,BCCH,len);
551

552
  mac_rrc_data_ind(module_idP,
553
                   CC_id,
554
                   frameP,0, // unknown subframe
555
                   SI_RNTI,
556 557 558
                   BCCH,
                   (uint8_t *)pdu,
                   len,
559
                   ENB_FLAG_NO,
560 561
                   eNB_index,
                   0);
562
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_DECODE_SI, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
563
#if UE_TIMING_TRACE
564
  stop_meas(&UE_mac_inst[module_idP].rx_si);
gabrielC's avatar
gabrielC committed
565
#endif
navid's avatar
navid committed
566 567 568 569 570 571 572
  if (opt_enabled == 1) {
    trace_pdu(0,
	      (uint8_t *)pdu,
	      len,
	      module_idP,
	      4,
	      0xffff,
573 574
	      UE_mac_inst[module_idP].rxFrame,
	      UE_mac_inst[module_idP].rxSubframe,
navid's avatar
navid committed
575 576 577 578 579
	      0,
	      0);
    LOG_D(OPT,"[UE %d][BCH] Frame %d trace pdu for CC_id %d rnti %x with size %d\n",
	    module_idP, frameP, CC_id, 0xffff, len);
  }
580 581
}

582 583
void ue_decode_p(module_id_t module_idP,int CC_id,frame_t frameP, uint8_t eNB_index, void *pdu,uint16_t len)
{
gabrielC's avatar
gabrielC committed
584 585 586
#if UE_TIMING_TRACE
    start_meas(&UE_mac_inst[module_idP].rx_p);
#endif
587 588 589 590 591 592 593 594 595 596 597 598 599 600 601
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_DECODE_PCCH, VCD_FUNCTION_IN);

  LOG_D(MAC,"[UE %d] Frame %d Sending Paging message to RRC (LCID Id %d,len %d)\n",module_idP,frameP,PCCH,len);

  mac_rrc_data_ind(module_idP,
                   CC_id,
                   frameP,0, // unknown subframe
                   P_RNTI,
                   PCCH,
                   (uint8_t *)pdu,
                   len,
                   ENB_FLAG_NO,
                   eNB_index,
                   0);
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_DECODE_PCCH, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
602
#if UE_TIMING_TRACE
603
  stop_meas(&UE_mac_inst[module_idP].rx_p);
gabrielC's avatar
gabrielC committed
604
#endif
605 606 607 608 609 610 611
  if (opt_enabled == 1) {
    trace_pdu(0,
	      (uint8_t *)pdu,
	      len,
	      module_idP,
	      4,
	      P_RNTI,
612 613
	      UE_mac_inst[module_idP].rxFrame,
	      UE_mac_inst[module_idP].rxSubframe,
614 615 616 617 618 619 620
	      0,
	      0);
    LOG_D(OPT,"[UE %d][BCH] Frame %d trace pdu for CC_id %d rnti %x with size %d\n",
	    module_idP, frameP, CC_id, P_RNTI, len);
  }
}

Cedric Roux's avatar
Cedric Roux committed
621
#if defined(Rel10) || defined(Rel14)
622
unsigned char *parse_mch_header(unsigned char *mac_header,
623 624 625 626 627
                                unsigned char *num_sdu,
                                unsigned char *rx_lcids,
                                unsigned short *rx_lengths,
                                unsigned short tb_length)
{
628 629 630
  unsigned char not_done=1, num_sdus=0, lcid, i;
  unsigned char *mac_header_ptr = mac_header;
  unsigned short length;
631

632
  while (not_done == 1) {
633 634 635 636 637 638 639 640 641 642 643
    if (((SCH_SUBHEADER_FIXED *)mac_header_ptr)->E == 0) {
      not_done = 0;
    }

    lcid = ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->LCID;

    if (lcid < SHORT_PADDING) {// subheader for MSI, MCCH or MTCH
      if (not_done == 0) { // last MAC SDU, length is implicit
        mac_header_ptr++;
        length = tb_length- (mac_header_ptr - mac_header);

644
        for (i=0; i<num_sdus; i++) {
645
          length -= rx_lengths[i];
646
        }
647 648 649 650 651 652 653 654 655
      } else { // not the last MAC SDU
        if ( ((SCH_SUBHEADER_LONG *)mac_header_ptr)->F == 1) {// subheader has length of 3octets
          //    length = ((SCH_SUBHEADER_LONG *)mac_header_ptr)->L;
          length = ((((SCH_SUBHEADER_LONG *)mac_header_ptr)->L_MSB & 0x7f ) << 8 ) | (((SCH_SUBHEADER_LONG *)mac_header_ptr)->L_LSB & 0xff);
          mac_header_ptr += 3;
        } else { // subheader has length of 2octets
          length = ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->L;
          mac_header_ptr += 2;
        }
656
      }
657 658 659 660 661 662 663 664

      rx_lcids[num_sdus] = lcid;
      rx_lengths[num_sdus] = length;
      num_sdus++;
    } else { // subheader for padding
      //     if (lcid == SHORT_PADDING)
      mac_header_ptr++;
    }
665
  }
666

667 668 669 670 671
  *num_sdu = num_sdus;
  return(mac_header_ptr);
}

// this function is for sending mch_sdu from phy to mac
672 673
void ue_send_mch_sdu(module_id_t module_idP, uint8_t CC_id, frame_t frameP, uint8_t *sdu, uint16_t sdu_len, uint8_t eNB_index, uint8_t sync_area)
{
674 675

  unsigned char num_sdu, i, *payload_ptr;
676
  unsigned char rx_lcids[NB_RB_MAX];
677
  unsigned short rx_lengths[NB_RB_MAX];
gabrielC's avatar
gabrielC committed
678
#if UE_TIMING_TRACE
679
  start_meas(&UE_mac_inst[module_idP].rx_mch_sdu);
gabrielC's avatar
gabrielC committed
680
#endif
681
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_MCH_SDU, VCD_FUNCTION_IN);
682

683
  LOG_D(MAC,"[UE %d] Frame %d : process the mch PDU for sync area %d \n",module_idP,frameP, sync_area);
684 685
  LOG_D(MAC,"[UE %d] sdu: %x.%x\n", module_idP,sdu[0], sdu[1]);
  LOG_D(MAC,"[UE %d] parse_mch_header, demultiplex\n",module_idP);
686 687

  payload_ptr = parse_mch_header(sdu, &num_sdu, rx_lcids, rx_lengths, sdu_len);
688
  LOG_D(MAC,"[UE %d] parse_mch_header, found %d sdus\n",module_idP,num_sdu);
689 690

  for (i=0; i<num_sdu; i++) {
691 692 693 694 695 696 697
    if (rx_lcids[i] == MCH_SCHDL_INFO) {
      if (UE_mac_inst[module_idP].mcch_status==1) {
        LOG_I(MAC,"[UE %d] Frame %d : MCH->MSI for sync area %d (eNB %d, %d bytes)\n",module_idP,frameP, sync_area, eNB_index, rx_lengths[i]);
        // ??store necessary scheduling info to ue_mac_inst in order to
        // calculate exact position of interested service (for the complex case has >1 mtch)
        // set msi_status to 1
        UE_mac_inst[module_idP].msi_status = 1;
698
      }
699 700 701
    } else if (rx_lcids[i] == MCCH_LCHANID) {
      LOG_I(MAC,"[UE %d] Frame %d : SDU %d MCH->MCCH for sync area %d (eNB %d, %d bytes)\n",module_idP,frameP, i, sync_area, eNB_index, rx_lengths[i]);
      mac_rrc_data_ind(module_idP,
702
                       CC_id,
703
                       frameP,0, // unknown subframe
704
                       M_RNTI,
705 706 707 708 709 710 711 712
                       MCCH,
                       payload_ptr, rx_lengths[i], 0, eNB_index, sync_area);
    } else if (rx_lcids[i] == MTCH) {
      if (UE_mac_inst[module_idP].msi_status==1) {
        LOG_I(MAC,"[UE %d] Frame %d : MCH->MTCH for sync area %d (eNB %d, %d bytes)\n",module_idP,frameP, sync_area, eNB_index, rx_lengths[i]);

        mac_rlc_data_ind(
          module_idP,
713
          UE_mac_inst[module_idP].crnti,
714 715
          eNB_index,
	  frameP,
716 717 718 719 720 721 722
          ENB_FLAG_NO,
          MBMS_FLAG_YES,
          MTCH, /*+ (maxDRB + 3),*/
          (char *)payload_ptr,
          rx_lengths[i],
          1,
          NULL);
723 724

      }
725 726 727 728 729 730 731 732 733
    } else {
      LOG_W(MAC,"[UE %d] Frame %d : unknown sdu %d rx_lcids[%d]=%d mcch status %d eNB %d \n",
            module_idP,
            frameP,
            rx_lengths[i],
            i,
            rx_lcids[i],
            UE_mac_inst[module_idP].mcch_status, eNB_index);
    }
734

735
    payload_ptr += rx_lengths[i];
736 737
  }

738
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_MCH_SDU, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
739
#if UE_TIMING_TRACE
740
  stop_meas(&UE_mac_inst[module_idP].rx_mch_sdu);
gabrielC's avatar
gabrielC committed
741
#endif
742 743
}

Raymond Knopp's avatar
Raymond Knopp committed
744 745 746 747 748 749 750 751 752 753

void ue_send_sl_sdu(module_id_t module_idP,
		    uint8_t CC_id,
		    frame_t frameP,
		    sub_frame_t subframeP,
		    uint8_t* sdu,
		    uint16_t sdu_len,
		    uint8_t eNB_index
		    ) {

754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771
  int rlc_sdu_len;
  char *rlc_sdu;

  // Notes: 1. no control elements are supported yet
  //        2. we exit with error if LCID != 3
  //        3. we exit with error if E=1 (more than one SDU/CE)
  // extract header
  SLSCH_SUBHEADER_24_Bit_DST_LONG *longh = (SLSCH_SUBHEADER_24_Bit_DST_LONG *)sdu;
  AssertFatal(longh->E==0,"E is non-zero\n");
  AssertFatal(longh->LCID==3,"LCID is %d (not 3)\n",longh->LCID);
  if (longh->F==1) {
    rlc_sdu_len = ((longh->L_MSB<<8)&0x7F00)|(longh->L_LSB&0xFF);
    rlc_sdu = sdu+sizeof(SLSCH_SUBHEADER_24_Bit_DST_LONG);
  }
  else {
    rlc_sdu_len = ((SLSCH_SUBHEADER_24_Bit_DST_SHORT *)sdu)->L;
    rlc_sdu = sdu+sizeof(SLSCH_SUBHEADER_24_Bit_DST_SHORT);
  }
Raymond Knopp's avatar
Raymond Knopp committed
772 773 774 775 776 777 778 779
  mac_rlc_data_ind(
		   module_idP,
		   0x1234,
		   eNB_index,
		   frameP,
		   ENB_FLAG_NO,
		   MBMS_FLAG_NO,
		   3,
780 781
		   rlc_sdu,
		   rlc_sdu_len,
Raymond Knopp's avatar
Raymond Knopp committed
782 783 784 785 786
		   1,
		   NULL);
}


787 788
int8_t ue_get_mbsfn_sf_alloction (module_id_t module_idP, uint8_t mbsfn_sync_area, unsigned char eNB_index)
{
789
  // currently there is one-to-one mapping between sf allocation pattern and sync area
790 791
  if (mbsfn_sync_area >= MAX_MBSFN_AREA) {
    LOG_W( MAC, "[UE %"PRIu8"] MBSFN synchronization area %"PRIu8" out of range for eNB %"PRIu8"\n", module_idP, mbsfn_sync_area, eNB_index );
792
    return -1;
793
  } else if (UE_mac_inst[module_idP].mbsfn_SubframeConfig[mbsfn_sync_area] != NULL) {
794
    return mbsfn_sync_area;
795
  } else {
796
    LOG_W( MAC, "[UE %"PRIu8"] MBSFN Subframe Config pattern %"PRIu8" not found \n", module_idP, mbsfn_sync_area );
797
    return -1;
798 799
  }
}
800

801 802
int ue_query_mch(module_id_t module_idP, uint8_t CC_id, uint32_t frameP, uint32_t subframe, uint8_t eNB_index,uint8_t *sync_area, uint8_t *mcch_active)
{
803

winckel's avatar
winckel committed
804
  int i=0, j=0, ii=0, msi_pos=0, mcch_mcs = - 1;
805
  int mcch_flag=0, mtch_flag=0, msi_flag=0;
806 807
  int mbsfn_period = 0;// 1<<(UE_mac_inst[module_idP].mbsfn_SubframeConfig[0]->radioframeAllocationPeriod);
  int mcch_period = 0;// 32<<(UE_mac_inst[module_idP].mbsfn_AreaInfo[0]->mcch_Config_r9.mcch_RepetitionPeriod_r9);
winckel's avatar
winckel committed
808
  int mch_scheduling_period = -1;
809

810
  int frame_FDD=1;
811

812

gabrielC's avatar
gabrielC committed
813
#if UE_TIMING_TRACE
814
  start_meas(&UE_mac_inst[module_idP].ue_query_mch);
gabrielC's avatar
gabrielC committed
815
#endif
816

817
  if (UE_mac_inst[module_idP].pmch_Config[0]) {
818
    mch_scheduling_period = 8<<(UE_mac_inst[module_idP].pmch_Config[0]->mch_SchedulingPeriod_r9);
819
  }
820

821
  for (i=0;
822 823 824
       i< UE_mac_inst[module_idP].num_active_mbsfn_area;
       i++ ) {
    // assume, that there is always a mapping
825
    if ((j=ue_get_mbsfn_sf_alloction(module_idP,i,eNB_index)) == -1) {
826
      return -1; // continue;
827
    }
828 829 830 831 832 833

    ii=0;
    msi_pos=0;
    mbsfn_period = 1<<(UE_mac_inst[module_idP].mbsfn_SubframeConfig[0]->radioframeAllocationPeriod);
    mcch_period = 32<<(UE_mac_inst[module_idP].mbsfn_AreaInfo[0]->mcch_Config_r9.mcch_RepetitionPeriod_r9);

834
    LOG_D(MAC,
Cedric Roux's avatar
Cedric Roux committed
835
          "[UE %d] Frame %d subframe %d: Checking MBSFN Sync Area %d/%d with SF allocation %d/%d for MCCH and MTCH (mbsfn period %d, mcch period %d,mac sched period (%d,%ld))\n",
836
          module_idP,frameP, subframe,i,UE_mac_inst[module_idP].num_active_mbsfn_area,
837 838 839
          j,UE_mac_inst[module_idP].num_sf_allocation_pattern,mbsfn_period,mcch_period,
          mch_scheduling_period,UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->radioframeAllocationOffset);

840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871
    // get the real MCS value
    switch (UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.signallingMCS_r9) {
    case 0:
      mcch_mcs = 2;
      break;

    case 1:
      mcch_mcs = 7;
      break;

    case 2:
      mcch_mcs = 13;
      break;

    case 3:
      mcch_mcs = 19;
      break;
    }

    if (frameP % mbsfn_period == UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->radioframeAllocationOffset) { // MBSFN frameP
      if (UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.present == MBSFN_SubframeConfig__subframeAllocation_PR_oneFrame) { // one-frameP format

        if (UE_mac_inst[module_idP].pmch_Config[0]) {
          //  Find the first subframe in this MCH to transmit MSI
          if (frameP % mch_scheduling_period == UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->radioframeAllocationOffset ) {
            while (ii == 0) {
              ii = UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & (0x80>>msi_pos);
              msi_pos++;
            }
          }
        }

872 873
	if (UE_mac_inst[module_idP].tdd_Config == NULL) frame_FDD=1;
	else frame_FDD=0;
874 875 876
        // Check if the subframe is for MSI, MCCH or MTCHs and Set the correspoding flag to 1
        switch (subframe) {
        case 1:
877
          if (frame_FDD==1) {
878
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF1) == MBSFN_FDD_SF1) {
879
              if (msi_pos == 1) {
880
                msi_flag = 1;
881
              }
882

883
	      if ( (frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
884
                   ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF1) == MBSFN_FDD_SF1) ) {
885
                mcch_flag = 1;
886
              }
887 888 889 890 891 892 893 894

              mtch_flag = 1;
            }
          }

          break;

        case 2:
895
          if (frame_FDD==1) {
896
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF2) == MBSFN_FDD_SF2) {
897
              if (msi_pos == 2) {
898
                msi_flag = 1;
899
              }
900 901

              if ( (frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
902
                   ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF2) == MBSFN_FDD_SF2) ) {
903
                mcch_flag = 1;
904
              }
905 906 907 908

              mtch_flag = 1;
            }
          }
909

910 911 912
          break;

        case 3:
913
          if (frame_FDD==0) { //TDD
914
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF3) == MBSFN_TDD_SF3) {
915
              if (msi_pos == 1) {
916
                msi_flag = 1;
917
              }
918 919

              if ( (frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
920
                   ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_TDD_SF3) == MBSFN_TDD_SF3) ) {
921
                mcch_flag = 1;
922
              }
923 924 925 926 927

              mtch_flag = 1;
            }
          } else { // FDD
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF3) == MBSFN_FDD_SF3) {
928
              if (msi_pos == 3) {
929
                msi_flag = 1;
930
              }
931 932

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
933
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF3) == MBSFN_FDD_SF3) ) {
934
                mcch_flag = 1;
935
              }
936 937 938 939 940 941 942 943

              mtch_flag = 1;
            }
          }

          break;

        case 4:
944
          if (frame_FDD==0) {
945
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF4) == MBSFN_TDD_SF4) {
946
              if (msi_pos == 2) {
947
                msi_flag = 1;
948
              }
949 950

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
951
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_TDD_SF4) == MBSFN_TDD_SF4) ) {
952
                mcch_flag = 1;
953
              }
954 955 956 957 958 959 960 961

              mtch_flag = 1;
            }
          }

          break;

        case 6:
962
          if (frame_FDD==1) {
963
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF6) == MBSFN_FDD_SF6) {
964
              if (msi_pos == 4) {
965
                msi_flag = 1;
966
              }
967 968

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
969
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF6) == MBSFN_FDD_SF6) ) {
970
                mcch_flag = 1;
971
              }
972 973 974

              mtch_flag = 1;
            }
975
          }
976 977 978 979

          break;

        case 7:
980
          if (frame_FDD==0) { // TDD
981
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF7) == MBSFN_TDD_SF7) {
982
              if (msi_pos == 3) {
983
                msi_flag = 1;
984
              }
985 986

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
987
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_TDD_SF7) == MBSFN_TDD_SF7) ) {
988
                mcch_flag = 1;
989
              }
990 991 992 993 994

              mtch_flag = 1;
            }
          } else { // FDD
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF7) == MBSFN_FDD_SF7) {
995
              if (msi_pos == 5) {
996
                msi_flag = 1;
997
              }
998 999

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
1000
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF7) == MBSFN_FDD_SF7) ) {
1001
                mcch_flag = 1;
1002
              }
1003 1004 1005

              mtch_flag = 1;
            }
1006
          }
1007 1008 1009 1010

          break;

        case 8:
1011
          if (frame_FDD==0) { //TDD
1012
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF8) == MBSFN_TDD_SF8) {
1013
              if (msi_pos == 4) {
1014
                msi_flag = 1;
1015
              }
1016 1017

              if ( (frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
1018
                   ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_TDD_SF8) == MBSFN_TDD_SF8) ) {
1019
                mcch_flag = 1;
1020
              }
1021 1022 1023 1024 1025

              mtch_flag = 1;
            }
          } else { // FDD
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF8) == MBSFN_FDD_SF8) {
1026
              if (msi_pos == 6) {
1027
                msi_flag = 1;
1028
              }
1029 1030

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
1031
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF8) == MBSFN_FDD_SF8) ) {
1032
                mcch_flag = 1;
1033
              }
1034 1035 1036 1037 1038 1039 1040 1041

              mtch_flag = 1;
            }
          }

          break;

        case 9:
1042
          if (frame_FDD==0) {
1043
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF9) == MBSFN_TDD_SF9) {
1044
              if (msi_pos == 5) {
1045
                msi_flag = 1;
1046
              }
1047 1048

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
1049
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_TDD_SF9) == MBSFN_TDD_SF9) ) {
1050
                mcch_flag = 1;
1051
              }
1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068

              mtch_flag = 1;
            }
          }

          break;
        }// end switch

        // sf allocation is non-overlapping
        if ((msi_flag==1) || (mcch_flag==1) || (mtch_flag==1)) {
          LOG_D(MAC,"[UE %d] Frame %d Subframe %d: sync area %d SF alloc %d: msi flag %d, mcch flag %d, mtch flag %d\n",
                module_idP, frameP, subframe,i,j,msi_flag,mcch_flag,mtch_flag);

          *sync_area=i;
          break;
        }
      } else { // four-frameP format
1069
      }
1070
    }
1071
  } // end of for
gabrielC's avatar
gabrielC committed
1072
#if UE_TIMING_TRACE
1073
  stop_meas(&UE_mac_inst[module_idP].ue_query_mch);
gabrielC's avatar
gabrielC committed
1074
#endif
1075

1076
  if ( (mcch_flag==1)) { // || (msi_flag==1))
1077
    *mcch_active=1;
1078
  }
1079

1080 1081
  if ( (mcch_flag==1) || ((msi_flag==1) && (UE_mac_inst[module_idP].mcch_status==1)) ) {
    return mcch_mcs;
1082
  } else if ((mtch_flag==1) && (UE_mac_inst[module_idP].msi_status==1)) {
1083
    return UE_mac_inst[module_idP].pmch_Config[0]->dataMCS_r9;
1084
  } else {
1085
    return -1;
1086
  }
1087 1088 1089 1090
}

#endif

1091
unsigned char generate_ulsch_header(uint8_t *mac_header,
1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102
                                    uint8_t num_sdus,
                                    uint8_t short_padding,
                                    uint16_t *sdu_lengths,
                                    uint8_t *sdu_lcids,
                                    POWER_HEADROOM_CMD *power_headroom,
                                    uint16_t *crnti,
                                    BSR_SHORT *truncated_bsr,
                                    BSR_SHORT *short_bsr,
                                    BSR_LONG *long_bsr,
                                    unsigned short post_padding)
{
1103 1104 1105 1106 1107 1108 1109

  SCH_SUBHEADER_FIXED *mac_header_ptr = (SCH_SUBHEADER_FIXED *)mac_header;
  unsigned char first_element=0,last_size=0,i;
  unsigned char mac_header_control_elements[16],*ce_ptr;

  LOG_D(MAC,"[UE] Generate ULSCH : num_sdus %d\n",num_sdus);
#ifdef DEBUG_HEADER_PARSING
1110

1111
  for (i=0; i<num_sdus; i++) {
1112
    LOG_T(MAC,"[UE] sdu %d : lcid %d length %d",i,sdu_lcids[i],sdu_lengths[i]);
1113
  }
1114

1115 1116 1117 1118 1119
  LOG_T(MAC,"\n");
#endif
  ce_ptr = &mac_header_control_elements[0];

  if ((short_padding == 1) || (short_padding == 2)) {
1120 1121 1122 1123 1124
    mac_header_ptr->R    = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = SHORT_PADDING;
    first_element=1;
    last_size=1;
1125
  }
1126

1127
  if (short_padding == 2) {
1128 1129 1130 1131 1132 1133
    mac_header_ptr->E = 1;
    mac_header_ptr++;
    mac_header_ptr->R = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = SHORT_PADDING;
    last_size=1;
1134 1135 1136
  }

  if (power_headroom) {
1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149
    if (first_element>0) {
      mac_header_ptr->E = 1;
      mac_header_ptr++;
    } else {
      first_element=1;
    }

    mac_header_ptr->R = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = POWER_HEADROOM;
    last_size=1;
    *((POWER_HEADROOM_CMD *)ce_ptr)=(*power_headroom);
    ce_ptr+=sizeof(POWER_HEADROOM_CMD);
Cedric Roux's avatar
Cedric Roux committed
1150
    LOG_D(MAC, "phr header size %zu\n",sizeof(POWER_HEADROOM_CMD));
1151 1152 1153 1154
  }

  if (crnti) {
#ifdef DEBUG_HEADER_PARSING
1155
    LOG_D(MAC,"[UE] CRNTI : %x (first_element %d)\n",*crnti,first_element);
1156
#endif
1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171

    if (first_element>0) {
      mac_header_ptr->E = 1;
      mac_header_ptr++;
    } else {
      first_element=1;
    }

    mac_header_ptr->R    = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = CRNTI;
    last_size=1;
    *((uint16_t *)ce_ptr)=(*crnti);
    ce_ptr+=sizeof(uint16_t);
    //    printf("offset %d\n",ce_ptr-mac_header_control_elements);
1172 1173 1174
  }

  if (truncated_bsr) {
1175 1176 1177
    if (first_element>0) {
      mac_header_ptr->E = 1;
      /*
1178
      printf("last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
1179 1180 1181 1182 1183 1184 1185 1186 1187
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->R,
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->E,
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->LCID);
       */
      mac_header_ptr++;
    } else {
      first_element=1;
    }

1188
#ifdef DEBUG_HEADER_PARSING
1189
    LOG_D(MAC,"[UE] Scheduler Truncated BSR Header\n");
1190
#endif
1191 1192 1193 1194 1195 1196 1197
    mac_header_ptr->R = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = TRUNCATED_BSR;
    last_size=1;
    *((BSR_TRUNCATED *)ce_ptr)=(*truncated_bsr);
    ce_ptr+=sizeof(BSR_TRUNCATED);
    //    printf("(cont_res) : offset %d\n",ce_ptr-mac_header_control_elements);
1198

1199 1200 1201 1202
  } else if (short_bsr) {
    if (first_element>0) {
      mac_header_ptr->E = 1;
      /*
1203
      printf("last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
1204 1205 1206 1207 1208 1209 1210 1211 1212
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->R,
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->E,
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->LCID);
       */
      mac_header_ptr++;
    } else {
      first_element=1;
    }

1213
#ifdef DEBUG_HEADER_PARSING
1214
    LOG_D(MAC,"[UE] Scheduler SHORT BSR Header\n");
1215
#endif
1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227
    mac_header_ptr->R = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = SHORT_BSR;
    last_size=1;
    *((BSR_SHORT *)ce_ptr)=(*short_bsr);
    ce_ptr+=sizeof(BSR_SHORT);

    //    printf("(cont_res) : offset %d\n",ce_ptr-mac_header_control_elements);
  } else if (long_bsr) {
    if (first_element>0) {
      mac_header_ptr->E = 1;
      /*
1228
      printf("last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
1229 1230 1231 1232 1233 1234 1235 1236 1237
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->R,
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->E,
      ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->LCID);
       */
      mac_header_ptr++;
    } else {
      first_element=1;
    }

1238
#ifdef DEBUG_HEADER_PARSING
1239
    LOG_D(MAC,"[UE] Scheduler Long BSR Header\n");
1240
#endif
1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251
    mac_header_ptr->R = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = LONG_BSR;
    last_size=1;

    *(ce_ptr)     = (long_bsr->Buffer_size0 << 2) | ((long_bsr->Buffer_size1 & 0x30) >> 4);
    *(ce_ptr + 1) = ((long_bsr->Buffer_size1 & 0x0F) << 4) | ((long_bsr->Buffer_size2 & 0x3C) >> 2);
    *(ce_ptr + 2) = ((long_bsr->Buffer_size2 & 0x03) << 2) | (long_bsr->Buffer_size3 & 0x3F);
    ce_ptr += BSR_LONG_SIZE;

    //    printf("(cont_res) : offset %d\n",ce_ptr-mac_header_control_elements);
1252
  }
1253

1254 1255
  //  printf("last_size %d,mac_header_ptr %p\n",last_size,mac_header_ptr);

1256
  for (i=0; i<num_sdus; i++) {
1257
#ifdef DEBUG_HEADER_PARSING
1258
    LOG_T(MAC,"[UE] sdu subheader %d (lcid %d, %d bytes)\n",i,sdu_lcids[i],sdu_lengths[i]);
1259
#endif
1260

1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274
    if ((i == (num_sdus - 1)) && ((short_padding) || (post_padding == 0))) {
        if (first_element>0) {
            mac_header_ptr->E = 1;
      #ifdef DEBUG_HEADER_PARSING
            LOG_D(MAC,"[UE] last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
                  ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->R,
                  ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->E,
                  ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->LCID);
      #endif
            mac_header_ptr+=last_size;
        }
        mac_header_ptr->R    = 0;
        mac_header_ptr->E    = 0;
        mac_header_ptr->LCID = sdu_lcids[i];
1275
    }
1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288
    else {
        if ((first_element>0)) {
          mac_header_ptr->E = 1;
    #ifdef DEBUG_HEADER_PARSING
          LOG_D(MAC,"[UE] last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
                ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->R,
                ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->E,
                ((SCH_SUBHEADER_FIXED *)mac_header_ptr)->LCID);
    #endif
          mac_header_ptr+=last_size;
          //      printf("last_size %d,mac_header_ptr %p\n",last_size,mac_header_ptr);
        } else {
          first_element=1;
1289

1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
        }

        if (sdu_lengths[i] < 128) {
          ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->R    = 0; // 3
          ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->E    = 0;
          ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->F    = 0;
          ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->LCID = sdu_lcids[i];
          ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->L    = (unsigned char)sdu_lengths[i];
          last_size=2;
    #ifdef DEBUG_HEADER_PARSING
          LOG_D(MAC,"[UE] short sdu\n");
          LOG_T(MAC,"[UE] last subheader : %x (R%d,E%d,LCID%d,F%d,L%d)\n",
                ((uint16_t*)mac_header_ptr)[0],
                ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->R,
                ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->E,
                ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->LCID,
                ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->F,
                ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->L);
    #endif
        } else {
          ((SCH_SUBHEADER_LONG *)mac_header_ptr)->R    = 0;
          ((SCH_SUBHEADER_LONG *)mac_header_ptr)->E    = 0;
          ((SCH_SUBHEADER_LONG *)mac_header_ptr)->F    = 1;
          ((SCH_SUBHEADER_LONG *)mac_header_ptr)->LCID = sdu_lcids[i];
          ((SCH_SUBHEADER_LONG *)mac_header_ptr)->L_MSB    = ((unsigned short) sdu_lengths[i]>>8)&0x7f;
          ((SCH_SUBHEADER_LONG *)mac_header_ptr)->L_LSB    = (unsigned short) sdu_lengths[i]&0xff;
          ((SCH_SUBHEADER_LONG *)mac_header_ptr)->padding  = 0x00;
          last_size=3;
    #ifdef DEBUG_HEADER_PARSING
          LOG_D(MAC,"[UE] long sdu\n");
    #endif
        }
1322
    }
1323
  }
1324

1325
  if (post_padding>0) {// we have lots of padding at the end of the packet
1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336
    mac_header_ptr->E = 1;
    mac_header_ptr+=last_size;
    // add a padding element
    mac_header_ptr->R    = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = SHORT_PADDING;
    mac_header_ptr++;
  } else { // no end of packet padding
    // last SDU subhead is of fixed type (sdu length implicitly to be computed at UE)
    mac_header_ptr++;
    //mac_header_ptr=last_size; // FIXME: should be ++
1337
  }
1338

1339

1340
  if ((ce_ptr-mac_header_control_elements) > 0) {
1341 1342
    memcpy((void*)mac_header_ptr,mac_header_control_elements,ce_ptr-mac_header_control_elements);
    mac_header_ptr+=(unsigned char)(ce_ptr-mac_header_control_elements);
1343
  }
1344

1345
#ifdef DEBUG_HEADER_PARSING
Cedric Roux's avatar
Cedric Roux committed
1346
  LOG_T(MAC," [UE] header : ");
1347

1348
  for (i=0; i<((unsigned char*)mac_header_ptr - mac_header); i++) {
1349
    LOG_T(MAC,"%2x.",mac_header[i]);
1350
  }
1351

1352 1353 1354 1355 1356 1357
  LOG_T(MAC,"\n");
#endif
  return((unsigned char*)mac_header_ptr - mac_header);

}

1358 1359
void ue_get_sdu(module_id_t module_idP,int CC_id,frame_t frameP,sub_frame_t subframe, uint8_t eNB_index,uint8_t *ulsch_buffer,uint16_t buflen, uint8_t *access_mode)
{
1360

hbilel's avatar
hbilel committed
1361 1362
  uint8_t total_rlc_pdu_header_len=0, rlc_pdu_header_len_last=0 ;
  uint16_t buflen_remain = 0;
1363
  uint8_t bsr_len=0,bsr_ce_len=0,bsr_header_len=0;
1364
  uint8_t phr_header_len=0, phr_ce_len=0,phr_len=0;
1365
  uint8_t lcid=0,lcid_rlc_pdu_count=0;
hbilel's avatar
hbilel committed
1366
  boolean_t is_lcid_processed = FALSE;
1367
  boolean_t is_all_lcid_processed = FALSE;
1368 1369 1370 1371 1372
  uint16_t sdu_lengths[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
  uint8_t sdu_lcids[8]    = { 0, 0, 0, 0, 0, 0, 0, 0 };
  uint8_t payload_offset=0,num_sdus=0;
  uint8_t ulsch_buff[MAX_ULSCH_PAYLOAD_BYTES];
  uint16_t sdu_length_total=0;
calvin wang's avatar
calvin wang committed
1373
  BSR_SHORT bsr_short,bsr_truncated;
1374 1375 1376
  BSR_LONG bsr_long;
  BSR_SHORT *bsr_s=&bsr_short;
  BSR_LONG  *bsr_l=&bsr_long;
calvin wang's avatar
calvin wang committed
1377
  BSR_SHORT *bsr_t=&bsr_truncated;
1378 1379
  POWER_HEADROOM_CMD phr;
  POWER_HEADROOM_CMD *phr_p=&phr;
fnabet's avatar
fnabet committed
1380
  unsigned short short_padding=0, post_padding=0, padding_len=0;
1381 1382
  int j; // used for padding
  // Compute header length
hbilel's avatar
hbilel committed
1383
  int lcg_id = 0;
1384 1385
  int lcg_id_bsr_trunc = 0;
  int highest_priority = 16;
hbilel's avatar
hbilel committed
1386
  int num_lcg_id_with_data = 0;
1387
  rlc_buffer_occupancy_t lcid_buffer_occupancy_old=0, lcid_buffer_occupancy_new=0;
1388
  
hbilel's avatar
hbilel committed
1389 1390
  LOG_D(MAC,"[UE %d] MAC PROCESS UL TRANSPORT BLOCK at frame%d subframe %d TBS=%d\n",
                        module_idP, frameP, subframe, buflen);
1391

1392

1393 1394
  AssertFatal(CC_id==0,
	      "Transmission on secondary CCs is not supported yet\n");
1395

gabrielC's avatar
gabrielC committed
1396
#if UE_TIMING_TRACE
1397
  start_meas(&UE_mac_inst[module_idP].tx_ulsch_sdu);
gabrielC's avatar
gabrielC committed
1398
#endif
1399
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_GET_SDU, VCD_FUNCTION_IN);
1400

Cedric Roux's avatar
Cedric Roux committed
1401
#ifdef CBA
1402 1403 1404

  if (*access_mode==CBA_ACCESS) {
    LOG_D(MAC,"[UE %d] frameP %d subframe %d try CBA transmission\n",
1405
          module_idP, frameP, subframe);
1406 1407 1408 1409

    //if (UE_mac_inst[module_idP].scheduling_info.LCID_status[DTCH] == LCID_EMPTY)
    if (cba_access(module_idP,frameP,subframe,eNB_index,buflen)==0) {
      *access_mode=POSTPONED_ACCESS;
1410
      VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_GET_SDU, VCD_FUNCTION_OUT);
1411 1412 1413 1414
      return;
    }

    LOG_I(MAC,"[UE %d] frameP %d subframe %d CBA transmission oppurtunity, tbs %d\n",
1415
          module_idP, frameP, subframe,buflen);
1416
  }
1417

1418
#endif
hbilel's avatar
hbilel committed
1419
  bsr_header_len = 0;
1420
  phr_header_len = 1;//sizeof(SCH_SUBHEADER_FIXED);
1421

hbilel's avatar
hbilel committed
1422 1423 1424 1425 1426 1427 1428 1429
  while (lcg_id < MAX_NUM_LCGID) {
     if  (UE_mac_inst[module_idP].scheduling_info.BSR_bytes[lcg_id]){
         num_lcg_id_with_data ++;
     }
     lcg_id ++;
  }

  if (num_lcg_id_with_data){
GabrirelCouturier's avatar
GabrirelCouturier committed
1430 1431 1432 1433 1434 1435 1436 1437 1438 1439
      LOG_D(MAC,"[UE %d] MAC Tx data pending at frame%d subframe %d nb LCG =%d Bytes for LCG0=%d LCG1=%d LCG2=%d LCG3=%d BSR Trigger status =%d TBS=%d\n",
                            module_idP,
                            frameP,
                            subframe,
                            num_lcg_id_with_data,
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[0],
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[1],
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[2],
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[3],
                            UE_mac_inst[module_idP].BSR_reporting_active, buflen);
hbilel's avatar
hbilel committed
1440 1441

  }
GabrirelCouturier's avatar
GabrirelCouturier committed
1442 1443 1444
  //Restart ReTxBSR Timer at new grant indication (36.321)
  if (UE_mac_inst[module_idP].scheduling_info.retxBSR_SF != MAC_UE_BSR_TIMER_NOT_RUNNING){
      UE_mac_inst[module_idP].scheduling_info.retxBSR_SF = get_sf_retxBSRTimer(UE_mac_inst[module_idP].scheduling_info.retxBSR_Timer);
hbilel's avatar
hbilel committed
1445
  }
GabrirelCouturier's avatar
GabrirelCouturier committed
1446

hbilel's avatar
hbilel committed
1447
  // periodicBSR-Timer expires, trigger BSR
Cedric Roux's avatar
Cedric Roux committed
1448
  if ((UE_mac_inst[module_idP].scheduling_info.periodicBSR_Timer != PeriodicBSR_Timer_r12_infinity)
hbilel's avatar
hbilel committed
1449
            && (UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF == 0)){
1450 1451
        // Trigger BSR Periodic
      UE_mac_inst[module_idP].BSR_reporting_active |= BSR_TRIGGER_PERIODIC;
hbilel's avatar
hbilel committed
1452

1453
      LOG_D(MAC,"[UE %d] MAC BSR Triggered PeriodicBSR Timer expiry at frame%d subframe %d TBS=%d\n",
hbilel's avatar
hbilel committed
1454 1455 1456 1457
                       module_idP, frameP, subframe, buflen);

    }

1458 1459
  //Compute BSR Length if Regular or Periodic BSR is triggered
  //WARNING: if BSR long is computed, it may be changed to BSR short during or after multiplexing if there remains less than 1 LCGROUP with data after Tx
hbilel's avatar
hbilel committed
1460
  if (UE_mac_inst[module_idP].BSR_reporting_active){
GabrirelCouturier's avatar
GabrirelCouturier committed
1461

1462 1463
	  AssertFatal ((UE_mac_inst[module_idP].BSR_reporting_active & BSR_TRIGGER_PADDING) == 0 , "Inconsistent BSR Trigger=%d !\n",
			  UE_mac_inst[module_idP].BSR_reporting_active);
GabrirelCouturier's avatar
GabrirelCouturier committed
1464

1465 1466 1467 1468 1469
      if (buflen >= 4){
    	  //A Regular or Periodic BSR can only be sent if TBS >= 4 as transmitting only a BSR is not allowed if UE has data to transmit
    	  bsr_header_len = 1;

          if (num_lcg_id_with_data <= 1){
hbilel's avatar
hbilel committed
1470 1471 1472
              bsr_ce_len = sizeof(BSR_SHORT); //1 byte
          }
          else{
fnabet's avatar
fnabet committed
1473
              bsr_ce_len = BSR_LONG_SIZE; //3 bytes
hbilel's avatar
hbilel committed
1474 1475 1476 1477
          }
      }
  }

1478
  bsr_len = bsr_ce_len + bsr_header_len;
1479

fnabet's avatar
fnabet committed
1480
  phr_ce_len = (UE_mac_inst[module_idP].PHR_reporting_active == 1) ? 1 /* sizeof(POWER_HEADROOM_CMD)*/: 0;
1481
  if ((phr_ce_len > 0) && ((phr_ce_len + phr_header_len + bsr_len) <= buflen)){
1482 1483
    phr_len = phr_ce_len + phr_header_len;
    LOG_D(MAC,"[UE %d] header size info: PHR len %d (ce%d,hdr%d) buff_len %d\n",
1484
          module_idP, phr_len, phr_ce_len, phr_header_len, buflen);
1485
  } else {
1486
    phr_len=0;
1487 1488
    phr_header_len = 0;
    phr_ce_len = 0;
1489
  }
1490 1491

  // check for UL bandwidth requests and add SR control element
1492 1493

  // check for UL bandwidth requests and add SR control element
1494 1495

  // Check for DCCH first
1496 1497
// TO DO: Multiplex in the order defined by the logical channel prioritization
for (lcid=DCCH; (lcid < MAX_NUM_LCID) && (is_all_lcid_processed == FALSE) ; lcid++) {
hbilel's avatar
hbilel committed
1498
  if (UE_mac_inst[module_idP].scheduling_info.LCID_status[lcid] == LCID_NOT_EMPTY) {
1499

1500
      lcid_rlc_pdu_count = 0;
1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
      is_lcid_processed	= FALSE;
      lcid_buffer_occupancy_old = mac_rlc_get_buffer_occupancy_ind(module_idP,
              	  	  	  	  	  	  	  	  	  	  	  	  	  UE_mac_inst[module_idP].crnti,
																  eNB_index,
																  frameP,
																  subframe,
																  ENB_FLAG_NO,
																  lcid);

      lcid_buffer_occupancy_new = lcid_buffer_occupancy_old;

      AssertFatal (lcid_buffer_occupancy_new == UE_mac_inst[module_idP].scheduling_info.LCID_buffer_remain[lcid], "LCID=%d RLC has BO %d bytes but MAC has stored %d bytes\n",
      					lcid,lcid_buffer_occupancy_new,UE_mac_inst[module_idP].scheduling_info.LCID_buffer_remain[lcid]);

      AssertFatal (lcid_buffer_occupancy_new <= UE_mac_inst[module_idP].scheduling_info.BSR_bytes[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]], "LCID=%d RLC has more BO %d bytes than BSR = %d bytes\n",
      					lcid,lcid_buffer_occupancy_new,UE_mac_inst[module_idP].scheduling_info.BSR_bytes[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]]);

1518

hbilel's avatar
hbilel committed
1519 1520
      //Multiplex all available DCCH RLC PDUs considering to multiplex the last PDU each time for maximize the data
      //Adjust at the end of the loop
1521
      while ((!is_lcid_processed) && (lcid_buffer_occupancy_new) && (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + MIN_MAC_HDR_RLC_SIZE <= buflen)) {
1522

fnabet's avatar
fnabet committed
1523 1524 1525 1526 1527 1528 1529
    	  // Workaround for issue in OAI eNB or EPC which are not able to process SRB2 message multiplexed with SRB1 on the same MAC PDU
    	  if ((usim_test == 0) && (lcid == DCCH1) && (lcid_rlc_pdu_count == 0) && (num_sdus)) {

    		  // Skip SRB2 multiplex if at least one SRB1 SDU is already multiplexed
    		  break;
    	  }

1530
          buflen_remain = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + 1);
hbilel's avatar
hbilel committed
1531 1532


1533 1534 1535 1536 1537 1538
		  LOG_D(MAC, "[UE %d] Frame %d : UL-DXCH -> ULSCH, RLC %d has %d bytes to "
				"send (Transport Block size %d BSR size=%d PHR=%d SDU Length Total %d , mac header len %d BSR byte before Tx=%d)\n",
				module_idP,frameP, lcid,lcid_buffer_occupancy_new,buflen,bsr_len,phr_len,sdu_length_total,total_rlc_pdu_header_len,UE_mac_inst[module_idP].scheduling_info.BSR_bytes[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]]);


		  sdu_lengths[num_sdus] = mac_rlc_data_req(module_idP,
1539 1540 1541 1542 1543 1544 1545 1546
							   UE_mac_inst[module_idP].crnti,
							   eNB_index,
							   frameP,
							   ENB_FLAG_NO,
							   MBMS_FLAG_NO,
							   lcid,
							   buflen_remain,
							   (char *)&ulsch_buff[sdu_length_total]);
1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600


		  AssertFatal (buflen_remain >= sdu_lengths[num_sdus], "LCID=%d RLC has segmented %d bytes but MAC has max=%d\n",
					lcid,sdu_lengths[num_sdus],buflen_remain);


		  if (sdu_lengths[num_sdus])
		  {
			  sdu_length_total += sdu_lengths[num_sdus];
			  sdu_lcids[num_sdus] = lcid;
			  LOG_D(MAC,"[UE %d] TX Multiplex RLC PDU TX Got %d bytes for LcId%d\n",module_idP,sdu_lengths[num_sdus],lcid);

			  if (buflen == (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + 1)) {
				  //No more remaining TBS after this PDU
				  //exit the function
				  rlc_pdu_header_len_last = 1;
				  is_lcid_processed = TRUE;
				  is_all_lcid_processed = TRUE;
			  }
			  else {
				  rlc_pdu_header_len_last = (sdu_lengths[num_sdus] > 128 ) ? 3 : 2 ;

				  //Change to 1 byte if it does not fit in the TBS, ie last PDU
				  if (buflen <= (bsr_len + phr_len + total_rlc_pdu_header_len + rlc_pdu_header_len_last + sdu_length_total)) {
					  rlc_pdu_header_len_last = 1;
					  is_lcid_processed = TRUE;
					  is_all_lcid_processed = TRUE;
				  }
			  }

			  //Update number of SDU
			  num_sdus ++;

			  //Update total MAC Header size for RLC PDUs and save last one
			  total_rlc_pdu_header_len += rlc_pdu_header_len_last;

			  lcid_rlc_pdu_count ++;
		  }
		  else
		  {
			  /* avoid infinite loop ... */
			  is_lcid_processed = TRUE;
		  }

          /* Get updated BO after multiplexing this PDU */
          lcid_buffer_occupancy_new = mac_rlc_get_buffer_occupancy_ind(module_idP,
                        	  	  	  	  	  	  	  	  	  	  	  	  	  UE_mac_inst[module_idP].crnti,
          																  eNB_index,
          																  frameP,
          																  subframe,
          																  ENB_FLAG_NO,
          																  lcid);

          is_lcid_processed = (is_lcid_processed) || (lcid_buffer_occupancy_new <= 0);
1601
   }
1602

1603
    //Update Buffer remain and BSR bytes after transmission
1604

1605 1606
    AssertFatal (lcid_buffer_occupancy_new <=  lcid_buffer_occupancy_old, "MAC UE Tx error : Buffer Occupancy After Tx=%d greater than before=%d BO! for LCID=%d RLC PDU nb=%d Frame %d Subrame %d\n",
    		lcid_buffer_occupancy_new,lcid_buffer_occupancy_old,lcid,lcid_rlc_pdu_count,frameP,subframe);
1607

1608 1609
    UE_mac_inst[module_idP].scheduling_info.LCID_buffer_remain[lcid] = lcid_buffer_occupancy_new;
    UE_mac_inst[module_idP].scheduling_info.BSR_bytes[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]] += (lcid_buffer_occupancy_new - lcid_buffer_occupancy_old);
1610

1611 1612 1613 1614 1615 1616
    //Update the number of LCGID with data as BSR shall reflect status after BSR transmission
    if ((num_lcg_id_with_data > 1) && (UE_mac_inst[module_idP].scheduling_info.BSR_bytes[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]] == 0))
    {
        num_lcg_id_with_data --;
        // Change BSR size to BSR SHORT if num_lcg_id_with_data becomes to 1
        if ((bsr_len) && (num_lcg_id_with_data == 1))
hbilel's avatar
hbilel committed
1617
        {
1618 1619
            bsr_ce_len = sizeof(BSR_SHORT);
            bsr_len = bsr_ce_len + bsr_header_len;
hbilel's avatar
hbilel committed
1620
        }
1621
    }
hbilel's avatar
hbilel committed
1622 1623


1624 1625
    UE_mac_inst[module_idP].scheduling_info.LCID_status[lcid] = LCID_EMPTY;
   }
hbilel's avatar
hbilel committed
1626 1627
 }

fnabet's avatar
fnabet committed
1628

1629

1630 1631 1632
  // Compute BSR Values and update Nb LCGID with data after multiplexing
  num_lcg_id_with_data = 0;
  lcg_id_bsr_trunc = 0;
hbilel's avatar
hbilel committed
1633 1634
  for (lcg_id=0;lcg_id<MAX_NUM_LCGID;lcg_id++){
      UE_mac_inst[module_idP].scheduling_info.BSR[lcg_id] = locate_BsrIndexByBufferSize(BSR_TABLE, BSR_TABLE_SIZE, UE_mac_inst[module_idP].scheduling_info.BSR_bytes[lcg_id]);
1635 1636 1637 1638 1639

      if  (UE_mac_inst[module_idP].scheduling_info.BSR_bytes[lcg_id]){
          num_lcg_id_with_data ++;
          lcg_id_bsr_trunc = lcg_id;
      }
1640
  }
hbilel's avatar
hbilel committed
1641

1642

GabrirelCouturier's avatar
GabrirelCouturier committed
1643 1644
  if (bsr_ce_len) {
      //Print updated BSR when sent
hbilel's avatar
hbilel committed
1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656
      LOG_D(MAC,"[UE %d] Remaining Buffer after Tx frame%d subframe %d nb LCG =%d Bytes for LCG0=%d LCG1=%d LCG2=%d LCG3=%d BSR Trigger status =%d TBS=%d\n",
                            module_idP,
                            frameP,
                            subframe,
                            num_lcg_id_with_data,
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[0],
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[1],
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[2],
                            UE_mac_inst[module_idP].scheduling_info.BSR_bytes[3],
                            UE_mac_inst[module_idP].BSR_reporting_active, buflen);

      LOG_D(MAC,"[UE %d] Frame %d Subframe %d TX BSR Regular or Periodic size=%d BSR0=%d BSR1=%d BSR2=%d BSR3=%d\n",module_idP,frameP,subframe,bsr_ce_len,
GabrirelCouturier's avatar
GabrirelCouturier committed
1657 1658 1659 1660
              UE_mac_inst[module_idP].scheduling_info.BSR[0],
              UE_mac_inst[module_idP].scheduling_info.BSR[1],
              UE_mac_inst[module_idP].scheduling_info.BSR[2],
              UE_mac_inst[module_idP].scheduling_info.BSR[3]);
1661 1662 1663
  }


1664
  // build PHR and update the timers
1665
  if (phr_ce_len == sizeof(POWER_HEADROOM_CMD)) {
1666 1667 1668 1669 1670 1671 1672 1673
	  if (nfapi_mode == 3){ //phy_stub mode
		  //Panos: Substitute with a static value for the MAC layer abstraction (phy_stub mode)
		  phr_p->PH = 40;
	  }
	  else { // Full stack mode
		  phr_p->PH = get_phr_mapping(module_idP,CC_id,eNB_index);
	  }

Raymond Knopp's avatar
 
Raymond Knopp committed
1674 1675
    phr_p->R  = 0;
    LOG_D(MAC,"[UE %d] Frame %d report PHR with mapping (%d->%d) for LCID %d\n",
1676
          module_idP,frameP, get_PHR(module_idP,CC_id,eNB_index), phr_p->PH,POWER_HEADROOM);
Raymond Knopp's avatar
 
Raymond Knopp committed
1677
    update_phr(module_idP,CC_id);
1678
  } else {
1679
    phr_p=NULL;
1680
  }
1681

1682

1683
  LOG_T(MAC,"[UE %d] Frame %d: bsr s %p bsr_l %p, phr_p %p\n",  module_idP,frameP,bsr_s, bsr_l, phr_p);
1684

1685

1686
  // Check BSR padding: it is done after PHR according to Logical Channel Prioritization order
hbilel's avatar
hbilel committed
1687
  // Check for max padding size, ie MAC Hdr for last RLC PDU = 1
1688 1689 1690 1691 1692 1693
  /* For Padding BSR:
     -	if the number of padding bits is equal to or larger than the size of the Short BSR plus its subheader but smaller than the size of the Long BSR plus its subheader:
         -	if more than one LCG has data available for transmission in the TTI where the BSR is transmitted: report Truncated BSR of the LCG with the highest priority logical channel with data available for transmission;
         -	else report Short BSR.
     -	else if the number of padding bits is equal to or larger than the size of the Long BSR plus its subheader, report Long BSR.
   */
hbilel's avatar
hbilel committed
1694
  if (sdu_length_total) {
1695
      padding_len = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len - rlc_pdu_header_len_last + sdu_length_total + 1);
1696
  }
hbilel's avatar
hbilel committed
1697 1698 1699 1700
  else {
      padding_len = buflen - (bsr_len + phr_len);
  }

1701

1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757
   if ((padding_len) && (bsr_len == 0))
   {
	   /* if the number of padding bits is equal to or larger than the size of the Long BSR plus its subheader, report Long BSR*/
     if (padding_len >= (1+BSR_LONG_SIZE))
     {
    	 bsr_ce_len = BSR_LONG_SIZE;
    	 bsr_header_len = 1;
         // Trigger BSR Padding
       UE_mac_inst[module_idP].BSR_reporting_active |= BSR_TRIGGER_PADDING;


     } else if (padding_len >= (1+sizeof(BSR_SHORT))) {
    	 bsr_ce_len = sizeof(BSR_SHORT);
    	 bsr_header_len = 1;

    	 if (num_lcg_id_with_data > 1)
    	 {
    	  // REPORT TRUNCATED BSR
       	  //Get LCGID of highest priority LCID with data
    		 for (lcid=DCCH; lcid < MAX_NUM_LCID ; lcid++) {
    			 if (UE_mac_inst[module_idP].logicalChannelConfig[lcid] != NULL) {
        			 lcg_id = UE_mac_inst[module_idP].scheduling_info.LCGID[lcid];

        			 if ((lcg_id < MAX_NUM_LCGID) && (UE_mac_inst[module_idP].scheduling_info.BSR_bytes[lcg_id])
        					 && (UE_mac_inst[module_idP].logicalChannelConfig[lcid]->ul_SpecificParameters->priority <= highest_priority)) {
        				 highest_priority = UE_mac_inst[module_idP].logicalChannelConfig[lcid]->ul_SpecificParameters->priority;
        				 lcg_id_bsr_trunc = lcg_id;
        			 }
    			 }
    		 }
    	 }
    	 else
    	 {
    		 //Report SHORT BSR, clear bsr_t
    		 bsr_t = NULL;
    	 }

       // Trigger BSR Padding
       UE_mac_inst[module_idP].BSR_reporting_active |= BSR_TRIGGER_PADDING;
     }
 	 bsr_len = bsr_header_len + bsr_ce_len;
   }

   //Fill BSR Infos
   if (bsr_ce_len == 0 ) {
     bsr_s = NULL;
     bsr_l = NULL;
     bsr_t = NULL;
   } else if (bsr_ce_len == BSR_LONG_SIZE) {
     bsr_s = NULL;
     bsr_t = NULL;
     bsr_l->Buffer_size0 = UE_mac_inst[module_idP].scheduling_info.BSR[LCGID0];
     bsr_l->Buffer_size1 = UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1];
     bsr_l->Buffer_size2 = UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2];
     bsr_l->Buffer_size3 = UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3];

hbilel's avatar
hbilel committed
1758
     LOG_D(MAC, "[UE %d] Frame %d subframe %d BSR Trig=%d report long BSR (level LCGID0 %d,level LCGID1 %d,level LCGID2 %d,level LCGID3 %d)\n", module_idP,frameP,subframe,
1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772
    	   UE_mac_inst[module_idP].BSR_reporting_active,
           UE_mac_inst[module_idP].scheduling_info.BSR[LCGID0],
           UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1],
           UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2],
           UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3]);

   } else if (bsr_ce_len == sizeof(BSR_SHORT)) {
     bsr_l = NULL;
     if ((bsr_t != NULL) && (UE_mac_inst[module_idP].BSR_reporting_active & BSR_TRIGGER_PADDING)) {
    	 //Truncated BSR
    	 bsr_s = NULL;
    	 bsr_t->LCGID = lcg_id_bsr_trunc;
    	 bsr_t->Buffer_size = UE_mac_inst[module_idP].scheduling_info.BSR[lcg_id_bsr_trunc];

hbilel's avatar
hbilel committed
1773
         LOG_D(MAC,"[UE %d] Frame %d subframe %d BSR Trig=%d report TRUNCATED BSR with level %d for LCGID %d\n",
hbilel's avatar
hbilel committed
1774
               module_idP, frameP, subframe, UE_mac_inst[module_idP].BSR_reporting_active, UE_mac_inst[module_idP].scheduling_info.BSR[lcg_id_bsr_trunc],lcg_id_bsr_trunc);
1775 1776 1777 1778 1779 1780 1781 1782

     }
     else
     {
    	 bsr_t = NULL;
         bsr_s->LCGID = lcg_id_bsr_trunc;
         bsr_s->Buffer_size = UE_mac_inst[module_idP].scheduling_info.BSR[lcg_id_bsr_trunc];

hbilel's avatar
hbilel committed
1783
         LOG_D(MAC,"[UE %d] Frame %d subframe %d BSR Trig=%d report SHORT BSR with level %d for LCGID %d\n",
hbilel's avatar
hbilel committed
1784
               module_idP, frameP, subframe, UE_mac_inst[module_idP].BSR_reporting_active, UE_mac_inst[module_idP].scheduling_info.BSR[lcg_id_bsr_trunc],lcg_id_bsr_trunc);
1785 1786 1787
     }
   }

hbilel's avatar
hbilel committed
1788 1789 1790
// 1-bit padding or 2-bit padding  special padding subheader
// Check for max padding size, ie MAC Hdr for last RLC PDU = 1
   if (sdu_length_total) {
1791
       padding_len = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len - rlc_pdu_header_len_last + sdu_length_total + 1);
hbilel's avatar
hbilel committed
1792 1793 1794 1795 1796
   }
   else {
       padding_len = buflen - (bsr_len + phr_len);
   }

fnabet's avatar
fnabet committed
1797 1798 1799
  if (padding_len <= 2) {
    short_padding = padding_len;
    // only add padding header
1800
    post_padding = 0;
hbilel's avatar
hbilel committed
1801 1802
    //update total MAC Hdr size for RLC data
    if (sdu_length_total) {
1803
        total_rlc_pdu_header_len = total_rlc_pdu_header_len - rlc_pdu_header_len_last + 1;
hbilel's avatar
hbilel committed
1804
        rlc_pdu_header_len_last = 1;
1805
   }
hbilel's avatar
hbilel committed
1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817
  }
  else if (sdu_length_total) {
      post_padding = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + 1);
      // If by adding MAC Hdr for last RLC PDU the padding is 0 then set MAC Hdr for last RLC PDU = 1 and compute 1 or 2 byte padding
      if (post_padding == 0) {
          total_rlc_pdu_header_len -= rlc_pdu_header_len_last;
          padding_len = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + 1);
          short_padding = padding_len;
          total_rlc_pdu_header_len ++;
      }
  }
  else {
fnabet's avatar
fnabet committed
1818
    if (padding_len == buflen) {// nona mac pdu
1819 1820 1821 1822 1823
      *access_mode=CANCELED_ACCESS;
    }

    short_padding = 0;

hbilel's avatar
hbilel committed
1824
    post_padding = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + 1);
1825
  }
1826

1827 1828
  // Generate header
  // if (num_sdus>0) {
1829

1830
  payload_offset = generate_ulsch_header(ulsch_buffer,  // mac header
1831 1832 1833 1834 1835 1836
                                         num_sdus,      // num sdus
                                         short_padding,            // short pading
                                         sdu_lengths,  // sdu length
                                         sdu_lcids,    // sdu lcid
                                         phr_p,  // power headroom
                                         NULL,  // crnti
calvin wang's avatar
calvin wang committed
1837
                                         bsr_t,  // truncated bsr
1838 1839 1840 1841
                                         bsr_s, // short bsr
                                         bsr_l,
                                         post_padding); // long_bsr

1842
  LOG_D(MAC,
hbilel's avatar
hbilel committed
1843 1844
        "[UE %d] Generate header :bufflen %d  sdu_length_total %d, num_sdus %d, sdu_lengths[0] %d, sdu_lcids[0] %d => payload offset %d,  total_rlc_pdu_header_len %d, padding %d,post_padding %d, bsr len %d, phr len %d, reminder %d \n",
        module_idP,buflen, sdu_length_total,num_sdus,sdu_lengths[0],sdu_lcids[0],payload_offset, total_rlc_pdu_header_len,
1845
        short_padding,post_padding, bsr_len, phr_len,buflen-sdu_length_total-payload_offset);
1846
  // cycle through SDUs and place in ulsch_buffer
hbilel's avatar
hbilel committed
1847 1848 1849
  if (sdu_length_total) {
      memcpy(&ulsch_buffer[payload_offset],ulsch_buff,sdu_length_total);
  }
1850

1851
  // fill remainder of DLSCH with random data
1852 1853 1854 1855
  if (post_padding) {
      for (j=0; j<(buflen-sdu_length_total-payload_offset); j++) {
        ulsch_buffer[payload_offset+sdu_length_total+j] = (char)(taus()&0xff);
      }
1856
  }
Cedric Roux's avatar
Cedric Roux committed
1857
  LOG_D(MAC,"[UE %d][SR] Gave SDU to PHY, clearing any scheduling request\n", module_idP);
1858 1859
  UE_mac_inst[module_idP].scheduling_info.SR_pending=0;
  UE_mac_inst[module_idP].scheduling_info.SR_COUNTER=0;
1860 1861 1862 1863

  /* Actions when a BSR is sent */
  if (bsr_ce_len)
  {
hbilel's avatar
hbilel committed
1864 1865 1866
      LOG_D(MAC,"[UE %d] MAC BSR Sent !! bsr (ce%d,hdr%d) buff_len %d\n",
              module_idP, bsr_ce_len, bsr_header_len, buflen);

1867 1868 1869
	  // Reset ReTx BSR Timer
	  UE_mac_inst[module_idP].scheduling_info.retxBSR_SF = get_sf_retxBSRTimer(UE_mac_inst[module_idP].scheduling_info.retxBSR_Timer);

Cedric Roux's avatar
Cedric Roux committed
1870
	  LOG_D(MAC,"[UE %d] MAC ReTx BSR Timer Reset =%d\n", module_idP,
1871 1872 1873
			  UE_mac_inst[module_idP].scheduling_info.retxBSR_SF);

	  // Reset Periodic Timer except when BSR is truncated
Cedric Roux's avatar
Cedric Roux committed
1874
	  if ((bsr_t == NULL) && (UE_mac_inst[module_idP].scheduling_info.periodicBSR_Timer != PeriodicBSR_Timer_r12_infinity))
1875 1876 1877
	  {
		  UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF = get_sf_periodicBSRTimer(UE_mac_inst[module_idP].scheduling_info.periodicBSR_Timer);

hbilel's avatar
hbilel committed
1878
		  LOG_D(MAC,"[UE %d] MAC Periodic BSR Timer Reset =%d\n",
Cedric Roux's avatar
Cedric Roux committed
1879
		        module_idP, UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF);
1880 1881 1882 1883 1884

	  }

	  // Reset BSR Trigger flags
	  UE_mac_inst[module_idP].BSR_reporting_active = BSR_TRIGGER_NONE;
calvin wang's avatar
calvin wang committed
1885
  }
1886

1887
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_GET_SDU, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
1888
#if UE_TIMING_TRACE
1889
  stop_meas(&UE_mac_inst[module_idP].tx_ulsch_sdu);
gabrielC's avatar
gabrielC committed
1890
#endif
navid's avatar
navid committed
1891
  
1892

navid's avatar
navid committed
1893
  if (opt_enabled) {
1894
    trace_pdu(0, ulsch_buffer, buflen, module_idP, 3, UE_mac_inst[module_idP].crnti, UE_mac_inst[module_idP].txFrame, UE_mac_inst[module_idP].txSubframe, 0, 0);
Cedric Roux's avatar
Cedric Roux committed
1895
    LOG_D(OPT,"[UE %d][ULSCH] Frame %d subframe %d trace pdu for rnti %x  with size %d\n",
1896
          module_idP, frameP, subframe, UE_mac_inst[module_idP].crnti, buflen);
navid's avatar
navid committed
1897
  }
1898 1899
}

1900 1901


1902
//------------------------------------------------------------------------------
1903 1904 1905 1906 1907 1908 1909
// called at each subframe
// Performs :
// 1. Trigger PDCP every 5ms
// 2. Call RRC for link status return to PHY
// 3. Perform SR/BSR procedures for scheduling feedback
// 4. Perform PHR procedures

1910 1911 1912
UE_L2_STATE_t
ue_scheduler(
  const module_id_t    module_idP,
1913 1914 1915 1916
  const frame_t        rxFrameP,
  const sub_frame_t    rxSubframeP,
  const frame_t        txFrameP,
  const sub_frame_t    txSubframeP,
1917 1918 1919 1920
  const lte_subframe_t directionP,
  const uint8_t        eNB_indexP,
  const int            CC_id)
//------------------------------------------------------------------------------
1921
{
1922 1923
  int lcid; // lcid index
  int TTI= 1;
winckel's avatar
winckel committed
1924 1925
  int bucketsizeduration = -1;
  int bucketsizeduration_max = -1;
1926
  // mac_rlc_status_resp_t rlc_status[MAX_NUM_LCGID]; // 4
1927
  // int8_t lcg_id;
1928
  struct RACH_ConfigCommon *rach_ConfigCommon = (struct RACH_ConfigCommon *)NULL;
1929
  protocol_ctxt_t   ctxt;
GabrirelCouturier's avatar
GabrirelCouturier committed
1930

1931
#if defined(ENABLE_ITTI)
1932 1933 1934 1935
  MessageDef   *msg_p;
  const char   *msg_name;
  instance_t    instance;
  int           result;
1936
#endif
gabrielC's avatar
gabrielC committed
1937
#if UE_TIMING_TRACE
1938
  start_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
1939
#endif
1940
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_IN);
1941

1942
  PROTOCOL_CTXT_SET_BY_MODULE_ID(&ctxt, module_idP, ENB_FLAG_NO, UE_mac_inst[module_idP].crnti, txFrameP, txSubframeP,eNB_indexP);
1943 1944
#if defined(ENABLE_ITTI)

1945 1946 1947
  do {
    // Checks if a message has been sent to MAC sub-task
    itti_poll_msg (TASK_MAC_UE, &msg_p);
1948

1949 1950 1951
    if (msg_p != NULL) {
      msg_name = ITTI_MSG_NAME (msg_p);
      instance = ITTI_MSG_INSTANCE (msg_p);
1952

1953 1954 1955 1956 1957
      switch (ITTI_MSG_ID(msg_p)) {
      case RRC_MAC_CCCH_DATA_REQ:
        LOG_I(MAC, "Received %s from %s: instance %d, frameP %d, eNB_index %d\n",
              msg_name, ITTI_MSG_ORIGIN_NAME(msg_p), instance,
              RRC_MAC_CCCH_DATA_REQ (msg_p).frame, RRC_MAC_CCCH_DATA_REQ (msg_p).enb_index);
1958

1959 1960
        // TODO process CCCH data req.
        break;
1961 1962


1963 1964 1965
      default:
        LOG_E(MAC, "Received unexpected message %s\n", msg_name);
        break;
1966
      }
1967 1968 1969 1970

      result = itti_free (ITTI_MSG_ORIGIN_ID(msg_p), msg_p);
      AssertFatal (result == EXIT_SUCCESS, "Failed to free memory (%d)!\n", result);
    }
1971
  } while(msg_p != NULL);
1972

1973 1974
#endif

1975 1976
  //Mac_rlc_xface->frameP=frameP;
  //Rrc_xface->Frame_index=Mac_rlc_xface->frameP;
1977
  //if (subframe%5 == 0)
1978
  //LG#ifdef EXMIMO
1979
  pdcp_run(&ctxt);
1980
  //#endif
1981 1982 1983 1984
  UE_mac_inst[module_idP].txFrame    = txFrameP;
  UE_mac_inst[module_idP].txSubframe = txSubframeP;
  UE_mac_inst[module_idP].rxFrame    = rxFrameP;
  UE_mac_inst[module_idP].rxSubframe = rxSubframeP;
1985 1986

#ifdef CELLULAR
1987
  rrc_rx_tx(module_idP, txFrameP, 0, eNB_indexP);
1988
#else
1989

1990
  switch (rrc_rx_tx(&ctxt,
1991 1992
                    eNB_indexP,
                    CC_id)) {
1993 1994
  case RRC_OK:
    break;
1995

1996 1997
  case RRC_ConnSetup_failed:
    LOG_E(MAC,"RRCConnectionSetup failed, returning to IDLE state\n");
1998
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
1999
#if UE_TIMING_TRACE
2000
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2001
#endif
2002 2003
    return(CONNECTION_LOST);
    break;
2004

2005 2006
  case RRC_PHY_RESYNCH:
    LOG_E(MAC,"RRC Loss of synch, returning PHY_RESYNCH\n");
2007
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2008
#if UE_TIMING_TRACE
2009
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2010
#endif
2011
    return(PHY_RESYNCH);
2012

2013
  case RRC_Handover_failed:
2014
    LOG_N(MAC,"Handover failure for UE %d eNB_index %d\n",module_idP,eNB_indexP);
2015
    //Invalid...need to add another MAC UE state for re-connection procedure
2016
    phy_config_afterHO_ue(module_idP,0,eNB_indexP,(MobilityControlInfo_t *)NULL,1);
2017 2018
    //return(3);
    break;
2019

2020 2021
  case RRC_HO_STARTED:
    LOG_I(MAC,"RRC handover, Instruct PHY to start the contention-free PRACH and synchronization\n");
2022
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2023
#if UE_TIMING_TRACE
2024
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2025
#endif
2026
    return(PHY_HO_PRACH);
2027

2028 2029 2030
  default:
    break;
  }
2031

2032
#endif
2033 2034

  // Check Contention resolution timer (put in a function later)
2035
  if (UE_mac_inst[module_idP].RA_contention_resolution_timer_active == 1) {
2036

2037
    if (UE_mac_inst[module_idP].radioResourceConfigCommon) {
2038
      rach_ConfigCommon = &UE_mac_inst[module_idP].radioResourceConfigCommon->rach_ConfigCommon;
2039
    } else {
2040
      LOG_E(MAC,"FATAL: radioResourceConfigCommon is NULL!!!\n");
2041
      VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
2042

2043
      stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
2044
      AssertFatal(1==0,"");
2045

gabrielC's avatar
gabrielC committed
2046
#if UE_TIMING_TRACE
2047
      stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2048
#endif
2049 2050
      //return(RRC_OK);
    }
2051

Cedric Roux's avatar
Cedric Roux committed
2052
    LOG_I(MAC,"Frame %d: Contention resolution timer %d/%ld\n",txFrameP,UE_mac_inst[module_idP].RA_contention_resolution_cnt,
2053 2054
          ((1+rach_ConfigCommon->ra_SupervisionInfo.mac_ContentionResolutionTimer)<<3));

2055 2056 2057 2058 2059 2060 2061 2062
    UE_mac_inst[module_idP].RA_contention_resolution_cnt++;

    if (UE_mac_inst[module_idP].RA_contention_resolution_cnt ==
        ((1+rach_ConfigCommon->ra_SupervisionInfo.mac_ContentionResolutionTimer)<<3)) {
      UE_mac_inst[module_idP].RA_active = 0;
      UE_mac_inst[module_idP].RA_contention_resolution_timer_active = 0;
      // Signal PHY to quit RA procedure
      LOG_E(MAC,"Module id %u Contention resolution timer expired, RA failed\n", module_idP);
2063
      ra_failed(module_idP,0,eNB_indexP);
2064
    }
2065 2066 2067
  }


2068
  // Get RLC status info and update Bj for all lcids that are active
fnabet's avatar
fnabet committed
2069
  for (lcid=DCCH; lcid < MAX_NUM_LCID; lcid++ ) {
2070
    if (UE_mac_inst[module_idP].logicalChannelConfig[lcid]) {
2071 2072 2073 2074 2075 2076 2077
      // meausre the Bj
      if ((directionP == SF_UL)&& (UE_mac_inst[module_idP].scheduling_info.Bj[lcid] >= 0)) {
        if (UE_mac_inst[module_idP].logicalChannelConfig[lcid]->ul_SpecificParameters) {
          bucketsizeduration = UE_mac_inst[module_idP].logicalChannelConfig[lcid]->ul_SpecificParameters->prioritisedBitRate * TTI;
          bucketsizeduration_max = get_ms_bucketsizeduration(UE_mac_inst[module_idP].logicalChannelConfig[lcid]->ul_SpecificParameters->bucketSizeDuration);
        } else {
          LOG_E(MAC,"[UE %d] lcid %d, NULL ul_SpecificParameters\n",module_idP,lcid);
2078
          AssertFatal(1==0,"");
2079 2080
        }

2081
        if ( UE_mac_inst[module_idP].scheduling_info.Bj[lcid] > bucketsizeduration_max ) {
2082
          UE_mac_inst[module_idP].scheduling_info.Bj[lcid] = bucketsizeduration_max;
2083
        } else {
2084
          UE_mac_inst[module_idP].scheduling_info.Bj[lcid] = bucketsizeduration;
2085
        }
2086 2087
      }

2088

2089
      /*
calvin wang's avatar
calvin wang committed
2090 2091
      if (lcid == DCCH) {    
        LOG_D(MAC,"[UE %d][SR] Frame %d subframe %d Pending data for SRB1=%d for LCGID %d \n",                  
2092
        module_idP, txFrameP,txSubframeP,UE_mac_inst[module_idP].scheduling_info.BSR[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]],                  
2093
//         UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]);
2094
      }
2095
      */
2096
    }
2097
  }
2098

2099
  // Call BSR procedure as described in Section 5.4.5 in 36.321
GabrirelCouturier's avatar
GabrirelCouturier committed
2100

2101 2102 2103 2104 2105 2106
  // First check ReTxBSR Timer because it is always configured
  // Decrement ReTxBSR Timer if it is running and not null
  if ((UE_mac_inst[module_idP].scheduling_info.retxBSR_SF != MAC_UE_BSR_TIMER_NOT_RUNNING)
          && (UE_mac_inst[module_idP].scheduling_info.retxBSR_SF != 0)){
      UE_mac_inst[module_idP].scheduling_info.retxBSR_SF --;
  }
GabrirelCouturier's avatar
GabrirelCouturier committed
2107

2108 2109 2110 2111
  // Decrement Periodic Timer if it is running and not null
  if ((UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF != MAC_UE_BSR_TIMER_NOT_RUNNING)
            && (UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF != 0)){
        UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF--;
2112
    }
GabrirelCouturier's avatar
GabrirelCouturier committed
2113

2114
  //Check whether Regular BSR is triggered
hbilel's avatar
hbilel committed
2115
  if (update_bsr(module_idP,txFrameP, txSubframeP,eNB_indexP) == TRUE) {
2116 2117 2118 2119 2120 2121
  // call SR procedure to generate pending SR and BSR for next PUCCH/PUSCH TxOp.  This should implement the procedures
  // outlined in Sections 5.4.4 an 5.4.5 of 36.321
    UE_mac_inst[module_idP].scheduling_info.SR_pending= 1;
    // Regular BSR trigger
    UE_mac_inst[module_idP].BSR_reporting_active |= BSR_TRIGGER_REGULAR;
    LOG_D(MAC,"[UE %d][BSR] Regular BSR Triggered Frame %d subframe %d SR for PUSCH is pending\n",
hbilel's avatar
hbilel committed
2122
          module_idP, txFrameP,txSubframeP);
2123
  }
2124

2125
  // UE has no valid phy config dedicated ||  no valid/released  SR
2126
  if ((UE_mac_inst[module_idP].physicalConfigDedicated == NULL)) {
2127 2128 2129 2130
    // cancel all pending SRs
    UE_mac_inst[module_idP].scheduling_info.SR_pending=0;
    UE_mac_inst[module_idP].ul_active=0;
    LOG_T(MAC,"[UE %d] Release all SRs \n", module_idP);
2131
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2132
#if UE_TIMING_TRACE
2133
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2134
#endif
2135
    return(CONNECTION_OK);
2136 2137
  }

2138
  if ((UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig == NULL) ||
2139
      (UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig->present == SchedulingRequestConfig_PR_release)) {
2140

2141
    // initiate RA with CRNTI included in msg3 (no contention) as descibed in 36.321 sec 5.1.5
2142

2143 2144 2145 2146
    // cancel all pending SRs
    UE_mac_inst[module_idP].scheduling_info.SR_pending=0;
    UE_mac_inst[module_idP].ul_active=0;
    LOG_T(MAC,"[UE %d] Release all SRs \n", module_idP);
2147 2148 2149
  }

  // Put this in a function
2150
  // Call PHR procedure as described in Section 5.4.6 in 36.321
2151 2152
  if (UE_mac_inst[module_idP].PHR_state == MAC_MainConfig__phr_Config_PR_setup) { // normal operation

2153 2154 2155 2156 2157 2158
    if (UE_mac_inst[module_idP].PHR_reconfigured == 1) { // upon (re)configuration of the power headroom reporting functionality by upper layers
      UE_mac_inst[module_idP].PHR_reporting_active = 1;
      UE_mac_inst[module_idP].PHR_reconfigured = 0;
    } else {
      //LOG_D(MAC,"PHR normal operation %d active %d \n", UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF, UE_mac_inst[module_idP].PHR_reporting_active);
      if ((UE_mac_inst[module_idP].scheduling_info.prohibitPHR_SF <= 0) &&
2159
          ((get_PL(module_idP,0,eNB_indexP) <  UE_mac_inst[module_idP].scheduling_info.PathlossChange_db) ||
2160 2161
           (UE_mac_inst[module_idP].power_backoff_db[eNB_indexP] > UE_mac_inst[module_idP].scheduling_info.PathlossChange_db)))
        // trigger PHR and reset the timer later when the PHR report is sent
2162
      {
2163
        UE_mac_inst[module_idP].PHR_reporting_active = 1;
2164
      } else if (UE_mac_inst[module_idP].PHR_reporting_active ==0 ) {
2165
        UE_mac_inst[module_idP].scheduling_info.prohibitPHR_SF--;
2166
      }
2167

2168
      if (UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF <= 0 )
2169
        // trigger PHR and reset the timer later when the PHR report is sent
2170
      {
2171
        UE_mac_inst[module_idP].PHR_reporting_active = 1;
2172
      } else if (UE_mac_inst[module_idP].PHR_reporting_active == 0 ) {
2173
        UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF--;
2174
      }
2175
    }
2176
  } else {    // release / nothing
2177
    UE_mac_inst[module_idP].PHR_reporting_active = 0; // release PHR
2178
  }
2179

2180
  //If the UE has UL resources allocated for new transmission for this TTI here:
2181
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2182 2183 2184
#if UE_TIMING_TRACE
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
#endif
2185 2186 2187 2188 2189
  return(CONNECTION_OK);
}

// to be improved
#ifdef CBA
2190
extern int cba_backoff;
2191 2192
double uniform_rngen(int min, int max)
{
2193 2194 2195 2196
  double random = (double)taus()/((double)0xffffffff);
  return (max - min) * random + min;
}

2197 2198
int cba_access(module_id_t module_idP,frame_t frameP,sub_frame_t subframe, uint8_t eNB_index,uint16_t buflen)
{
2199

2200 2201 2202 2203
  mac_rlc_status_resp_t rlc_status;
  int header_offset=4;
  int rv =0;

2204
  /*
2205 2206 2207 2208 2209
  if (( ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]<64))   ||
      ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2]<64))   ||
      ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3]<64)) )
      //  && (UE_mac_inst[module_idP].ul_active == 0) // check if the ul is acrtive
      && (UE_mac_inst[module_idP].cba_last_access[0] <= 0) ) { // backoff
2210
      //  LOG_D(MAC,"[UE %d] Frame %d Subframe %d: the current CBA backoff is %d \n", module_idP, frameP, subframe,
2211 2212
      //  UE_mac_inst[module_idP].cba_last_access[0] );

2213
      UE_mac_inst[module_idP].cba_last_access[0]= round(uniform_rngen(1,40));
2214
      LOG_D(MAC,"[UE %d] Frame %d Subframe %d: start a new CBA backoff  %d UL active state %d \n", module_idP, frameP, subframe,
2215 2216
          UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);

2217
      rv=1;
2218 2219 2220 2221 2222 2223 2224 2225
  } else if (( ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]> 0 ))   ||
      ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2]> 0 ))   ||
      ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3]> 0 )) )
      // && (UE_mac_inst[module_idP].ul_active == 0) // check if the ul is acrtive
      && (UE_mac_inst[module_idP].cba_last_access[0]> 0) ){

      UE_mac_inst[module_idP].cba_last_access[0]-=1;
      LOG_D(MAC,"[UE %d] Frame %d Subframe %d: CBA backoff is decreased by one to %d UL active state %d \n",
2226
          module_idP, frameP, subframe,
2227 2228
          UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);

2229 2230 2231 2232
  } else if (( ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1] == 0 ))   &&
               ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2] == 0 ))   &&
               ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3] ==  0 )) )
             && (UE_mac_inst[module_idP].cba_last_access[0]> 0) ){
2233
    UE_mac_inst[module_idP].cba_last_access[0]-=1;
2234
    }*/
2235

2236
  if ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID0]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID0]<64) ) {
2237
    return 0;
2238
  }
2239

2240 2241
  if ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1] <= 0 ) &&
      (UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2] <= 0 ) &&
2242
      (UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3] <= 0 ) ) {
2243
    return 0;
2244
  }
2245

2246
  if (cba_backoff == 0 ) { // apply probablisitc method
2247
    UE_mac_inst[module_idP].cba_last_access[0]= uniform_rngen(0,1);
2248 2249

    if (uniform_rngen(0,1) > 0.6 ) {
2250
      LOG_I(MAC,"[UE %d] Frame %d Subframe %d: CBA probability-based backoff (%d), UL active state %d \n", module_idP, frameP, subframe,
2251 2252
            cba_backoff,UE_mac_inst[module_idP].ul_active);

2253 2254
      rv=1;
    }
2255 2256
  } else {

2257 2258
    if (UE_mac_inst[module_idP].cba_last_access[0] <= 0) {
      UE_mac_inst[module_idP].cba_last_access[0]= round(uniform_rngen(1,cba_backoff));
2259

2260
      LOG_I(MAC,"[UE %d] Frame %d Subframe %d: start a new CBA backoff  %d/%d UL active state %d \n", module_idP, frameP, subframe,
2261 2262 2263 2264
            UE_mac_inst[module_idP].cba_last_access[0], cba_backoff,UE_mac_inst[module_idP].ul_active);

      rv = 1;
      /*
2265
      rlc_status = mac_rlc_status_ind(module_idP, UE_mac_inst[module_idP].crnti,frameP,ENB_FLAG_NO,MBMS_FLAG_NO, // eNB_index
2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279
      DTCH,
      0);

      if ((
      //  (rlc_status.pdus_in_buffer > 0 )           &&
      // (UE_mac_inst[module_idP].ul_active == 0)  && // check if the ul is acrtive
      (rlc_status.head_sdu_is_segmented  == 0 )          &&
      ((rlc_status.head_sdu_remaining_size_to_send + header_offset ) <= buflen )
      )){
      rv = 1;

      UE_mac_inst[module_idP].cba_last_access[0]= round(uniform_rngen(1,30));
      LOG_D(MAC,"[UE %d] Frame %d Subframe %d: start a new CBA backoff  %d UL active state %d \n", module_idP, frameP, subframe,
      UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);
2280 2281 2282 2283
      */
    } else {
      UE_mac_inst[module_idP].cba_last_access[0]-=1;
      LOG_D(MAC,"[UE %d] Frame %d Subframe %d: wait for backoff to expire (%d) CBA UL active state %d \n",
2284 2285 2286
            module_idP, frameP, subframe,
            UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);
    }
2287
  }
2288

2289 2290 2291
  return rv;
  /*
    if (( ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]<64))   ||
2292 2293 2294 2295 2296
    ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2]<64))   ||
    ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3]<64)) )
  //  && (UE_mac_inst[module_idP].ul_active == 0) // check if the ul is acrtive
  && (UE_mac_inst[module_idP].cba_last_access[0] <= 0) ) {

2297
      UE_mac_inst[module_idP].cba_last_access[0]= round(uniform_rngen(1,cba_backoff));
2298

2299
      LOG_I(MAC,"[UE %d] Frame %d Subframe %d: start a new CBA backoff  %d/%d UL active state %d \n", module_idP, frameP, subframe,
2300 2301 2302 2303
      UE_mac_inst[module_idP].cba_last_access[0], cba_backoff,UE_mac_inst[module_idP].ul_active);

      rv = 1;

2304
    rlc_status = mac_rlc_status_ind(module_idP, UE_mac_inst[module_idP].crnti,frameP,ENB_FLAG_NO,MBMS_FLAG_NO, // eNB_index
2305 2306 2307
            DTCH,
            0);

2308
    if ((
2309 2310 2311 2312 2313
   // (rlc_status.pdus_in_buffer > 0 )           &&
  // (UE_mac_inst[module_idP].ul_active == 0)  && // check if the ul is acrtive
   (rlc_status.head_sdu_is_segmented  == 0 )          &&
   ((rlc_status.head_sdu_remaining_size_to_send + header_offset ) <= buflen )
   )){
2314
      rv = 1;
2315

2316 2317
      UE_mac_inst[module_idP].cba_last_access[0]= round(uniform_rngen(1,30));
      LOG_D(MAC,"[UE %d] Frame %d Subframe %d: start a new CBA backoff  %d UL active state %d \n", module_idP, frameP, subframe,
2318 2319
      UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);
    } else
2320
      UE_mac_inst[module_idP].cba_last_access[0]= round(uniform_rngen(1,5));
2321

2322 2323

    } else if (( ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]> 0 ))   ||
2324 2325 2326 2327
     ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2]> 0 ))   ||
     ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3]> 0 )) )
         // && (UE_mac_inst[module_idP].ul_active == 0) // check if the ul is acrtive
         && (UE_mac_inst[module_idP].cba_last_access[0]> 0) )
2328
      {
2329 2330 2331 2332 2333

  UE_mac_inst[module_idP].cba_last_access[0]-=1;
  LOG_D(MAC,"[UE %d] Frame %d Subframe %d: wait for backoff to expire (%d) CBA UL active state %d \n",
        module_idP, frameP, subframe,
        UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);
2334 2335
      }
  }
2336 2337
  */

2338 2339 2340 2341
}
#endif


2342
boolean_t  update_bsr(module_id_t module_idP, frame_t frameP, sub_frame_t subframeP,eNB_index_t eNB_index)
2343
{
2344 2345

  mac_rlc_status_resp_t rlc_status;
2346 2347 2348 2349 2350
  boolean_t bsr_regular_triggered = FALSE;
  uint8_t lcid;
  uint8_t lcgid;
  uint8_t num_lcid_with_data = 0; // for LCID with data only if LCGID is defined
  uint16_t lcgid_buffer_remain[MAX_NUM_LCGID] = {0,0,0,0};
2351
  int32_t lcid_bytes_in_buffer[MAX_NUM_LCID];
2352 2353 2354 2355 2356 2357 2358 2359
  /* Array for ordering LCID with data per decreasing priority order */
  uint8_t lcid_reordered_array[MAX_NUM_LCID]=
  {MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID,MAX_NUM_LCID};
  uint8_t pos_next = 0;
  uint8_t highest_priority = 16;
  uint8_t array_index = 0;

  // Reset All BSR Infos
hbilel's avatar
hbilel committed
2360
  lcid_bytes_in_buffer[0] = 0;
2361 2362 2363 2364 2365
  for (lcid=DCCH; lcid < MAX_NUM_LCID; lcid++)
  {
	  // Reset transmission status
	  lcid_bytes_in_buffer[lcid] = 0;
	  UE_mac_inst[module_idP].scheduling_info.LCID_status[lcid]=LCID_EMPTY;
2366
  }
2367

hbilel's avatar
hbilel committed
2368
  for (lcgid=0; lcgid < MAX_NUM_LCGID; lcgid++)
2369 2370 2371 2372
  {
	  // Reset Buffer Info
	  UE_mac_inst[module_idP].scheduling_info.BSR[lcgid]=0;
	  UE_mac_inst[module_idP].scheduling_info.BSR_bytes[lcgid]=0;
2373
  }
Raymond Knopp's avatar
 
Raymond Knopp committed
2374

2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387
  //Get Buffer Occupancy and fill lcid_reordered_array
  for (lcid=DCCH; lcid < MAX_NUM_LCID; lcid++)
  {
	  if (UE_mac_inst[module_idP].logicalChannelConfig[lcid])
	  {
		  	lcgid = UE_mac_inst[module_idP].scheduling_info.LCGID[lcid];

		  	// Store already available data to transmit per Group
		  	if (lcgid < MAX_NUM_LCGID)
		  	{
			  	lcgid_buffer_remain[lcgid] += UE_mac_inst[module_idP].scheduling_info.LCID_buffer_remain[lcid];
		  	}

2388
		    rlc_status = mac_rlc_status_ind(module_idP, UE_mac_inst[module_idP].crnti,eNB_index,frameP,subframeP,ENB_FLAG_NO,MBMS_FLAG_NO,
2389
		                                    lcid,
2390
		                                    0xFFFF); //TBS is not used in RLC at this step, set a special value for debug
2391 2392 2393 2394 2395

		    lcid_bytes_in_buffer[lcid] = rlc_status.bytes_in_buffer;

		    if (rlc_status.bytes_in_buffer > 0)
		    {
hbilel's avatar
hbilel committed
2396 2397
		          LOG_D(MAC,"[UE %d] PDCCH Tick : LCID%d LCGID%d has data to transmit =%d bytes at frame %d subframe %d\n",
		                              module_idP, lcid,lcgid,rlc_status.bytes_in_buffer,frameP,subframeP);
2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428

		         UE_mac_inst[module_idP].scheduling_info.LCID_status[lcid] = LCID_NOT_EMPTY;
		         //Update BSR_bytes and position in lcid_reordered_array only if Group is defined
		         if (lcgid < MAX_NUM_LCGID)
		         {
		        	 num_lcid_with_data ++;
			         // sum lcid buffer which has same lcgid
			         UE_mac_inst[module_idP].scheduling_info.BSR_bytes[lcgid] += rlc_status.bytes_in_buffer;

			         //Fill in the array
			         array_index = 0;
			         do
					{
			        	 if (UE_mac_inst[module_idP].logicalChannelConfig[lcid]->ul_SpecificParameters->priority <= highest_priority)
			        	 {
			        		 //Insert if priority is higher or equal (lower or equal in value)
			        		 for (pos_next=num_lcid_with_data-1; pos_next > array_index; pos_next--)
			        		 {
			        			 lcid_reordered_array[pos_next] = lcid_reordered_array[pos_next - 1];

			        		 }
			        		 lcid_reordered_array[array_index] = lcid;
			        		 break;

			        	 }
			        	 array_index ++;
					}
			         while ((array_index < num_lcid_with_data) && (array_index < MAX_NUM_LCID));
		         }
		    }
	  }
Raymond Knopp's avatar
 
Raymond Knopp committed
2429

2430
  }
2431

2432 2433 2434
  // Check whether a regular BSR can be triggered according to the first cases in 36.321
  if (num_lcid_with_data)
  {
hbilel's avatar
hbilel committed
2435 2436 2437
          LOG_D(MAC,"[UE %d] PDCCH Tick at frame %d subframe %d: NumLCID with data=%d Reordered LCID0=%d LCID1=%d LCID2=%d\n",
                            module_idP, frameP, subframeP,num_lcid_with_data,lcid_reordered_array[0],lcid_reordered_array[1],lcid_reordered_array[2]);

2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451
	  for (array_index=0; array_index < num_lcid_with_data; array_index++)
	  {
		  lcid = lcid_reordered_array[array_index];
	      /* UL data, for a logical channel which belongs to a LCG, becomes available for transmission in the RLC entity
	         either the data belongs to a logical channel with higher priority than the priorities of the logical channels
	         which belong to any LCG and for which data is already available for transmission
	      */
		  if ((UE_mac_inst[module_idP].scheduling_info.LCID_buffer_remain[lcid] == 0)
			/* or there is no data available for any of the logical channels which belong to a LCG */
			||(lcgid_buffer_remain[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]] == 0)
			)
		  {
			  bsr_regular_triggered = TRUE;

hbilel's avatar
hbilel committed
2452 2453
		      LOG_D(MAC,"[UE %d] PDCCH Tick : MAC BSR Triggered LCID%d LCGID%d data become available at frame %d subframe %d\n",
		                      module_idP, lcid,UE_mac_inst[module_idP].scheduling_info.LCGID[lcid],frameP, subframeP);
2454 2455 2456 2457 2458 2459 2460 2461 2462 2463

			  break;
		  }
	  }

	  // Trigger Regular BSR if ReTxBSR Timer has expired and UE has data for transmission
	  if (UE_mac_inst[module_idP].scheduling_info.retxBSR_SF == 0)
	  {
		  bsr_regular_triggered = TRUE;

hbilel's avatar
hbilel committed
2464 2465 2466 2467
		  if ((UE_mac_inst[module_idP].BSR_reporting_active & BSR_TRIGGER_REGULAR) == 0) {
		        LOG_I(MAC,"[UE %d] PDCCH Tick : MAC BSR Triggered ReTxBSR Timer expiry at frame %d subframe %d\n",
		                          module_idP, frameP, subframeP);
		  }
2468 2469

	  }
2470
  }
2471

2472 2473 2474 2475
  //Store Buffer Occupancy in remain buffers for next TTI
  for (lcid=DCCH; lcid < MAX_NUM_LCID; lcid++)
  {
	  UE_mac_inst[module_idP].scheduling_info.LCID_buffer_remain[lcid] = lcid_bytes_in_buffer[lcid];
2476
  }
2477

2478
  return bsr_regular_triggered;
2479 2480
}

fnabet's avatar
fnabet committed
2481
uint8_t locate_BsrIndexByBufferSize (const uint32_t *table, int size, int value)
2482
{
2483

2484
  uint8_t ju, jm, jl;
2485 2486
  int ascend;

2487 2488 2489
  DevAssert( size > 0 );
  DevAssert( size <= 256 );

2490 2491 2492
  if (value == 0) {
    return 0;  //elseif (value > 150000) return 63;
  }
2493

2494 2495
  jl = 0;        // lower bound
  ju = size - 1; // upper bound
2496 2497 2498
  ascend = (table[ju] >= table[jl]) ? 1 : 0; // determine the order of the the table:  1 if ascending order of table, 0 otherwise

  while (ju-jl > 1) { //If we are not yet done,
2499 2500
    jm = (ju+jl) >> 1; //compute a midpoint,

2501
    if ((value >= table[jm]) == ascend) {
2502
      jl=jm; // replace the lower limit
2503
    } else {
2504
      ju=jm; //replace the upper limit
2505
    }
2506 2507

    LOG_T(MAC,"[UE] searching BSR index %d for (BSR TABLE %d < value %d)\n", jm, table[jm], value);
2508
  }
2509

2510 2511 2512 2513 2514
  if (value == table[jl]) {
    return jl;
  } else                    {
    return jl+1;  //equally  ju
  }
2515 2516 2517

}

2518 2519
int get_sf_periodicBSRTimer(uint8_t sf_offset)
{
2520 2521

  switch (sf_offset) {
Cedric Roux's avatar
Cedric Roux committed
2522
  case PeriodicBSR_Timer_r12_sf5:
2523 2524
    return 5;
    break;
2525

Cedric Roux's avatar
Cedric Roux committed
2526
  case PeriodicBSR_Timer_r12_sf10:
2527 2528
    return 10;
    break;
2529

Cedric Roux's avatar
Cedric Roux committed
2530
  case PeriodicBSR_Timer_r12_sf16:
2531 2532
    return 16;
    break;
2533

Cedric Roux's avatar
Cedric Roux committed
2534
  case PeriodicBSR_Timer_r12_sf20:
2535 2536
    return 20;
    break;
2537

Cedric Roux's avatar
Cedric Roux committed
2538
  case PeriodicBSR_Timer_r12_sf32:
2539 2540
    return 32;
    break;
2541

Cedric Roux's avatar
Cedric Roux committed
2542
  case PeriodicBSR_Timer_r12_sf40:
2543 2544
    return 40;
    break;
2545

Cedric Roux's avatar
Cedric Roux committed
2546
  case PeriodicBSR_Timer_r12_sf64:
2547 2548
    return 64;
    break;
2549

Cedric Roux's avatar
Cedric Roux committed
2550
  case PeriodicBSR_Timer_r12_sf80:
2551 2552
    return 80;
    break;
2553

Cedric Roux's avatar
Cedric Roux committed
2554
  case PeriodicBSR_Timer_r12_sf128:
2555 2556
    return 128;
    break;
2557

Cedric Roux's avatar
Cedric Roux committed
2558
  case PeriodicBSR_Timer_r12_sf160:
2559 2560
    return 160;
    break;
2561

Cedric Roux's avatar
Cedric Roux committed
2562
  case PeriodicBSR_Timer_r12_sf320:
2563 2564
    return 320;
    break;
2565

Cedric Roux's avatar
Cedric Roux committed
2566
  case PeriodicBSR_Timer_r12_sf640:
2567 2568
    return 640;
    break;
2569

Cedric Roux's avatar
Cedric Roux committed
2570
  case PeriodicBSR_Timer_r12_sf1280:
2571 2572
    return 1280;
    break;
2573

Cedric Roux's avatar
Cedric Roux committed
2574
  case PeriodicBSR_Timer_r12_sf2560:
2575 2576
    return 2560;
    break;
2577

Cedric Roux's avatar
Cedric Roux committed
2578
  case PeriodicBSR_Timer_r12_infinity:
2579
  default:
calvin wang's avatar
calvin wang committed
2580
    return 0xFFFF;
2581 2582 2583 2584
    break;
  }
}

2585 2586
int get_sf_retxBSRTimer(uint8_t sf_offset)
{
2587 2588

  switch (sf_offset) {
Cedric Roux's avatar
Cedric Roux committed
2589
  case RetxBSR_Timer_r12_sf320:
2590 2591
    return 320;
    break;
2592

Cedric Roux's avatar
Cedric Roux committed
2593
  case RetxBSR_Timer_r12_sf640:
2594 2595
    return 640;
    break;
2596

Cedric Roux's avatar
Cedric Roux committed
2597
  case RetxBSR_Timer_r12_sf1280:
2598 2599
    return 1280;
    break;
2600

Cedric Roux's avatar
Cedric Roux committed
2601
  case RetxBSR_Timer_r12_sf2560:
2602 2603
    return 2560;
    break;
2604

Cedric Roux's avatar
Cedric Roux committed
2605
  case RetxBSR_Timer_r12_sf5120:
2606 2607
    return 5120;
    break;
2608

Cedric Roux's avatar
Cedric Roux committed
2609
  case RetxBSR_Timer_r12_sf10240:
2610 2611
    return 10240;
    break;
2612

2613 2614 2615 2616 2617
  default:
    return -1;
    break;
  }
}
2618 2619
int get_ms_bucketsizeduration(uint8_t bucketsizeduration)
{
2620 2621 2622 2623 2624

  switch (bucketsizeduration) {
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms50:
    return 50;
    break;
2625

2626 2627 2628
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms100:
    return 100;
    break;
2629

2630 2631 2632
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms150:
    return 150;
    break;
2633

2634 2635 2636
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms300:
    return 300;
    break;
2637

2638 2639 2640
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms500:
    return 500;
    break;
2641

2642 2643 2644
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms1000:
    return 1000;
    break;
2645

2646 2647 2648 2649 2650 2651
  default:
    return 0;
    break;
  }
}

2652 2653
void update_phr(module_id_t module_idP,int CC_id)
{
Raymond Knopp's avatar
 
Raymond Knopp committed
2654

2655 2656
  AssertFatal(CC_id==0,
	      "Transmission on secondary CCs is not supported yet\n");
2657 2658 2659 2660 2661

  UE_mac_inst[module_idP].PHR_reporting_active =0;
  UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF =  get_sf_perioidicPHR_Timer(UE_mac_inst[module_idP].scheduling_info.periodicPHR_Timer);
  UE_mac_inst[module_idP].scheduling_info.prohibitPHR_SF =  get_sf_prohibitPHR_Timer(UE_mac_inst[module_idP].scheduling_info.prohibitPHR_Timer);
  // LOG_D(MAC,"phr %d %d\n ",UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF, UE_mac_inst[module_idP].scheduling_info.prohibitPHR_SF);
2662
}
2663 2664
uint8_t get_phr_mapping (module_id_t module_idP, int CC_id, uint8_t eNB_index)
{
2665

2666 2667
  AssertFatal(CC_id==0,
	      "Transmission on secondary CCs is not supported yet\n");
2668

2669 2670
  //power headroom reporting range is from -23 ...+40 dB, as described in 36313
  //note: mac_xface->get_Po_NOMINAL_PUSCH(module_idP) is float
2671
  if (get_PHR(module_idP,CC_id,eNB_index) < -23) {
2672
    return 0;
2673
  } else if (get_PHR(module_idP,CC_id,eNB_index) >= 40) {
2674
    return 63;
2675
  } else { // -23 to 40
2676
    return  (uint8_t) get_PHR(module_idP,CC_id,eNB_index) + PHR_MAPPING_OFFSET;
2677

2678
  }
2679
}
2680 2681
int get_sf_perioidicPHR_Timer(uint8_t perioidicPHR_Timer)
{
2682 2683 2684 2685
  return (perioidicPHR_Timer+1)*10;
}


2686 2687
int get_sf_prohibitPHR_Timer(uint8_t prohibitPHR_Timer)
{
2688 2689 2690
  return (prohibitPHR_Timer)*10;
}

2691 2692 2693
int get_db_dl_PathlossChange(uint8_t dl_PathlossChange)
{
  switch (dl_PathlossChange) {
2694 2695 2696
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_dB1:
    return 1;
    break;
2697

2698 2699 2700
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_dB3:
    return 3;
    break;
2701

2702 2703 2704
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_dB6:
    return 6;
    break;
2705

2706 2707 2708 2709 2710 2711
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_infinity:
  default:
    return -1;
    break;
  }
}
2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741


SLSS_t *ue_get_slss(module_id_t Mod_id,int CC_id,frame_t frame_tx,sub_frame_t subframe_tx) {

  return((SLSS_t*)NULL);
}

SLDCH_t *ue_get_sldch(module_id_t Mod_id,int CC_id,frame_t frame_tx,sub_frame_t subframe_tx) {

  return((SLDCH_t*)NULL);
}


SLSCH_t *ue_get_slsch(module_id_t module_idP,int CC_id,frame_t frameP,sub_frame_t subframeP) {

  mac_rlc_status_resp_t rlc_status;
  uint32_t absSF = (frameP*10)+subframeP;
  UE_MAC_INST *ue = &UE_mac_inst[module_idP];
  int rvtab[4] = {0,2,3,1};
  int sdu_length;
  // Note: this is hard-coded for now for the default SL configuration (4 SF PSCCH, 36 SF PSSCH)
  SLSCH_t *slsch = &UE_mac_inst[module_idP].slsch;

  LOG_D(MAC,"Checking SLSCH for absSF %d\n",absSF);

  if ((absSF%40) == 0) { // fill PSCCH data later in first subframe of SL period
    ue->sltx_active = 0;
    rlc_status = mac_rlc_status_ind(module_idP, 0x1234,0,frameP,subframeP,ENB_FLAG_NO,MBMS_FLAG_NO,
				    3,
				    0xFFFF);
2742 2743
    if (rlc_status.bytes_in_buffer > 2) {
      LOG_I(MAC,"SFN.SF %d.%d: Scheduling for %d bytes in Sidelink buffer\n",frameP,subframeP,rlc_status.bytes_in_buffer);
2744 2745 2746 2747 2748 2749 2750 2751 2752
      // Fill in group id for off-network communications
      ue->sltx_active = 1;
    }
  } // we're not in the SCCH period
  else if (((absSF & 3) == 0 ) && 
	   (ue->sltx_active == 1)) { // every 4th subframe, check for new data from RLC
    // 10 PRBs, mcs 19
    int TBS = 4584/8;
    int req;
2753 2754
    
    
2755 2756 2757 2758 2759
    rlc_status = mac_rlc_status_ind(module_idP, 0x1234,0,frameP,subframeP,ENB_FLAG_NO,MBMS_FLAG_NO,
				    3,
				    0xFFFF);
    if (TBS<=rlc_status.bytes_in_buffer) req=TBS;
    else req = rlc_status.bytes_in_buffer;
2760 2761 2762 2763 2764 2765 2766 2767 2768 2769
    
    if (req>0) {
      sdu_length = mac_rlc_data_req(module_idP,
				    0x1234,
				    0,
				    frameP,
				    ENB_FLAG_NO,
				    MBMS_FLAG_NO,
				    3,				    
				    req,
2770
				    (char*)(ue->slsch_pdu.payload + sizeof(SLSCH_SUBHEADER_24_Bit_DST_LONG)));
2771
      
2772 2773 2774
      // Notes: 1. hard-coded to 24-bit destination format for now
      //        2. LCID hard-coded to 3
      //        3. SRC/DST IDs with debug values
2775 2776 2777
      if (sdu_length > 0) {
	LOG_I(MAC,"SFN.SF %d.%d : got %d bytes from Sidelink buffer (%d requested)\n",frameP,subframeP,sdu_length,req);
	slsch->payload = (unsigned char*)ue->slsch_pdu.payload;
2778 2779 2780 2781 2782
	if (sdu_length < 128) { 
	  slsch->payload++;
	  SLSCH_SUBHEADER_24_Bit_DST_SHORT *shorth= (SLSCH_SUBHEADER_24_Bit_DST_SHORT *)slsch->payload;
	  shorth->F=0;
	  shorth->L=sdu_length;
2783
	  shorth->E=0;
2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797
	  shorth->LCID=3;
	  shorth->SRC07=0x12;
	  shorth->SRC815=0x34;
	  shorth->SRC1623=0x56;
	  shorth->DST07=0x78;
	  shorth->DST815=0x9A;
	  shorth->DST1623=0xBC;
	  shorth->V=0x1;
	}
	else {
	  SLSCH_SUBHEADER_24_Bit_DST_LONG *longh= (SLSCH_SUBHEADER_24_Bit_DST_LONG *)slsch->payload;
	  longh->F=1;
	  longh->L_LSB=sdu_length&0xff;
	  longh->L_MSB=(sdu_length>>8)&0x7f;
2798
	  longh->E=0;
2799 2800 2801 2802 2803 2804 2805 2806 2807
	  longh->LCID=3;
	  longh->SRC07=0x12;
	  longh->SRC815=0x34;
	  longh->SRC1623=0x56;
	  longh->DST07=0x78;
	  longh->DST815=0x9A;
	  longh->DST1623=0xBC;
	  longh->V=0x1;
	}
2808 2809 2810 2811 2812 2813
	slsch->rvidx   = 0;
	slsch->payload_length = TBS;
	// fill in SLSCH configuration
	return(&ue->slsch);
      }
      else ue->sltx_active = 0;
2814
    }
2815 2816 2817 2818 2819

  } else if ((absSF%40)>3 && ue->sltx_active == 1) { // handle retransmission of SDU
    LOG_I(MAC,"SFN.SF %d.%d : retransmission\n",frameP,subframeP);
    slsch->rvidx = rvtab[absSF&3];
    return(&ue->slsch);
2820
  }
2821

2822 2823 2824
  
  return(NULL);
}