ue_procedures.c 105 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 83
#ifndef USER_MODE
#define msg debug_msg
#endif
84
 */
85
mapping BSR_names[] = {
86 87 88 89 90 91
  {"NONE", 0},
  {"SHORT BSR", 1},
  {"TRUNCATED BSR", 2},
  {"LONG BSR", 3},
  {"PADDING BSR", 4},
  {NULL, -1}
92 93 94
};


95 96
void ue_init_mac(module_id_t module_idP)
{
97 98
  int i;
  // default values as deined in 36.331 sec 9.2.2
99 100
  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
101 102
  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;
103 104 105 106 107 108 109 110 111
  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
112 113
  UE_mac_inst[module_idP].scheduling_info.extendedBSR_Sizes_r10=0;
  UE_mac_inst[module_idP].scheduling_info.extendedPHR_r10=0;
114 115
  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
116
  // 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
117 118
  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;
119
  UE_mac_inst[module_idP].BSR_reporting_active = BSR_TRIGGER_NONE;
120

121 122 123
  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
124
  UE_mac_inst[module_idP].PHR_reporting_active = 0;
125 126

  for (i=0; i < MAX_NUM_LCID; i++) {
Raymond Knopp's avatar
 
Raymond Knopp committed
127 128
    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;
129 130
    UE_mac_inst[module_idP].scheduling_info.bucket_size[i]=-1;

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

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

141 142
  if(nfapi_mode == 3) {
	  pthread_mutex_init(&UE_mac_inst[module_idP].UL_INFO_mutex,NULL);
143
	  UE_mac_inst[module_idP].UE_mode[0] = NOT_SYNCHED; //PRACH;
144 145 146 147 148 149 150
	  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;
  }

151
#ifdef CBA
152

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

#endif
158 159
}

Raymond Knopp's avatar
 
Raymond Knopp committed
160

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

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

  while (not_done==1) {

176 177 178 179 180 181 182 183 184 185 186 187 188
    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;

189
        for (num_sdu_cnt=0; num_sdu_cnt < num_sdus ; num_sdu_cnt++) {
190
          length -= rx_lengths[num_sdu_cnt];
191
        }
192 193 194 195
      } 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;
196
#ifdef DEBUG_HEADER_PARSING
197
          LOG_D(MAC,"[UE] parse long sdu, size %x \n",length);
198
#endif
199

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

206
#ifdef DEBUG_HEADER_PARSING
Cedric Roux's avatar
Cedric Roux committed
207
      LOG_D(MAC,"[UE] sdu %d lcid %d length %d (offset now %ld)\n",
208
            num_sdus,lcid,length,mac_header_ptr-mac_header);
209
#endif
210 211 212 213 214
      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
215
    	num_padding ++;
216 217 218 219 220 221
        mac_header_ptr++;
      } else {
        rx_ces[num_ces] = lcid;
        num_ces++;
        mac_header_ptr ++;

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

        	// 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 ++;
242
          ce_len+=6;
243
        }
244
      }
245

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

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

  return(mac_header_ptr);
}

258 259
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)
{
260 261 262

  // 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
263 264 265
  int MGRP       = 0; // measurement gap repetition period in ms
  int gapOffset  = -1;
  int T          = 0;
266

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

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

272
  // determin the measurement gap
273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292
  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);
    }
293
  }
294 295

  if ((UE_mac_inst[module_idP].physicalConfigDedicated != NULL) &&
296
      (UE_mac_inst[module_idP].scheduling_info.SR_pending==1) &&
297
      (UE_mac_inst[module_idP].scheduling_info.SR_COUNTER <
298 299
       (1<<(2+UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig->choice.setup.dsr_TransMax)))
     ) {
300
    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",
301
          module_idP,rnti,frameP,subframe,
302 303 304 305
          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);

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

308 309 310 311
    // 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;
312
    } else {
313
      UE_mac_inst[module_idP].scheduling_info.sr_ProhibitTimer_Running=0;
314
    }
315 316 317 318 319 320 321 322 323 324 325 326 327

    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
328 329 330 331
      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;
332
          UE_mac_inst[module_idP].BSR_reporting_active=BSR_TRIGGER_NONE;
hbilel's avatar
hbilel committed
333 334 335

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

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

  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
360
#if UE_TIMING_TRACE
361
  start_meas(&UE_mac_inst[module_idP].rx_dlsch_sdu);
gabrielC's avatar
gabrielC committed
362
#endif
363
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_SDU, VCD_FUNCTION_IN);
364 365 366

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

367
  if (opt_enabled) {
368
    trace_pdu(1, sdu, sdu_len, module_idP, 3, UE_mac_inst[module_idP].crnti,
369
        frameP, subframeP, 0, 0);
navid's avatar
navid committed
370 371
    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);
372 373 374 375 376
  }

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

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

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

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

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

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

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

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

      if (UE_mac_inst[module_idP].RA_active == 1) {
Cedric Roux's avatar
Cedric Roux committed
402
        LOG_I(MAC,"[UE %d][RAPROC] Frame %d : Clearing RA_active flag\n", module_idP, frameP);
403 404 405 406 407 408 409 410
        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]) {
411 412 413 414 415 416 417 418 419 420
        	  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);
        	  }
421
            VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_SDU, VCD_FUNCTION_OUT);
422 423 424
            return;
          }

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

428 429 430 431 432 433 434 435
        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);
        }
436 437 438 439 440 441
      }

      payload_ptr+=6;
      break;

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

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

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

467 468
    if (rx_lcids[i] == CCCH) {

469 470 471 472 473 474
      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]);
475 476

#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
477
      int j;
478

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

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

496
    } else if ((rx_lcids[i] == DCCH) || (rx_lcids[i] == DCCH1)) {
497
      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]);
498 499
      mac_rlc_data_ind(module_idP,
                       UE_mac_inst[module_idP].crnti,
500
		       eNB_index,
501 502 503
                       frameP,
                       ENB_FLAG_NO,
                       MBMS_FLAG_NO,
504
                       rx_lcids[i],
505 506 507 508
                       (char *)payload_ptr,
                       rx_lengths[i],
                       1,
                       NULL);
509

510
    } else if ((rx_lcids[i]  < NB_RB_MAX) && (rx_lcids[i] > DCCH1 )) {
511

512
      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]);
513 514

#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
515
      int j;
516 517
      for (j=0;j<rx_lengths[i];j++)
	LOG_T(MAC,"%x.",(unsigned char)payload_ptr[j]);
518
      LOG_T(MAC,"\n");
519
#endif
520
      mac_rlc_data_ind(module_idP,
521
		       UE_mac_inst[module_idP].crnti,
522 523
		       eNB_index,
		       frameP,
524 525 526 527 528 529 530 531 532
		       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);
533 534
    }
    payload_ptr+= rx_lengths[i];
535
  }
fnabet's avatar
fnabet committed
536
  } // end if (payload_ptr != NULL)
537

538
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SEND_SDU, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
539
#if UE_TIMING_TRACE
540
  stop_meas(&UE_mac_inst[module_idP].rx_dlsch_sdu);
gabrielC's avatar
gabrielC committed
541
#endif
542 543
}

544 545
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
546 547 548
#if UE_TIMING_TRACE
    start_meas(&UE_mac_inst[module_idP].rx_si);
#endif
549
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_DECODE_SI, VCD_FUNCTION_IN);
550

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

553
  mac_rrc_data_ind(module_idP,
554
                   CC_id,
555
                   frameP,0, // unknown subframe
556
                   SI_RNTI,
557 558 559
                   BCCH,
                   (uint8_t *)pdu,
                   len,
560
                   ENB_FLAG_NO,
561 562
                   eNB_index,
                   0);
563
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_DECODE_SI, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
564
#if UE_TIMING_TRACE
565
  stop_meas(&UE_mac_inst[module_idP].rx_si);
gabrielC's avatar
gabrielC committed
566
#endif
navid's avatar
navid committed
567 568 569 570 571 572 573
  if (opt_enabled == 1) {
    trace_pdu(0,
	      (uint8_t *)pdu,
	      len,
	      module_idP,
	      4,
	      0xffff,
574 575
	      UE_mac_inst[module_idP].rxFrame,
	      UE_mac_inst[module_idP].rxSubframe,
navid's avatar
navid committed
576 577 578 579 580
	      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);
  }
581 582
}

583 584
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
585 586 587
#if UE_TIMING_TRACE
    start_meas(&UE_mac_inst[module_idP].rx_p);
#endif
588 589 590 591 592 593 594 595 596 597 598 599 600 601 602
  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
603
#if UE_TIMING_TRACE
604
  stop_meas(&UE_mac_inst[module_idP].rx_p);
gabrielC's avatar
gabrielC committed
605
#endif
606 607 608 609 610 611 612
  if (opt_enabled == 1) {
    trace_pdu(0,
	      (uint8_t *)pdu,
	      len,
	      module_idP,
	      4,
	      P_RNTI,
613 614
	      UE_mac_inst[module_idP].rxFrame,
	      UE_mac_inst[module_idP].rxSubframe,
615 616 617 618 619 620 621
	      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
622
#if defined(Rel10) || defined(Rel14)
623
unsigned char *parse_mch_header(unsigned char *mac_header,
624 625 626 627 628
                                unsigned char *num_sdu,
                                unsigned char *rx_lcids,
                                unsigned short *rx_lengths,
                                unsigned short tb_length)
{
629 630 631
  unsigned char not_done=1, num_sdus=0, lcid, i;
  unsigned char *mac_header_ptr = mac_header;
  unsigned short length;
632

633
  while (not_done == 1) {
634 635 636 637 638 639 640 641 642 643 644
    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);

645
        for (i=0; i<num_sdus; i++) {
646
          length -= rx_lengths[i];
647
        }
648 649 650 651 652 653 654 655 656
      } 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;
        }
657
      }
658 659 660 661 662 663 664 665

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

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

// this function is for sending mch_sdu from phy to mac
673 674
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)
{
675 676

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

684
  LOG_D(MAC,"[UE %d] Frame %d : process the mch PDU for sync area %d \n",module_idP,frameP, sync_area);
685 686
  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);
687 688

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

  for (i=0; i<num_sdu; i++) {
692 693 694 695 696 697 698
    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;
699
      }
700 701 702
    } 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,
703
                       CC_id,
704
                       frameP,0, // unknown subframe
705
                       M_RNTI,
706 707 708 709 710 711 712 713
                       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,
714
          UE_mac_inst[module_idP].crnti,
715 716
          eNB_index,
	  frameP,
717 718 719 720 721 722 723
          ENB_FLAG_NO,
          MBMS_FLAG_YES,
          MTCH, /*+ (maxDRB + 3),*/
          (char *)payload_ptr,
          rx_lengths[i],
          1,
          NULL);
724 725

      }
726 727 728 729 730 731 732 733 734
    } 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);
    }
735

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

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

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

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,
752 753
		    uint8_t eNB_index,
		    sl_discovery_flag_t sl_discovery_flag
Raymond Knopp's avatar
Raymond Knopp committed
754 755
		    ) {

756 757
  int rlc_sdu_len;
  char *rlc_sdu;
758
  uint32_t destinationL2Id =0x00000000;
759

760 761
  if (sl_discovery_flag == SL_DISCOVERY_FLAG_NO) {

762 763 764 765 766 767
  // 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");
768
  AssertFatal(((longh->LCID==3)|(longh->LCID==10)),"LCID is %d (not 3 or 10)\n",longh->LCID);
769 770
  //filter incoming packet based on destination address
  destinationL2Id = (longh->DST07<<16) | (longh->DST815 <<8) | (longh->DST1623);
771
  LOG_I( MAC, "[DestinationL2Id:  0x%08x]  \n", destinationL2Id );
772 773 774 775 776 777
  //match the destinationL2Id with UE L2Id or groupL2ID
  if (!((destinationL2Id == UE_mac_inst[module_idP].sourceL2Id) | (destinationL2Id == UE_mac_inst[module_idP].groupL2Id))){
     LOG_I( MAC, "[Destination Id is neither matched with Source Id nor with Group Id, drop the packet!!! \n");
     return;
  }

778 779 780 781 782 783 784 785
  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
786 787 788 789 790 791 792
  mac_rlc_data_ind(
		   module_idP,
		   0x1234,
		   eNB_index,
		   frameP,
		   ENB_FLAG_NO,
		   MBMS_FLAG_NO,
793
		   longh->LCID, //3/10
794 795
		   rlc_sdu,
		   rlc_sdu_len,
Raymond Knopp's avatar
Raymond Knopp committed
796 797
		   1,
		   NULL);
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814
  } else { //SL_DISCOVERY

     LOG_I( MAC, "SL DISCOVERY \n");
    //call mac_rrc_data_ind
     uint16_t len;
     mac_rrc_data_ind(module_idP,
                      CC_id,
                      frameP,subframeP,
                      UE_mac_inst[module_idP].crnti,
                      SL_DISCOVERY,
                      sdu, //(uint8_t*)&UE_mac_inst[Mod_id].SL_Discovery[0].Rx_buffer.Payload[0],
                      len,
                      ENB_FLAG_NO,
                      eNB_index,
                      0);

  }
Raymond Knopp's avatar
Raymond Knopp committed
815 816 817
}


818 819
int8_t ue_get_mbsfn_sf_alloction (module_id_t module_idP, uint8_t mbsfn_sync_area, unsigned char eNB_index)
{
820
  // currently there is one-to-one mapping between sf allocation pattern and sync area
821 822
  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 );
823
    return -1;
824
  } else if (UE_mac_inst[module_idP].mbsfn_SubframeConfig[mbsfn_sync_area] != NULL) {
825
    return mbsfn_sync_area;
826
  } else {
827
    LOG_W( MAC, "[UE %"PRIu8"] MBSFN Subframe Config pattern %"PRIu8" not found \n", module_idP, mbsfn_sync_area );
828
    return -1;
829 830
  }
}
831

832 833
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)
{
834

winckel's avatar
winckel committed
835
  int i=0, j=0, ii=0, msi_pos=0, mcch_mcs = - 1;
836
  int mcch_flag=0, mtch_flag=0, msi_flag=0;
837 838
  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
839
  int mch_scheduling_period = -1;
840

841
  int frame_FDD=1;
842

843

gabrielC's avatar
gabrielC committed
844
#if UE_TIMING_TRACE
845
  start_meas(&UE_mac_inst[module_idP].ue_query_mch);
gabrielC's avatar
gabrielC committed
846
#endif
847

848
  if (UE_mac_inst[module_idP].pmch_Config[0]) {
849
    mch_scheduling_period = 8<<(UE_mac_inst[module_idP].pmch_Config[0]->mch_SchedulingPeriod_r9);
850
  }
851

852
  for (i=0;
853 854 855
       i< UE_mac_inst[module_idP].num_active_mbsfn_area;
       i++ ) {
    // assume, that there is always a mapping
856
    if ((j=ue_get_mbsfn_sf_alloction(module_idP,i,eNB_index)) == -1) {
857
      return -1; // continue;
858
    }
859 860 861 862 863 864

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

865
    LOG_D(MAC,
Cedric Roux's avatar
Cedric Roux committed
866
          "[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",
867
          module_idP,frameP, subframe,i,UE_mac_inst[module_idP].num_active_mbsfn_area,
868 869 870
          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);

871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902
    // 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++;
            }
          }
        }

903 904
	if (UE_mac_inst[module_idP].tdd_Config == NULL) frame_FDD=1;
	else frame_FDD=0;
905 906 907
        // Check if the subframe is for MSI, MCCH or MTCHs and Set the correspoding flag to 1
        switch (subframe) {
        case 1:
908
          if (frame_FDD==1) {
909
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF1) == MBSFN_FDD_SF1) {
910
              if (msi_pos == 1) {
911
                msi_flag = 1;
912
              }
913

914
	      if ( (frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
915
                   ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF1) == MBSFN_FDD_SF1) ) {
916
                mcch_flag = 1;
917
              }
918 919 920 921 922 923 924 925

              mtch_flag = 1;
            }
          }

          break;

        case 2:
926
          if (frame_FDD==1) {
927
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF2) == MBSFN_FDD_SF2) {
928
              if (msi_pos == 2) {
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_SF2) == MBSFN_FDD_SF2) ) {
934
                mcch_flag = 1;
935
              }
936 937 938 939

              mtch_flag = 1;
            }
          }
940

941 942 943
          break;

        case 3:
944
          if (frame_FDD==0) { //TDD
945
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF3) == MBSFN_TDD_SF3) {
946
              if (msi_pos == 1) {
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_SF3) == MBSFN_TDD_SF3) ) {
952
                mcch_flag = 1;
953
              }
954 955 956 957 958

              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) {
959
              if (msi_pos == 3) {
960
                msi_flag = 1;
961
              }
962 963

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

              mtch_flag = 1;
            }
          }

          break;

        case 4:
975
          if (frame_FDD==0) {
976
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF4) == MBSFN_TDD_SF4) {
977
              if (msi_pos == 2) {
978
                msi_flag = 1;
979
              }
980 981

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
982
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_TDD_SF4) == MBSFN_TDD_SF4) ) {
983
                mcch_flag = 1;
984
              }
985 986 987 988 989 990 991 992

              mtch_flag = 1;
            }
          }

          break;

        case 6:
993
          if (frame_FDD==1) {
994
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_FDD_SF6) == MBSFN_FDD_SF6) {
995
              if (msi_pos == 4) {
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_SF6) == MBSFN_FDD_SF6) ) {
1001
                mcch_flag = 1;
1002
              }
1003 1004 1005

              mtch_flag = 1;
            }
1006
          }
1007 1008 1009 1010

          break;

        case 7:
1011
          if (frame_FDD==0) { // TDD
1012
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF7) == MBSFN_TDD_SF7) {
1013
              if (msi_pos == 3) {
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_SF7) == MBSFN_TDD_SF7) ) {
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_SF7) == MBSFN_FDD_SF7) {
1026
              if (msi_pos == 5) {
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_SF7) == MBSFN_FDD_SF7) ) {
1032
                mcch_flag = 1;
1033
              }
1034 1035 1036

              mtch_flag = 1;
            }
1037
          }
1038 1039 1040 1041

          break;

        case 8:
1042
          if (frame_FDD==0) { //TDD
1043
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF8) == MBSFN_TDD_SF8) {
1044
              if (msi_pos == 4) {
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_SF8) == MBSFN_TDD_SF8) ) {
1050
                mcch_flag = 1;
1051
              }
1052 1053 1054 1055 1056

              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) {
1057
              if (msi_pos == 6) {
1058
                msi_flag = 1;
1059
              }
1060 1061

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
1062
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_FDD_SF8) == MBSFN_FDD_SF8) ) {
1063
                mcch_flag = 1;
1064
              }
1065 1066 1067 1068 1069 1070 1071 1072

              mtch_flag = 1;
            }
          }

          break;

        case 9:
1073
          if (frame_FDD==0) {
1074
            if ((UE_mac_inst[module_idP].mbsfn_SubframeConfig[j]->subframeAllocation.choice.oneFrame.buf[0] & MBSFN_TDD_SF9) == MBSFN_TDD_SF9) {
1075
              if (msi_pos == 5) {
1076
                msi_flag = 1;
1077
              }
1078 1079

              if ((frameP % mcch_period == UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.mcch_Offset_r9) &&
1080
                  ((UE_mac_inst[module_idP].mbsfn_AreaInfo[i]->mcch_Config_r9.sf_AllocInfo_r9.buf[0] & MBSFN_TDD_SF9) == MBSFN_TDD_SF9) ) {
1081
                mcch_flag = 1;
1082
              }
1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099

              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
1100
      }
1101
    }
1102
  } // end of for
gabrielC's avatar
gabrielC committed
1103
#if UE_TIMING_TRACE
1104
  stop_meas(&UE_mac_inst[module_idP].ue_query_mch);
gabrielC's avatar
gabrielC committed
1105
#endif
1106

1107
  if ( (mcch_flag==1)) { // || (msi_flag==1))
1108
    *mcch_active=1;
1109
  }
1110

1111 1112
  if ( (mcch_flag==1) || ((msi_flag==1) && (UE_mac_inst[module_idP].mcch_status==1)) ) {
    return mcch_mcs;
1113
  } else if ((mtch_flag==1) && (UE_mac_inst[module_idP].msi_status==1)) {
1114
    return UE_mac_inst[module_idP].pmch_Config[0]->dataMCS_r9;
1115
  } else {
1116
    return -1;
1117
  }
1118 1119 1120 1121
}

#endif

1122
unsigned char generate_ulsch_header(uint8_t *mac_header,
1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
                                    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)
{
1134 1135 1136 1137 1138 1139 1140

  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
1141

1142
  for (i=0; i<num_sdus; i++) {
1143
    LOG_T(MAC,"[UE] sdu %d : lcid %d length %d",i,sdu_lcids[i],sdu_lengths[i]);
1144
  }
1145

1146 1147 1148 1149 1150
  LOG_T(MAC,"\n");
#endif
  ce_ptr = &mac_header_control_elements[0];

  if ((short_padding == 1) || (short_padding == 2)) {
1151 1152 1153 1154 1155
    mac_header_ptr->R    = 0;
    mac_header_ptr->E    = 0;
    mac_header_ptr->LCID = SHORT_PADDING;
    first_element=1;
    last_size=1;
1156
  }
1157

1158
  if (short_padding == 2) {
1159 1160 1161 1162 1163 1164
    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;
1165 1166 1167
  }

  if (power_headroom) {
1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180
    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
1181
    LOG_D(MAC, "phr header size %zu\n",sizeof(POWER_HEADROOM_CMD));
1182 1183 1184 1185
  }

  if (crnti) {
#ifdef DEBUG_HEADER_PARSING
1186
    LOG_D(MAC,"[UE] CRNTI : %x (first_element %d)\n",*crnti,first_element);
1187
#endif
1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202

    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);
1203 1204 1205
  }

  if (truncated_bsr) {
1206 1207 1208
    if (first_element>0) {
      mac_header_ptr->E = 1;
      /*
1209
      printf("last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
1210 1211 1212 1213 1214 1215 1216 1217 1218
      ((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;
    }

1219
#ifdef DEBUG_HEADER_PARSING
1220
    LOG_D(MAC,"[UE] Scheduler Truncated BSR Header\n");
1221
#endif
1222 1223 1224 1225 1226 1227 1228
    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);
1229

1230 1231 1232 1233
  } else if (short_bsr) {
    if (first_element>0) {
      mac_header_ptr->E = 1;
      /*
1234
      printf("last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
1235 1236 1237 1238 1239 1240 1241 1242 1243
      ((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;
    }

1244
#ifdef DEBUG_HEADER_PARSING
1245
    LOG_D(MAC,"[UE] Scheduler SHORT BSR Header\n");
1246
#endif
1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258
    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;
      /*
1259
      printf("last subheader : %x (R%d,E%d,LCID%d)\n",*(unsigned char*)mac_header_ptr,
1260 1261 1262 1263 1264 1265 1266 1267 1268
      ((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;
    }

1269
#ifdef DEBUG_HEADER_PARSING
1270
    LOG_D(MAC,"[UE] Scheduler Long BSR Header\n");
1271
#endif
1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282
    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);
1283
  }
1284

1285 1286
  //  printf("last_size %d,mac_header_ptr %p\n",last_size,mac_header_ptr);

1287
  for (i=0; i<num_sdus; i++) {
1288
#ifdef DEBUG_HEADER_PARSING
1289
    LOG_T(MAC,"[UE] sdu subheader %d (lcid %d, %d bytes)\n",i,sdu_lcids[i],sdu_lengths[i]);
1290
#endif
1291

1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305
    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];
1306
    }
1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
    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;
1320

1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352
        }

        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
        }
1353
    }
1354
  }
1355

1356
  if (post_padding>0) {// we have lots of padding at the end of the packet
1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367
    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 ++
1368
  }
1369

1370

1371
  if ((ce_ptr-mac_header_control_elements) > 0) {
1372 1373
    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);
1374
  }
1375

1376
#ifdef DEBUG_HEADER_PARSING
Cedric Roux's avatar
Cedric Roux committed
1377
  LOG_T(MAC," [UE] header : ");
1378

1379
  for (i=0; i<((unsigned char*)mac_header_ptr - mac_header); i++) {
1380
    LOG_T(MAC,"%2x.",mac_header[i]);
1381
  }
1382

1383 1384 1385 1386 1387 1388
  LOG_T(MAC,"\n");
#endif
  return((unsigned char*)mac_header_ptr - mac_header);

}

1389 1390
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)
{
1391

hbilel's avatar
hbilel committed
1392 1393
  uint8_t total_rlc_pdu_header_len=0, rlc_pdu_header_len_last=0 ;
  uint16_t buflen_remain = 0;
1394
  uint8_t bsr_len=0,bsr_ce_len=0,bsr_header_len=0;
1395
  uint8_t phr_header_len=0, phr_ce_len=0,phr_len=0;
1396
  uint8_t lcid=0,lcid_rlc_pdu_count=0;
hbilel's avatar
hbilel committed
1397
  boolean_t is_lcid_processed = FALSE;
1398
  boolean_t is_all_lcid_processed = FALSE;
1399 1400 1401 1402 1403
  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
1404
  BSR_SHORT bsr_short,bsr_truncated;
1405 1406 1407
  BSR_LONG bsr_long;
  BSR_SHORT *bsr_s=&bsr_short;
  BSR_LONG  *bsr_l=&bsr_long;
calvin wang's avatar
calvin wang committed
1408
  BSR_SHORT *bsr_t=&bsr_truncated;
1409 1410
  POWER_HEADROOM_CMD phr;
  POWER_HEADROOM_CMD *phr_p=&phr;
fnabet's avatar
fnabet committed
1411
  unsigned short short_padding=0, post_padding=0, padding_len=0;
1412 1413
  int j; // used for padding
  // Compute header length
hbilel's avatar
hbilel committed
1414
  int lcg_id = 0;
1415 1416
  int lcg_id_bsr_trunc = 0;
  int highest_priority = 16;
hbilel's avatar
hbilel committed
1417
  int num_lcg_id_with_data = 0;
1418
  rlc_buffer_occupancy_t lcid_buffer_occupancy_old=0, lcid_buffer_occupancy_new=0;
1419

hbilel's avatar
hbilel committed
1420 1421
  LOG_D(MAC,"[UE %d] MAC PROCESS UL TRANSPORT BLOCK at frame%d subframe %d TBS=%d\n",
                        module_idP, frameP, subframe, buflen);
1422

1423

1424 1425
  AssertFatal(CC_id==0,
	      "Transmission on secondary CCs is not supported yet\n");
1426

gabrielC's avatar
gabrielC committed
1427
#if UE_TIMING_TRACE
1428
  start_meas(&UE_mac_inst[module_idP].tx_ulsch_sdu);
gabrielC's avatar
gabrielC committed
1429
#endif
1430
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_GET_SDU, VCD_FUNCTION_IN);
1431

Cedric Roux's avatar
Cedric Roux committed
1432
#ifdef CBA
1433 1434 1435

  if (*access_mode==CBA_ACCESS) {
    LOG_D(MAC,"[UE %d] frameP %d subframe %d try CBA transmission\n",
1436
          module_idP, frameP, subframe);
1437 1438 1439 1440

    //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;
1441
      VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_GET_SDU, VCD_FUNCTION_OUT);
1442 1443 1444 1445
      return;
    }

    LOG_I(MAC,"[UE %d] frameP %d subframe %d CBA transmission oppurtunity, tbs %d\n",
1446
          module_idP, frameP, subframe,buflen);
1447
  }
1448

1449
#endif
hbilel's avatar
hbilel committed
1450
  bsr_header_len = 0;
1451
  phr_header_len = 1;//sizeof(SCH_SUBHEADER_FIXED);
1452

hbilel's avatar
hbilel committed
1453 1454 1455 1456 1457 1458 1459 1460
  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
1461 1462 1463 1464 1465 1466 1467 1468 1469 1470
      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
1471 1472

  }
GabrirelCouturier's avatar
GabrirelCouturier committed
1473 1474 1475
  //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
1476
  }
GabrirelCouturier's avatar
GabrirelCouturier committed
1477

hbilel's avatar
hbilel committed
1478
  // periodicBSR-Timer expires, trigger BSR
Cedric Roux's avatar
Cedric Roux committed
1479
  if ((UE_mac_inst[module_idP].scheduling_info.periodicBSR_Timer != PeriodicBSR_Timer_r12_infinity)
hbilel's avatar
hbilel committed
1480
            && (UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF == 0)){
1481 1482
        // Trigger BSR Periodic
      UE_mac_inst[module_idP].BSR_reporting_active |= BSR_TRIGGER_PERIODIC;
hbilel's avatar
hbilel committed
1483

1484
      LOG_D(MAC,"[UE %d] MAC BSR Triggered PeriodicBSR Timer expiry at frame%d subframe %d TBS=%d\n",
hbilel's avatar
hbilel committed
1485 1486 1487 1488
                       module_idP, frameP, subframe, buflen);

    }

1489 1490
  //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
1491
  if (UE_mac_inst[module_idP].BSR_reporting_active){
GabrirelCouturier's avatar
GabrirelCouturier committed
1492

1493 1494
	  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
1495

1496 1497 1498 1499 1500
      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
1501 1502 1503
              bsr_ce_len = sizeof(BSR_SHORT); //1 byte
          }
          else{
fnabet's avatar
fnabet committed
1504
              bsr_ce_len = BSR_LONG_SIZE; //3 bytes
hbilel's avatar
hbilel committed
1505 1506 1507 1508
          }
      }
  }

1509
  bsr_len = bsr_ce_len + bsr_header_len;
1510

fnabet's avatar
fnabet committed
1511
  phr_ce_len = (UE_mac_inst[module_idP].PHR_reporting_active == 1) ? 1 /* sizeof(POWER_HEADROOM_CMD)*/: 0;
1512
  if ((phr_ce_len > 0) && ((phr_ce_len + phr_header_len + bsr_len) <= buflen)){
1513 1514
    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",
1515
          module_idP, phr_len, phr_ce_len, phr_header_len, buflen);
1516
  } else {
1517
    phr_len=0;
1518 1519
    phr_header_len = 0;
    phr_ce_len = 0;
1520
  }
1521 1522

  // check for UL bandwidth requests and add SR control element
1523 1524

  // check for UL bandwidth requests and add SR control element
1525 1526

  // Check for DCCH first
1527 1528
// 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
1529
  if (UE_mac_inst[module_idP].scheduling_info.LCID_status[lcid] == LCID_NOT_EMPTY) {
1530

1531
      lcid_rlc_pdu_count = 0;
1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548
      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]]);

1549

hbilel's avatar
hbilel committed
1550 1551
      //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
1552
      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)) {
1553

fnabet's avatar
fnabet committed
1554 1555 1556 1557 1558 1559 1560
    	  // 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;
    	  }

1561
          buflen_remain = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + 1);
hbilel's avatar
hbilel committed
1562 1563


1564 1565 1566 1567 1568 1569
		  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,
1570 1571 1572 1573 1574 1575 1576 1577
							   UE_mac_inst[module_idP].crnti,
							   eNB_index,
							   frameP,
							   ENB_FLAG_NO,
							   MBMS_FLAG_NO,
							   lcid,
							   buflen_remain,
							   (char *)&ulsch_buff[sdu_length_total]);
1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631


		  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);
1632
   }
1633

1634
    //Update Buffer remain and BSR bytes after transmission
1635

1636 1637
    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);
1638

1639 1640
    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);
1641

1642 1643 1644 1645 1646 1647
    //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
1648
        {
1649 1650
            bsr_ce_len = sizeof(BSR_SHORT);
            bsr_len = bsr_ce_len + bsr_header_len;
hbilel's avatar
hbilel committed
1651
        }
1652
    }
hbilel's avatar
hbilel committed
1653 1654


1655 1656
    UE_mac_inst[module_idP].scheduling_info.LCID_status[lcid] = LCID_EMPTY;
   }
hbilel's avatar
hbilel committed
1657 1658
 }

fnabet's avatar
fnabet committed
1659

1660

1661 1662 1663
  // 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
1664 1665
  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]);
1666 1667 1668 1669 1670

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

1673

GabrirelCouturier's avatar
GabrirelCouturier committed
1674 1675
  if (bsr_ce_len) {
      //Print updated BSR when sent
hbilel's avatar
hbilel committed
1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687
      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
1688 1689 1690 1691
              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]);
1692 1693 1694
  }


1695
  // build PHR and update the timers
1696
  if (phr_ce_len == sizeof(POWER_HEADROOM_CMD)) {
1697 1698 1699 1700 1701 1702 1703 1704
	  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
1705 1706
    phr_p->R  = 0;
    LOG_D(MAC,"[UE %d] Frame %d report PHR with mapping (%d->%d) for LCID %d\n",
1707
          module_idP,frameP, get_PHR(module_idP,CC_id,eNB_index), phr_p->PH,POWER_HEADROOM);
Raymond Knopp's avatar
 
Raymond Knopp committed
1708
    update_phr(module_idP,CC_id);
1709
  } else {
1710
    phr_p=NULL;
1711
  }
1712

1713

1714
  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);
1715

1716

1717
  // Check BSR padding: it is done after PHR according to Logical Channel Prioritization order
hbilel's avatar
hbilel committed
1718
  // Check for max padding size, ie MAC Hdr for last RLC PDU = 1
1719 1720 1721 1722 1723 1724
  /* 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
1725
  if (sdu_length_total) {
1726
      padding_len = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len - rlc_pdu_header_len_last + sdu_length_total + 1);
1727
  }
hbilel's avatar
hbilel committed
1728 1729 1730 1731
  else {
      padding_len = buflen - (bsr_len + phr_len);
  }

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 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788
   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
1789
     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,
1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803
    	   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
1804
         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
1805
               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);
1806 1807 1808 1809 1810 1811 1812 1813

     }
     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
1814
         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
1815
               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);
1816 1817 1818
     }
   }

hbilel's avatar
hbilel committed
1819 1820 1821
// 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) {
1822
       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
1823 1824 1825 1826 1827
   }
   else {
       padding_len = buflen - (bsr_len + phr_len);
   }

fnabet's avatar
fnabet committed
1828 1829 1830
  if (padding_len <= 2) {
    short_padding = padding_len;
    // only add padding header
1831
    post_padding = 0;
hbilel's avatar
hbilel committed
1832 1833
    //update total MAC Hdr size for RLC data
    if (sdu_length_total) {
1834
        total_rlc_pdu_header_len = total_rlc_pdu_header_len - rlc_pdu_header_len_last + 1;
hbilel's avatar
hbilel committed
1835
        rlc_pdu_header_len_last = 1;
1836
   }
hbilel's avatar
hbilel committed
1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848
  }
  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
1849
    if (padding_len == buflen) {// nona mac pdu
1850 1851 1852 1853 1854
      *access_mode=CANCELED_ACCESS;
    }

    short_padding = 0;

hbilel's avatar
hbilel committed
1855
    post_padding = buflen - (bsr_len + phr_len + total_rlc_pdu_header_len + sdu_length_total + 1);
1856
  }
1857

1858 1859
  // Generate header
  // if (num_sdus>0) {
1860

1861
  payload_offset = generate_ulsch_header(ulsch_buffer,  // mac header
1862 1863 1864 1865 1866 1867
                                         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
1868
                                         bsr_t,  // truncated bsr
1869 1870 1871 1872
                                         bsr_s, // short bsr
                                         bsr_l,
                                         post_padding); // long_bsr

1873
  LOG_D(MAC,
hbilel's avatar
hbilel committed
1874 1875
        "[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,
1876
        short_padding,post_padding, bsr_len, phr_len,buflen-sdu_length_total-payload_offset);
1877
  // cycle through SDUs and place in ulsch_buffer
hbilel's avatar
hbilel committed
1878 1879 1880
  if (sdu_length_total) {
      memcpy(&ulsch_buffer[payload_offset],ulsch_buff,sdu_length_total);
  }
1881

1882
  // fill remainder of DLSCH with random data
1883 1884 1885 1886
  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);
      }
1887
  }
Cedric Roux's avatar
Cedric Roux committed
1888
  LOG_D(MAC,"[UE %d][SR] Gave SDU to PHY, clearing any scheduling request\n", module_idP);
1889 1890
  UE_mac_inst[module_idP].scheduling_info.SR_pending=0;
  UE_mac_inst[module_idP].scheduling_info.SR_COUNTER=0;
1891 1892 1893 1894

  /* Actions when a BSR is sent */
  if (bsr_ce_len)
  {
hbilel's avatar
hbilel committed
1895 1896 1897
      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);

1898 1899 1900
	  // 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
1901
	  LOG_D(MAC,"[UE %d] MAC ReTx BSR Timer Reset =%d\n", module_idP,
1902 1903 1904
			  UE_mac_inst[module_idP].scheduling_info.retxBSR_SF);

	  // Reset Periodic Timer except when BSR is truncated
Cedric Roux's avatar
Cedric Roux committed
1905
	  if ((bsr_t == NULL) && (UE_mac_inst[module_idP].scheduling_info.periodicBSR_Timer != PeriodicBSR_Timer_r12_infinity))
1906 1907 1908
	  {
		  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
1909
		  LOG_D(MAC,"[UE %d] MAC Periodic BSR Timer Reset =%d\n",
Cedric Roux's avatar
Cedric Roux committed
1910
		        module_idP, UE_mac_inst[module_idP].scheduling_info.periodicBSR_SF);
1911 1912 1913 1914 1915

	  }

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

1918
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_GET_SDU, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
1919
#if UE_TIMING_TRACE
1920
  stop_meas(&UE_mac_inst[module_idP].tx_ulsch_sdu);
gabrielC's avatar
gabrielC committed
1921
#endif
1922

1923

navid's avatar
navid committed
1924
  if (opt_enabled) {
1925
    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
1926
    LOG_D(OPT,"[UE %d][ULSCH] Frame %d subframe %d trace pdu for rnti %x  with size %d\n",
1927
          module_idP, frameP, subframe, UE_mac_inst[module_idP].crnti, buflen);
navid's avatar
navid committed
1928
  }
1929 1930
}

1931 1932


1933
//------------------------------------------------------------------------------
1934 1935 1936 1937 1938 1939 1940
// 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

1941 1942 1943
UE_L2_STATE_t
ue_scheduler(
  const module_id_t    module_idP,
1944 1945 1946 1947
  const frame_t        rxFrameP,
  const sub_frame_t    rxSubframeP,
  const frame_t        txFrameP,
  const sub_frame_t    txSubframeP,
1948 1949 1950 1951
  const lte_subframe_t directionP,
  const uint8_t        eNB_indexP,
  const int            CC_id)
//------------------------------------------------------------------------------
1952
{
1953 1954
  int lcid; // lcid index
  int TTI= 1;
winckel's avatar
winckel committed
1955 1956
  int bucketsizeduration = -1;
  int bucketsizeduration_max = -1;
1957
  // mac_rlc_status_resp_t rlc_status[MAX_NUM_LCGID]; // 4
1958
  // int8_t lcg_id;
1959
  struct RACH_ConfigCommon *rach_ConfigCommon = (struct RACH_ConfigCommon *)NULL;
1960
  protocol_ctxt_t   ctxt;
GabrirelCouturier's avatar
GabrirelCouturier committed
1961

1962
#if defined(ENABLE_ITTI)
1963 1964 1965 1966
  MessageDef   *msg_p;
  const char   *msg_name;
  instance_t    instance;
  int           result;
1967
#endif
gabrielC's avatar
gabrielC committed
1968
#if UE_TIMING_TRACE
1969
  start_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
1970
#endif
1971
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_IN);
1972

1973
  PROTOCOL_CTXT_SET_BY_MODULE_ID(&ctxt, module_idP, ENB_FLAG_NO, UE_mac_inst[module_idP].crnti, txFrameP, txSubframeP,eNB_indexP);
1974 1975
#if defined(ENABLE_ITTI)

1976 1977 1978
  do {
    // Checks if a message has been sent to MAC sub-task
    itti_poll_msg (TASK_MAC_UE, &msg_p);
1979

1980 1981 1982
    if (msg_p != NULL) {
      msg_name = ITTI_MSG_NAME (msg_p);
      instance = ITTI_MSG_INSTANCE (msg_p);
1983

1984 1985 1986 1987 1988
      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);
1989

1990 1991
        // TODO process CCCH data req.
        break;
1992 1993


1994 1995 1996
      default:
        LOG_E(MAC, "Received unexpected message %s\n", msg_name);
        break;
1997
      }
1998 1999 2000 2001

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

2004 2005
#endif

2006 2007
  //Mac_rlc_xface->frameP=frameP;
  //Rrc_xface->Frame_index=Mac_rlc_xface->frameP;
2008
  //if (subframe%5 == 0)
2009
  //LG#ifdef EXMIMO
2010
  pdcp_run(&ctxt);
2011
  //#endif
2012 2013 2014 2015
  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;
2016 2017

#ifdef CELLULAR
2018
  rrc_rx_tx(module_idP, txFrameP, 0, eNB_indexP);
2019
#else
2020

2021
  switch (rrc_rx_tx(&ctxt,
2022 2023
                    eNB_indexP,
                    CC_id)) {
2024 2025
  case RRC_OK:
    break;
2026

2027 2028
  case RRC_ConnSetup_failed:
    LOG_E(MAC,"RRCConnectionSetup failed, returning to IDLE state\n");
2029
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2030
#if UE_TIMING_TRACE
2031
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2032
#endif
2033 2034
    return(CONNECTION_LOST);
    break;
2035

2036 2037
  case RRC_PHY_RESYNCH:
    LOG_E(MAC,"RRC Loss of synch, returning PHY_RESYNCH\n");
2038
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2039
#if UE_TIMING_TRACE
2040
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2041
#endif
2042
    return(PHY_RESYNCH);
2043

2044
  case RRC_Handover_failed:
2045
    LOG_N(MAC,"Handover failure for UE %d eNB_index %d\n",module_idP,eNB_indexP);
2046
    //Invalid...need to add another MAC UE state for re-connection procedure
2047
    phy_config_afterHO_ue(module_idP,0,eNB_indexP,(MobilityControlInfo_t *)NULL,1);
2048 2049
    //return(3);
    break;
2050

2051 2052
  case RRC_HO_STARTED:
    LOG_I(MAC,"RRC handover, Instruct PHY to start the contention-free PRACH and synchronization\n");
2053
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2054
#if UE_TIMING_TRACE
2055
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2056
#endif
2057
    return(PHY_HO_PRACH);
2058

2059 2060 2061
  default:
    break;
  }
2062

2063
#endif
2064 2065

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

2068
    if (UE_mac_inst[module_idP].radioResourceConfigCommon) {
2069
      rach_ConfigCommon = &UE_mac_inst[module_idP].radioResourceConfigCommon->rach_ConfigCommon;
2070
    } else {
2071
      LOG_E(MAC,"FATAL: radioResourceConfigCommon is NULL!!!\n");
2072
      VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
2073

2074
      stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
2075
      AssertFatal(1==0,"");
2076

gabrielC's avatar
gabrielC committed
2077
#if UE_TIMING_TRACE
2078
      stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2079
#endif
2080 2081
      //return(RRC_OK);
    }
2082

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

2086 2087 2088 2089 2090 2091 2092 2093
    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);
2094
      ra_failed(module_idP,0,eNB_indexP);
2095
    }
2096 2097 2098
  }


2099
  // Get RLC status info and update Bj for all lcids that are active
fnabet's avatar
fnabet committed
2100
  for (lcid=DCCH; lcid < MAX_NUM_LCID; lcid++ ) {
2101
    if (UE_mac_inst[module_idP].logicalChannelConfig[lcid]) {
2102 2103 2104 2105 2106 2107 2108
      // 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);
2109
          AssertFatal(1==0,"");
2110 2111
        }

2112
        if ( UE_mac_inst[module_idP].scheduling_info.Bj[lcid] > bucketsizeduration_max ) {
2113
          UE_mac_inst[module_idP].scheduling_info.Bj[lcid] = bucketsizeduration_max;
2114
        } else {
2115
          UE_mac_inst[module_idP].scheduling_info.Bj[lcid] = bucketsizeduration;
2116
        }
2117 2118
      }

2119

2120
      /*
2121 2122 2123
      if (lcid == DCCH) {
        LOG_D(MAC,"[UE %d][SR] Frame %d subframe %d Pending data for SRB1=%d for LCGID %d \n",
        module_idP, txFrameP,txSubframeP,UE_mac_inst[module_idP].scheduling_info.BSR[UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]],
2124
//         UE_mac_inst[module_idP].scheduling_info.LCGID[lcid]);
2125
      }
2126
      */
2127
    }
2128
  }
2129

2130
  // Call BSR procedure as described in Section 5.4.5 in 36.321
GabrirelCouturier's avatar
GabrirelCouturier committed
2131

2132 2133 2134 2135 2136 2137
  // 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
2138

2139 2140 2141 2142
  // 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--;
2143
    }
GabrirelCouturier's avatar
GabrirelCouturier committed
2144

2145
  //Check whether Regular BSR is triggered
hbilel's avatar
hbilel committed
2146
  if (update_bsr(module_idP,txFrameP, txSubframeP,eNB_indexP) == TRUE) {
2147 2148 2149 2150 2151 2152
  // 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
2153
          module_idP, txFrameP,txSubframeP);
2154
  }
2155

2156
  // UE has no valid phy config dedicated ||  no valid/released  SR
2157
  if ((UE_mac_inst[module_idP].physicalConfigDedicated == NULL)) {
2158 2159 2160 2161
    // 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);
2162
    VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2163
#if UE_TIMING_TRACE
2164
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
gabrielC's avatar
gabrielC committed
2165
#endif
2166
    return(CONNECTION_OK);
2167 2168
  }

2169
  if ((UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig == NULL) ||
2170
      (UE_mac_inst[module_idP].physicalConfigDedicated->schedulingRequestConfig->present == SchedulingRequestConfig_PR_release)) {
2171

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

2174 2175 2176 2177
    // 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);
2178 2179 2180
  }

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

2184 2185 2186 2187 2188 2189
    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) &&
2190
          ((get_PL(module_idP,0,eNB_indexP) <  UE_mac_inst[module_idP].scheduling_info.PathlossChange_db) ||
2191 2192
           (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
2193
      {
2194
        UE_mac_inst[module_idP].PHR_reporting_active = 1;
2195
      } else if (UE_mac_inst[module_idP].PHR_reporting_active ==0 ) {
2196
        UE_mac_inst[module_idP].scheduling_info.prohibitPHR_SF--;
2197
      }
2198

2199
      if (UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF <= 0 )
2200
        // trigger PHR and reset the timer later when the PHR report is sent
2201
      {
2202
        UE_mac_inst[module_idP].PHR_reporting_active = 1;
2203
      } else if (UE_mac_inst[module_idP].PHR_reporting_active == 0 ) {
2204
        UE_mac_inst[module_idP].scheduling_info.periodicPHR_SF--;
2205
      }
2206
    }
2207
  } else {    // release / nothing
2208
    UE_mac_inst[module_idP].PHR_reporting_active = 0; // release PHR
2209
  }
2210

2211
  //If the UE has UL resources allocated for new transmission for this TTI here:
2212
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_UE_SCHEDULER, VCD_FUNCTION_OUT);
gabrielC's avatar
gabrielC committed
2213 2214 2215
#if UE_TIMING_TRACE
    stop_meas(&UE_mac_inst[module_idP].ue_scheduler);
#endif
2216 2217 2218 2219 2220
  return(CONNECTION_OK);
}

// to be improved
#ifdef CBA
2221
extern int cba_backoff;
2222 2223
double uniform_rngen(int min, int max)
{
2224 2225 2226 2227
  double random = (double)taus()/((double)0xffffffff);
  return (max - min) * random + min;
}

2228 2229
int cba_access(module_id_t module_idP,frame_t frameP,sub_frame_t subframe, uint8_t eNB_index,uint16_t buflen)
{
2230

2231 2232 2233 2234
  mac_rlc_status_resp_t rlc_status;
  int header_offset=4;
  int rv =0;

2235
  /*
2236 2237 2238 2239 2240
  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
2241
      //  LOG_D(MAC,"[UE %d] Frame %d Subframe %d: the current CBA backoff is %d \n", module_idP, frameP, subframe,
2242 2243
      //  UE_mac_inst[module_idP].cba_last_access[0] );

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

2248
      rv=1;
2249 2250 2251 2252 2253 2254 2255 2256
  } 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",
2257
          module_idP, frameP, subframe,
2258 2259
          UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);

2260 2261 2262 2263
  } 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) ){
2264
    UE_mac_inst[module_idP].cba_last_access[0]-=1;
2265
    }*/
2266

2267
  if ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID0]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID0]<64) ) {
2268
    return 0;
2269
  }
2270

2271 2272
  if ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1] <= 0 ) &&
      (UE_mac_inst[module_idP].scheduling_info.BSR[LCGID2] <= 0 ) &&
2273
      (UE_mac_inst[module_idP].scheduling_info.BSR[LCGID3] <= 0 ) ) {
2274
    return 0;
2275
  }
2276

2277
  if (cba_backoff == 0 ) { // apply probablisitc method
2278
    UE_mac_inst[module_idP].cba_last_access[0]= uniform_rngen(0,1);
2279 2280

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

2284 2285
      rv=1;
    }
2286 2287
  } else {

2288 2289
    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));
2290

2291
      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,
2292 2293 2294 2295
            UE_mac_inst[module_idP].cba_last_access[0], cba_backoff,UE_mac_inst[module_idP].ul_active);

      rv = 1;
      /*
2296
      rlc_status = mac_rlc_status_ind(module_idP, UE_mac_inst[module_idP].crnti,frameP,ENB_FLAG_NO,MBMS_FLAG_NO, // eNB_index
2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310
      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);
2311 2312 2313 2314
      */
    } 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",
2315 2316 2317
            module_idP, frameP, subframe,
            UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);
    }
2318
  }
2319

2320 2321 2322
  return rv;
  /*
    if (( ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]>0)&&(UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]<64))   ||
2323 2324 2325 2326 2327
    ((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) ) {

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

2330
      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,
2331 2332 2333 2334
      UE_mac_inst[module_idP].cba_last_access[0], cba_backoff,UE_mac_inst[module_idP].ul_active);

      rv = 1;

2335
    rlc_status = mac_rlc_status_ind(module_idP, UE_mac_inst[module_idP].crnti,frameP,ENB_FLAG_NO,MBMS_FLAG_NO, // eNB_index
2336 2337 2338
            DTCH,
            0);

2339
    if ((
2340 2341 2342 2343 2344
   // (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 )
   )){
2345
      rv = 1;
2346

2347 2348
      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,
2349 2350
      UE_mac_inst[module_idP].cba_last_access[0], UE_mac_inst[module_idP].ul_active);
    } else
2351
      UE_mac_inst[module_idP].cba_last_access[0]= round(uniform_rngen(1,5));
2352

2353 2354

    } else if (( ((UE_mac_inst[module_idP].scheduling_info.BSR[LCGID1]> 0 ))   ||
2355 2356 2357 2358
     ((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) )
2359
      {
2360 2361 2362 2363 2364

  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);
2365 2366
      }
  }
2367 2368
  */

2369 2370 2371 2372
}
#endif


2373
boolean_t  update_bsr(module_id_t module_idP, frame_t frameP, sub_frame_t subframeP,eNB_index_t eNB_index)
2374
{
2375 2376

  mac_rlc_status_resp_t rlc_status;
2377 2378 2379 2380 2381
  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};
2382
  int32_t lcid_bytes_in_buffer[MAX_NUM_LCID];
2383 2384 2385 2386 2387 2388 2389 2390
  /* 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
2391
  lcid_bytes_in_buffer[0] = 0;
2392 2393 2394 2395 2396
  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;
2397
  }
2398

hbilel's avatar
hbilel committed
2399
  for (lcgid=0; lcgid < MAX_NUM_LCGID; lcgid++)
2400 2401 2402 2403
  {
	  // Reset Buffer Info
	  UE_mac_inst[module_idP].scheduling_info.BSR[lcgid]=0;
	  UE_mac_inst[module_idP].scheduling_info.BSR_bytes[lcgid]=0;
2404
  }
Raymond Knopp's avatar
 
Raymond Knopp committed
2405

2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418
  //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];
		  	}

2419
		    rlc_status = mac_rlc_status_ind(module_idP, UE_mac_inst[module_idP].crnti,eNB_index,frameP,subframeP,ENB_FLAG_NO,MBMS_FLAG_NO,
2420
		                                    lcid,
2421
		                                    0xFFFF); //TBS is not used in RLC at this step, set a special value for debug
2422 2423 2424 2425 2426

		    lcid_bytes_in_buffer[lcid] = rlc_status.bytes_in_buffer;

		    if (rlc_status.bytes_in_buffer > 0)
		    {
hbilel's avatar
hbilel committed
2427 2428
		          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);
2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459

		         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
2460

2461
  }
2462

2463 2464 2465
  // 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
2466 2467 2468
          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]);

2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482
	  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
2483 2484
		      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);
2485 2486 2487 2488 2489 2490 2491 2492 2493 2494

			  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
2495 2496 2497 2498
		  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);
		  }
2499 2500

	  }
2501
  }
2502

2503 2504 2505 2506
  //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];
2507
  }
2508

2509
  return bsr_regular_triggered;
2510 2511
}

fnabet's avatar
fnabet committed
2512
uint8_t locate_BsrIndexByBufferSize (const uint32_t *table, int size, int value)
2513
{
2514

2515
  uint8_t ju, jm, jl;
2516 2517
  int ascend;

2518 2519 2520
  DevAssert( size > 0 );
  DevAssert( size <= 256 );

2521 2522 2523
  if (value == 0) {
    return 0;  //elseif (value > 150000) return 63;
  }
2524

2525 2526
  jl = 0;        // lower bound
  ju = size - 1; // upper bound
2527 2528 2529
  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,
2530 2531
    jm = (ju+jl) >> 1; //compute a midpoint,

2532
    if ((value >= table[jm]) == ascend) {
2533
      jl=jm; // replace the lower limit
2534
    } else {
2535
      ju=jm; //replace the upper limit
2536
    }
2537 2538

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

2541 2542 2543 2544 2545
  if (value == table[jl]) {
    return jl;
  } else                    {
    return jl+1;  //equally  ju
  }
2546 2547 2548

}

2549 2550
int get_sf_periodicBSRTimer(uint8_t sf_offset)
{
2551 2552

  switch (sf_offset) {
Cedric Roux's avatar
Cedric Roux committed
2553
  case PeriodicBSR_Timer_r12_sf5:
2554 2555
    return 5;
    break;
2556

Cedric Roux's avatar
Cedric Roux committed
2557
  case PeriodicBSR_Timer_r12_sf10:
2558 2559
    return 10;
    break;
2560

Cedric Roux's avatar
Cedric Roux committed
2561
  case PeriodicBSR_Timer_r12_sf16:
2562 2563
    return 16;
    break;
2564

Cedric Roux's avatar
Cedric Roux committed
2565
  case PeriodicBSR_Timer_r12_sf20:
2566 2567
    return 20;
    break;
2568

Cedric Roux's avatar
Cedric Roux committed
2569
  case PeriodicBSR_Timer_r12_sf32:
2570 2571
    return 32;
    break;
2572

Cedric Roux's avatar
Cedric Roux committed
2573
  case PeriodicBSR_Timer_r12_sf40:
2574 2575
    return 40;
    break;
2576

Cedric Roux's avatar
Cedric Roux committed
2577
  case PeriodicBSR_Timer_r12_sf64:
2578 2579
    return 64;
    break;
2580

Cedric Roux's avatar
Cedric Roux committed
2581
  case PeriodicBSR_Timer_r12_sf80:
2582 2583
    return 80;
    break;
2584

Cedric Roux's avatar
Cedric Roux committed
2585
  case PeriodicBSR_Timer_r12_sf128:
2586 2587
    return 128;
    break;
2588

Cedric Roux's avatar
Cedric Roux committed
2589
  case PeriodicBSR_Timer_r12_sf160:
2590 2591
    return 160;
    break;
2592

Cedric Roux's avatar
Cedric Roux committed
2593
  case PeriodicBSR_Timer_r12_sf320:
2594 2595
    return 320;
    break;
2596

Cedric Roux's avatar
Cedric Roux committed
2597
  case PeriodicBSR_Timer_r12_sf640:
2598 2599
    return 640;
    break;
2600

Cedric Roux's avatar
Cedric Roux committed
2601
  case PeriodicBSR_Timer_r12_sf1280:
2602 2603
    return 1280;
    break;
2604

Cedric Roux's avatar
Cedric Roux committed
2605
  case PeriodicBSR_Timer_r12_sf2560:
2606 2607
    return 2560;
    break;
2608

Cedric Roux's avatar
Cedric Roux committed
2609
  case PeriodicBSR_Timer_r12_infinity:
2610
  default:
calvin wang's avatar
calvin wang committed
2611
    return 0xFFFF;
2612 2613 2614 2615
    break;
  }
}

2616 2617
int get_sf_retxBSRTimer(uint8_t sf_offset)
{
2618 2619

  switch (sf_offset) {
Cedric Roux's avatar
Cedric Roux committed
2620
  case RetxBSR_Timer_r12_sf320:
2621 2622
    return 320;
    break;
2623

Cedric Roux's avatar
Cedric Roux committed
2624
  case RetxBSR_Timer_r12_sf640:
2625 2626
    return 640;
    break;
2627

Cedric Roux's avatar
Cedric Roux committed
2628
  case RetxBSR_Timer_r12_sf1280:
2629 2630
    return 1280;
    break;
2631

Cedric Roux's avatar
Cedric Roux committed
2632
  case RetxBSR_Timer_r12_sf2560:
2633 2634
    return 2560;
    break;
2635

Cedric Roux's avatar
Cedric Roux committed
2636
  case RetxBSR_Timer_r12_sf5120:
2637 2638
    return 5120;
    break;
2639

Cedric Roux's avatar
Cedric Roux committed
2640
  case RetxBSR_Timer_r12_sf10240:
2641 2642
    return 10240;
    break;
2643

2644 2645 2646 2647 2648
  default:
    return -1;
    break;
  }
}
2649 2650
int get_ms_bucketsizeduration(uint8_t bucketsizeduration)
{
2651 2652 2653 2654 2655

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

2657 2658 2659
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms100:
    return 100;
    break;
2660

2661 2662 2663
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms150:
    return 150;
    break;
2664

2665 2666 2667
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms300:
    return 300;
    break;
2668

2669 2670 2671
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms500:
    return 500;
    break;
2672

2673 2674 2675
  case LogicalChannelConfig__ul_SpecificParameters__bucketSizeDuration_ms1000:
    return 1000;
    break;
2676

2677 2678 2679 2680 2681 2682
  default:
    return 0;
    break;
  }
}

2683 2684
void update_phr(module_id_t module_idP,int CC_id)
{
Raymond Knopp's avatar
 
Raymond Knopp committed
2685

2686 2687
  AssertFatal(CC_id==0,
	      "Transmission on secondary CCs is not supported yet\n");
2688 2689 2690 2691 2692

  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);
2693
}
2694 2695
uint8_t get_phr_mapping (module_id_t module_idP, int CC_id, uint8_t eNB_index)
{
2696

2697 2698
  AssertFatal(CC_id==0,
	      "Transmission on secondary CCs is not supported yet\n");
2699

2700 2701
  //power headroom reporting range is from -23 ...+40 dB, as described in 36313
  //note: mac_xface->get_Po_NOMINAL_PUSCH(module_idP) is float
2702
  if (get_PHR(module_idP,CC_id,eNB_index) < -23) {
2703
    return 0;
2704
  } else if (get_PHR(module_idP,CC_id,eNB_index) >= 40) {
2705
    return 63;
2706
  } else { // -23 to 40
2707
    return  (uint8_t) get_PHR(module_idP,CC_id,eNB_index) + PHR_MAPPING_OFFSET;
2708

2709
  }
2710
}
2711 2712
int get_sf_perioidicPHR_Timer(uint8_t perioidicPHR_Timer)
{
2713 2714 2715 2716
  return (perioidicPHR_Timer+1)*10;
}


2717 2718
int get_sf_prohibitPHR_Timer(uint8_t prohibitPHR_Timer)
{
2719 2720 2721
  return (prohibitPHR_Timer)*10;
}

2722 2723 2724
int get_db_dl_PathlossChange(uint8_t dl_PathlossChange)
{
  switch (dl_PathlossChange) {
2725 2726 2727
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_dB1:
    return 1;
    break;
2728

2729 2730 2731
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_dB3:
    return 3;
    break;
2732

2733 2734 2735
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_dB6:
    return 6;
    break;
2736

2737 2738 2739 2740 2741 2742
  case MAC_MainConfig__phr_Config__setup__dl_PathlossChange_infinity:
  default:
    return -1;
    break;
  }
}
2743 2744 2745 2746 2747 2748 2749 2750


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) {
2751

2752 2753
    UE_MAC_INST *ue = &UE_mac_inst[Mod_id];
    SLDCH_t *sldch = &UE_mac_inst[Mod_id].sldch;
2754 2755

    sldch->payload_length = mac_rrc_data_req(Mod_id,
2756 2757 2758 2759
            CC_id,
            frame_tx,
            SL_DISCOVERY,
            1,
2760
            (char*)(sldch->payload), //&UE_mac_inst[Mod_id].SL_Discovery[0].Tx_buffer.Payload[0],
2761 2762 2763 2764
            0,
            0, //eNB_indexP
            0);

2765

2766 2767 2768 2769
   if (sldch->payload_length >0 ) {
     LOG_I(MAC,"Got %d bytes from RRC for SLDCH @ %p\n",sldch->payload_length,sldch);
     return (sldch);
   }
2770
   else
2771

2772
   return((SLDCH_t*)NULL);
2773 2774 2775 2776 2777
}


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

2778
  mac_rlc_status_resp_t rlc_status, rlc_status_data;
2779 2780 2781 2782
  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;
2783
  uint32_t destL2Id; //groupL2Id/destinationL2Id
2784

2785 2786 2787 2788 2789 2790 2791
  // 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;
2792

2793
    rlc_status = mac_rlc_status_ind(module_idP, 0x1234,0,frameP,subframeP,ENB_FLAG_NO,MBMS_FLAG_NO,
2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810
				    10,
				    0xFFFF);//for signaling - hardcoded
    rlc_status_data = mac_rlc_status_ind(module_idP, 0x1234,0,frameP,subframeP,ENB_FLAG_NO,MBMS_FLAG_NO,
                3,
                0xFFFF); //for data - hardcoded

    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);
       // Fill in group id for off-network communications
       ue->sltx_active = 1;
       ue->slsch_lcid = 10;
    }
    else if (rlc_status_data.bytes_in_buffer >2){
       LOG_I(MAC,"SFN.SF %d.%d: Scheduling for %d bytes in Sidelink buffer\n",frameP,subframeP,rlc_status_data.bytes_in_buffer);
       // Fill in group id for off-network communications
       ue->sltx_active = 1;
       ue->slsch_lcid = 3;
2811 2812
    }
  } // we're not in the SCCH period
2813
  else if (((absSF & 3) == 0 ) &&
2814 2815 2816 2817
	   (ue->sltx_active == 1)) { // every 4th subframe, check for new data from RLC
    // 10 PRBs, mcs 19
    int TBS = 4584/8;
    int req;
2818 2819

    if (ue->slsch_lcid == 10) {
2820 2821 2822
       if (TBS<=rlc_status.bytes_in_buffer) req=TBS;
       else req = rlc_status.bytes_in_buffer;
       destL2Id = ue->destinationL2Id;
2823 2824 2825
    } else if (ue->slsch_lcid == 3){
       if (TBS<=rlc_status_data.bytes_in_buffer) req=TBS;
       else req = rlc_status_data.bytes_in_buffer;
2826
       destL2Id = ue->groupL2Id;
2827 2828
    }

2829 2830 2831 2832 2833 2834 2835
    if (req>0) {
      sdu_length = mac_rlc_data_req(module_idP,
				    0x1234,
				    0,
				    frameP,
				    ENB_FLAG_NO,
				    MBMS_FLAG_NO,
2836
				    ue->slsch_lcid,
2837
				    req,
2838
				    (char*)(ue->slsch_pdu.payload + sizeof(SLSCH_SUBHEADER_24_Bit_DST_LONG)));
2839

2840 2841 2842
      // Notes: 1. hard-coded to 24-bit destination format for now
      //        2. LCID hard-coded to 3
      //        3. SRC/DST IDs with debug values
2843
      if (sdu_length > 0) {
2844

2845
	LOG_I(MAC,"SFN.SF %d.%d : got %d bytes from Sidelink buffer (%d requested)\n",frameP,subframeP,sdu_length,req);
2846 2847
	LOG_I(MAC,"sourceL2Id: 0x%08x \n",ue->sourceL2Id);
	LOG_I(MAC,"groupL2Id/destinationL2Id: 0x%08x \n",destL2Id);
2848

2849
	slsch->payload = (unsigned char*)ue->slsch_pdu.payload;
2850
	if (sdu_length < 128) {
2851 2852 2853 2854
	  slsch->payload++;
	  SLSCH_SUBHEADER_24_Bit_DST_SHORT *shorth= (SLSCH_SUBHEADER_24_Bit_DST_SHORT *)slsch->payload;
	  shorth->F=0;
	  shorth->L=sdu_length;
2855
	  shorth->E=0;
2856
	  shorth->LCID=ue->slsch_lcid;
2857 2858 2859
	  shorth->SRC07 = (ue->sourceL2Id>>16) & 0x000000ff;
	  shorth->SRC815 = (ue->sourceL2Id>>8) & 0x000000ff;
	  shorth->SRC1623 = ue->sourceL2Id & 0x000000ff;
2860 2861 2862
     shorth->DST07 = (destL2Id >>16) & 0x000000ff;
     shorth->DST815 = (destL2Id>>8) & 0x000000ff;
	  shorth->DST1623 = destL2Id & 0x000000ff;
2863

2864 2865 2866 2867 2868 2869 2870
	  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;
2871
	  longh->E=0;
2872
	  longh->LCID=ue->slsch_lcid;
2873 2874 2875
	  longh->SRC07 = (ue->sourceL2Id >>16) & 0x000000ff;
	  longh->SRC815 = (ue->sourceL2Id>>8) & 0x000000ff;
	  longh->SRC1623 = ue->sourceL2Id & 0x000000ff;
2876 2877 2878
	  longh->DST07 = (destL2Id >>16) & 0x000000ff;
	  longh->DST815 = (destL2Id>>8) & 0x000000ff;
	  longh->DST1623 = destL2Id & 0x000000ff;
2879

2880 2881
	  longh->V=0x1;
	}
2882 2883 2884 2885 2886 2887
	slsch->rvidx   = 0;
	slsch->payload_length = TBS;
	// fill in SLSCH configuration
	return(&ue->slsch);
      }
      else ue->sltx_active = 0;
2888
    }
2889 2890 2891 2892 2893

  } 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);
2894
  }
2895

2896

2897 2898
  return(NULL);
}