eNB_scheduler_ulsch.c 68.8 KB
Newer Older
1 2 3 4 5
/*
 * Licensed to the OpenAirInterface (OAI) Software Alliance under one or more
 * contributor license agreements.  See the NOTICE file distributed with
 * this work for additional information regarding copyright ownership.
 * The OpenAirInterface Software Alliance licenses this file to You under
Cedric Roux's avatar
Cedric Roux committed
6
 * the OAI Public License, Version 1.1  (the "License"); you may not use this file
7 8 9 10 11 12 13 14 15 16 17 18 19 20
 * except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.openairinterface.org/?page_id=698
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *-------------------------------------------------------------------------------
 * For more information about the OpenAirInterface (OAI) Software Alliance:
 *      contact@openairinterface.org
 */
nikaeinn's avatar
nikaeinn committed
21 22 23

/*! \file eNB_scheduler_ulsch.c
 * \brief eNB procedures for the ULSCH transport channel
24 25 26
 * \author Navid Nikaein and Raymond Knopp
 * \date 2010 - 2014
 * \email: navid.nikaein@eurecom.fr
nikaeinn's avatar
nikaeinn committed
27
 * \version 1.0
28 29 30 31
 * @ingroup _mac

 */

32 33
/* indented with: indent -kr eNB_scheduler_RA.c */

34 35


36 37 38
#include "LAYER2/MAC/mac.h"
#include "LAYER2/MAC/mac_proto.h"
#include "LAYER2/MAC/mac_extern.h"
39 40
#include "common/utils/LOG/log.h"
#include "common/utils/LOG/vcd_signal_dumper.h"
41 42 43
#include "UTIL/OPT/opt.h"
#include "OCG.h"
#include "OCG_extern.h"
Cedric Roux's avatar
Cedric Roux committed
44
#include "PHY/LTE_TRANSPORT/transport_common_proto.h"
45

46
#include "RRC/LTE/rrc_extern.h"
47 48
#include "RRC/L2_INTERFACE/openair_rrc_L2_interface.h"

49
#include "assertions.h"
50 51 52 53
//#include "LAYER2/MAC/pre_processor.c"
#include "pdcp.h"

#if defined(ENABLE_ITTI)
54
#include "intertask_interface.h"
55 56
#endif

57 58 59 60 61
#include "ENB_APP/flexran_agent_defs.h"
#include "flexran_agent_ran_api.h"
#include "header.pb-c.h"
#include "flexran.pb-c.h"
#include "flexran_agent_mac.h"
62
#include <dlfcn.h>
63

Cedric Roux's avatar
Cedric Roux committed
64 65
#include "T.h"

66
#define ENABLE_MAC_PAYLOAD_DEBUG
67 68
#define DEBUG_eNB_SCHEDULER 1

69 70 71 72 73 74 75 76
extern int oai_nfapi_hi_dci0_req(nfapi_hi_dci0_request_t *hi_dci0_req);
extern void add_subframe(uint16_t *frameP, uint16_t *subframeP, int offset);
extern uint16_t sfnsf_add_subframe(uint16_t frameP, uint16_t subframeP, int offset);
extern int oai_nfapi_ul_config_req(nfapi_ul_config_request_t *ul_config_req);
extern uint8_t nfapi_mode;

extern uint8_t nfapi_mode;

77
// This table holds the allowable PRB sizes for ULSCH transmissions
78
uint8_t rb_table[34] =
knopp's avatar
knopp committed
79
  { 1, 2, 3, 4, 5, 6, 8, 9, 10, 12, 15, 16, 18, 20, 24, 25, 27, 30, 32,
80
    36, 40, 45, 48, 50, 54, 60, 64, 72, 75, 80, 81, 90, 96, 100
knopp's avatar
knopp committed
81
  };
82

83 84 85 86 87 88 89 90 91 92 93 94
/* number of active slices for  past and current time*/
int n_active_slices_uplink = 1;
int n_active_slices_current_uplink = 1;

/* RB share for each slice for past and current time*/
float avg_slice_percentage_uplink=0.25;
float slice_percentage_uplink[MAX_NUM_SLICES] = {1.0, 0.0, 0.0, 0.0};
float slice_percentage_current_uplink[MAX_NUM_SLICES] = {1.0, 0.0, 0.0, 0.0};
float total_slice_percentage_uplink = 0;
float total_slice_percentage_current_uplink = 0;

// MAX MCS for each slice for past and current time
95 96
int slice_maxmcs_uplink[MAX_NUM_SLICES] = {20, 20, 20, 20};
int slice_maxmcs_current_uplink[MAX_NUM_SLICES] = {20,20,20,20};
97 98 99 100 101 102 103 104 105 106 107 108 109

/*resource blocks allowed*/
uint16_t         nb_rbs_allowed_slice_uplink[MAX_NUM_CCs][MAX_NUM_SLICES];
/*Slice Update */
int update_ul_scheduler[MAX_NUM_SLICES] = {1, 1, 1, 1};
int update_ul_scheduler_current[MAX_NUM_SLICES] = {1, 1, 1, 1};

/* name of available scheduler*/
char *ul_scheduler_type[MAX_NUM_SLICES] = {"schedule_ulsch_rnti",
					   "schedule_ulsch_rnti",
					   "schedule_ulsch_rnti",
					   "schedule_ulsch_rnti"
};
Xu Bo's avatar
Xu Bo committed
110
extern mui_t    rrc_eNB_mui;
111 112 113 114

/* Slice Function Pointer */
slice_scheduler_ul slice_sched_ul[MAX_NUM_SLICES] = {0};

115 116 117 118 119 120 121 122 123
void
rx_sdu(const module_id_t enb_mod_idP,
       const int CC_idP,
       const frame_t frameP,
       const sub_frame_t subframeP,
       const rnti_t rntiP,
       uint8_t * sduP,
       const uint16_t sdu_lenP,
       const uint16_t timing_advance, const uint8_t ul_cqi)
Cedric Roux's avatar
Cedric Roux committed
124
{
knopp's avatar
knopp committed
125 126 127 128 129 130 131 132 133 134
  int current_rnti = rntiP;
  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];
  int UE_id = find_UE_id(enb_mod_idP, current_rnti);
  int RA_id;
  int ii, j;
  eNB_MAC_INST *mac = RC.mac[enb_mod_idP];
  int harq_pid =
    subframe2harqpid(&mac->common_channels[CC_idP], frameP, subframeP);
135
  int lcgid_updated[4] = {0, 0, 0, 0};
knopp's avatar
knopp committed
136 137 138 139 140 141 142 143 144

  UE_list_t *UE_list = &mac->UE_list;
  int crnti_rx = 0;
  RA_t *ra =
    (RA_t *) & RC.mac[enb_mod_idP]->common_channels[CC_idP].ra[0];
  int first_rb = 0;

  start_meas(&mac->rx_ulsch_sdu);

knopp's avatar
knopp committed
145
  if ((UE_id > MAX_MOBILES_PER_ENB) || (UE_id == -1))
knopp's avatar
knopp committed
146 147 148 149 150 151 152
    for (ii = 0; ii < NB_RB_MAX; ii++) {
      rx_lengths[ii] = 0;
    }

  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME
    (VCD_SIGNAL_DUMPER_FUNCTIONS_RX_SDU, 1);
  if (opt_enabled == 1) {
Thomas Laurent's avatar
fix 344  
Thomas Laurent committed
153
    trace_pdu(DIRECTION_UPLINK, sduP, sdu_lenP, 0, WS_C_RNTI, current_rnti, frameP, subframeP,
knopp's avatar
knopp committed
154 155 156 157 158 159
	      0, 0);
    LOG_D(OPT, "[eNB %d][ULSCH] Frame %d  rnti %x  with size %d\n",
	  enb_mod_idP, frameP, current_rnti, sdu_lenP);
  }

  if (UE_id != -1) {
160
    LOG_D(MAC,
knopp's avatar
knopp committed
161 162
	  "[eNB %d][PUSCH %d] CC_id %d %d.%d Received ULSCH sdu round %d from PHY (rnti %x, UE_id %d) ul_cqi %d\n",
	  enb_mod_idP, harq_pid, CC_idP,frameP,subframeP,
knopp's avatar
knopp committed
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187
	  UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid],
	  current_rnti, UE_id, ul_cqi);

    AssertFatal(UE_list->UE_sched_ctrl[UE_id].
		round_UL[CC_idP][harq_pid] < 8, "round >= 8\n");
    if (sduP != NULL) {
      UE_list->UE_sched_ctrl[UE_id].ul_inactivity_timer = 0;
      UE_list->UE_sched_ctrl[UE_id].ul_failure_timer = 0;
      UE_list->UE_sched_ctrl[UE_id].ul_scheduled &= (~(1 << harq_pid));
      /* Update with smoothing: 3/4 of old value and 1/4 of new.
       * This is the logic that was done in the function
       * lte_est_timing_advance_pusch, maybe it's not necessary?
       * maybe it's even not correct at all?
       */
      UE_list->UE_sched_ctrl[UE_id].ta_update =	(UE_list->UE_sched_ctrl[UE_id].ta_update * 3 + timing_advance) / 4;
      UE_list->UE_sched_ctrl[UE_id].pusch_snr[CC_idP] = ul_cqi;
      UE_list->UE_sched_ctrl[UE_id].ul_consecutive_errors = 0;
      first_rb = UE_list->UE_template[CC_idP][UE_id].first_rb_ul[harq_pid];

      if (UE_list->UE_sched_ctrl[UE_id].ul_out_of_sync > 0) {
	UE_list->UE_sched_ctrl[UE_id].ul_out_of_sync = 0;
	mac_eNB_rrc_ul_in_sync(enb_mod_idP, CC_idP, frameP,
			       subframeP, UE_RNTI(enb_mod_idP,
						  UE_id));
      }
188 189 190 191 192

      /* update scheduled bytes */
      UE_list->UE_template[CC_idP][UE_id].scheduled_ul_bytes -= UE_list->UE_template[CC_idP][UE_id].TBS_UL[harq_pid];
      if (UE_list->UE_template[CC_idP][UE_id].scheduled_ul_bytes < 0)
        UE_list->UE_template[CC_idP][UE_id].scheduled_ul_bytes = 0;
knopp's avatar
knopp committed
193
    } else {		// we've got an error
knopp's avatar
knopp committed
194 195 196
      LOG_I(MAC,
	    "[eNB %d][PUSCH %d] CC_id %d %d.%d ULSCH in error in round %d, ul_cqi %d\n",
	    enb_mod_idP, harq_pid, CC_idP,frameP,subframeP,
knopp's avatar
knopp committed
197 198 199
	    UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid],
	    ul_cqi);

200 201 202 203
      if(ul_cqi>200){ // too high energy pattern
        UE_list->UE_sched_ctrl[UE_id].pusch_snr[CC_idP] = ul_cqi;
      }

knopp's avatar
knopp committed
204 205 206 207 208 209
      //      AssertFatal(1==0,"ulsch in error\n");
      if (UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid] == 3) {
	UE_list->UE_sched_ctrl[UE_id].ul_scheduled &= (~(1 << harq_pid));
	UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid] = 0;
	if (UE_list->UE_sched_ctrl[UE_id].ul_consecutive_errors++ == 10)
	  UE_list->UE_sched_ctrl[UE_id].ul_failure_timer = 1;
210 211 212 213 214

        /* update scheduled bytes */
        UE_list->UE_template[CC_idP][UE_id].scheduled_ul_bytes -= UE_list->UE_template[CC_idP][UE_id].TBS_UL[harq_pid];
        if (UE_list->UE_template[CC_idP][UE_id].scheduled_ul_bytes < 0)
          UE_list->UE_template[CC_idP][UE_id].scheduled_ul_bytes = 0;
215 216

        if (find_RA_id(enb_mod_idP, CC_idP, current_rnti) != -1)
217
          cancel_ra_proc(enb_mod_idP, CC_idP, frameP, current_rnti);
knopp's avatar
knopp committed
218 219
      } else
	UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid]++;
220 221 222 223 224 225 226

      first_rb = UE_list->UE_template[CC_idP][UE_id].first_rb_ul[harq_pid];

      // Program NACK for PHICH
      LOG_D(MAC,
	"Programming PHICH NACK for rnti %x harq_pid %d (first_rb %d)\n",
	current_rnti, harq_pid, first_rb);
Wu Jing's avatar
Wu Jing committed
227 228 229
      nfapi_hi_dci0_request_t *hi_dci0_req;
      uint8_t sf_ahead_dl = ul_subframe2_k_phich(&mac->common_channels[CC_idP] , subframeP);
      hi_dci0_req = &mac->HI_DCI0_req[CC_idP][(subframeP+sf_ahead_dl)%10];
230 231 232 233 234 235 236 237 238 239 240 241 242
      nfapi_hi_dci0_request_body_t *hi_dci0_req_body = &hi_dci0_req->hi_dci0_request_body;
      nfapi_hi_dci0_request_pdu_t *hi_dci0_pdu =
        &hi_dci0_req_body->hi_dci0_pdu_list[hi_dci0_req_body->number_of_dci + hi_dci0_req_body->number_of_hi];
      memset((void *) hi_dci0_pdu, 0, sizeof(nfapi_hi_dci0_request_pdu_t));
      hi_dci0_pdu->pdu_type = NFAPI_HI_DCI0_HI_PDU_TYPE;
      hi_dci0_pdu->pdu_size = 2 + sizeof(nfapi_hi_dci0_hi_pdu);
      hi_dci0_pdu->hi_pdu.hi_pdu_rel8.tl.tag = NFAPI_HI_DCI0_REQUEST_HI_PDU_REL8_TAG;
      hi_dci0_pdu->hi_pdu.hi_pdu_rel8.resource_block_start = first_rb;
      hi_dci0_pdu->hi_pdu.hi_pdu_rel8.cyclic_shift_2_for_drms = 0;
      hi_dci0_pdu->hi_pdu.hi_pdu_rel8.hi_value = 0;
      hi_dci0_req_body->number_of_hi++;
      hi_dci0_req_body->sfnsf = sfnsf_add_subframe(frameP,subframeP, 0);
      hi_dci0_req_body->tl.tag = NFAPI_HI_DCI0_REQUEST_BODY_TAG;
243
      hi_dci0_req->sfn_sf = sfnsf_add_subframe(frameP,subframeP, sf_ahead_dl);
244 245
      hi_dci0_req->header.message_id = NFAPI_HI_DCI0_REQUEST;

knopp's avatar
knopp committed
246
      return;
247

Florian Kaltenberger's avatar
Florian Kaltenberger committed
248
    }
knopp's avatar
knopp committed
249 250 251 252 253 254 255 256
  } else if ((RA_id = find_RA_id(enb_mod_idP, CC_idP, current_rnti)) != -1) {	// Check if this is an RA process for the rnti
    AssertFatal(mac->common_channels[CC_idP].
		radioResourceConfigCommon->rach_ConfigCommon.
		maxHARQ_Msg3Tx > 1,
		"maxHARQ %d should be greater than 1\n",
		(int) mac->common_channels[CC_idP].
		radioResourceConfigCommon->rach_ConfigCommon.
		maxHARQ_Msg3Tx);
257

knopp's avatar
knopp committed
258 259 260 261 262 263 264 265 266 267 268 269 270 271 272
    LOG_D(MAC,
	  "[eNB %d][PUSCH %d] CC_id %d [RAPROC Msg3] Received ULSCH sdu round %d from PHY (rnti %x, RA_id %d) ul_cqi %d\n",
	  enb_mod_idP, harq_pid, CC_idP, ra[RA_id].msg3_round,
	  current_rnti, RA_id, ul_cqi);

    first_rb = ra->msg3_first_rb;

    if (sduP == NULL) {	// we've got an error on Msg3
      LOG_D(MAC,
	    "[eNB %d] CC_id %d, RA %d ULSCH in error in round %d/%d\n",
	    enb_mod_idP, CC_idP, RA_id,
	    ra[RA_id].msg3_round,
	    (int) mac->common_channels[CC_idP].
	    radioResourceConfigCommon->rach_ConfigCommon.
	    maxHARQ_Msg3Tx);
273
      if (ra[RA_id].msg3_round >= mac->common_channels[CC_idP].radioResourceConfigCommon->rach_ConfigCommon.maxHARQ_Msg3Tx - 1) {
knopp's avatar
knopp committed
274 275 276 277 278 279 280
	cancel_ra_proc(enb_mod_idP, CC_idP, frameP, current_rnti);
      }

      else {
	first_rb = UE_list->UE_template[CC_idP][UE_id].first_rb_ul[harq_pid];
	ra[RA_id].msg3_round++;
	// prepare handling of retransmission
281 282 283
        get_Msg3allocret(&mac->common_channels[CC_idP],
                 ra[RA_id].Msg3_subframe, ra[RA_id].Msg3_frame,
                 &ra[RA_id].Msg3_frame, &ra[RA_id].Msg3_subframe);
knopp's avatar
knopp committed
284 285
	add_msg3(enb_mod_idP, CC_idP, &ra[RA_id], frameP, subframeP);
      }
286 287 288

      /* TODO: program NACK for PHICH? */

knopp's avatar
knopp committed
289 290 291 292 293 294 295 296 297 298
      return;
    }
  } else {
    LOG_W(MAC,
	  "Cannot find UE or RA corresponding to ULSCH rnti %x, dropping it\n",
	  current_rnti);
    return;
  }
  payload_ptr = parse_ulsch_header(sduP, &num_ce, &num_sdu, rx_ces, rx_lcids, rx_lengths, sdu_lenP);

299 300 301 302 303 304
  if(payload_ptr == NULL){
   LOG_E(MAC,"[eNB %d][PUSCH %d] CC_id %d ulsch header unknown lcid(rnti %x, UE_id %d)\n",
         enb_mod_idP, harq_pid, CC_idP,current_rnti, UE_id);
   return;
  }

knopp's avatar
knopp committed
305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324
  T(T_ENB_MAC_UE_UL_PDU, T_INT(enb_mod_idP), T_INT(CC_idP),
    T_INT(current_rnti), T_INT(frameP), T_INT(subframeP),
    T_INT(harq_pid), T_INT(sdu_lenP), T_INT(num_ce), T_INT(num_sdu));
  T(T_ENB_MAC_UE_UL_PDU_WITH_DATA, T_INT(enb_mod_idP), T_INT(CC_idP),
    T_INT(current_rnti), T_INT(frameP), T_INT(subframeP),
    T_INT(harq_pid), T_INT(sdu_lenP), T_INT(num_ce), T_INT(num_sdu),
    T_BUFFER(sduP, sdu_lenP));

  mac->eNB_stats[CC_idP].ulsch_bytes_rx = sdu_lenP;
  mac->eNB_stats[CC_idP].total_ulsch_bytes_rx += sdu_lenP;
  mac->eNB_stats[CC_idP].total_ulsch_pdus_rx += 1;

  UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid] = 0;

  // control element
  for (i = 0; i < num_ce; i++) {

    T(T_ENB_MAC_UE_UL_CE, T_INT(enb_mod_idP), T_INT(CC_idP),
      T_INT(current_rnti), T_INT(frameP), T_INT(subframeP),
      T_INT(rx_ces[i]));
325

knopp's avatar
knopp committed
326 327 328 329 330
    switch (rx_ces[i]) {	// implement and process BSR + CRNTI +
    case POWER_HEADROOM:
      if (UE_id != -1) {
	UE_list->UE_template[CC_idP][UE_id].phr_info =
	  (payload_ptr[0] & 0x3f) - PHR_MAPPING_OFFSET;
331
	LOG_D(MAC,
knopp's avatar
knopp committed
332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351
	      "[eNB %d] CC_id %d MAC CE_LCID %d : Received PHR PH = %d (db)\n",
	      enb_mod_idP, CC_idP, rx_ces[i],
	      UE_list->UE_template[CC_idP][UE_id].phr_info);
	UE_list->UE_template[CC_idP][UE_id].phr_info_configured =
	  1;
	UE_list->UE_sched_ctrl[UE_id].phr_received = 1;
      }
      payload_ptr += sizeof(POWER_HEADROOM_CMD);
      break;

    case CRNTI:
      {
	int old_rnti =
	  (((uint16_t) payload_ptr[0]) << 8) + payload_ptr[1];
	int old_UE_id = find_UE_id(enb_mod_idP, old_rnti);
	LOG_D(MAC,
	      "[eNB %d] Frame %d, Subframe %d CC_id %d MAC CE_LCID %d (ce %d/%d): CRNTI %x (UE_id %d) in Msg3\n",
	      enb_mod_idP, frameP, subframeP, CC_idP, rx_ces[i], i,
	      num_ce, old_rnti, old_UE_id);
	/* receiving CRNTI means that the current rnti has to go away */
352 353
	//cancel_ra_proc(enb_mod_idP, CC_idP, frameP,
	//	       current_rnti);
knopp's avatar
knopp committed
354 355 356 357 358 359 360 361 362 363 364 365
	if (old_UE_id != -1) {
	  /* TODO: if the UE did random access (followed by a MAC uplink with
	   * CRNTI) because none of its scheduling request was granted, then
	   * according to 36.321 5.4.4 the UE's MAC will notify RRC to release
	   * PUCCH/SRS. According to 36.331 5.3.13 the UE will then apply
	   * default configuration for CQI reporting and scheduling requests,
	   * which basically means that the CQI requests won't work anymore and
	   * that the UE won't do any scheduling request anymore as long as the
	   * eNB doesn't reconfigure the UE.
	   * We have to take care of this. As the code is, nothing is done and
	   * the UE state in the eNB is wrong.
	   */
Xu Bo's avatar
Xu Bo committed
366 367 368
          for (ii = 0; ii < NB_RA_PROC_MAX; ii++) {
            ra = &mac->common_channels[CC_idP].ra[ii];
            if ((ra->rnti == current_rnti) && (ra->state != IDLE)) {
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395
              mac_rrc_data_ind(enb_mod_idP,
                               CC_idP,
                               frameP, subframeP,
                               old_rnti,
                               DCCH,
                               (uint8_t *) payload_ptr,
                               rx_lengths[i],
                               0);
              // prepare transmission of Msg4(RRCConnectionReconfiguration)
              ra->state = MSGCRNTI;
              LOG_I(MAC,
                    "[eNB %d] Frame %d, Subframe %d CC_id %d : (rnti %x UE_id %d) RRCConnectionReconfiguration(Msg4)\n",
                    enb_mod_idP, frameP, subframeP, CC_idP, old_rnti, old_UE_id);

              UE_id = old_UE_id;
              current_rnti = old_rnti;
              ra->rnti = old_rnti;
              ra->crnti_rrc_mui = rrc_eNB_mui-1;
              ra->crnti_harq_pid = -1;
              //clear timer
              UE_list->UE_sched_ctrl[UE_id].uplane_inactivity_timer = 0;
              UE_list->UE_sched_ctrl[UE_id].ul_inactivity_timer = 0;
              UE_list->UE_sched_ctrl[UE_id].ul_failure_timer = 0;
              if (UE_list->UE_sched_ctrl[UE_id].ul_out_of_sync > 0) {
                UE_list->UE_sched_ctrl[UE_id].ul_out_of_sync = 0;
                mac_eNB_rrc_ul_in_sync(enb_mod_idP, CC_idP, frameP,
                                       subframeP, old_rnti);
Xu Bo's avatar
Xu Bo committed
396
              }
397 398 399 400
              UE_list->UE_template[CC_idP][UE_id].ul_SR = 1;
              UE_list->UE_sched_ctrl[UE_id].crnti_reconfigurationcomplete_flag = 1;
              break;
            }
Xu Bo's avatar
Xu Bo committed
401
          }
402
        } else {
Xu Bo's avatar
Xu Bo committed
403 404
          cancel_ra_proc(enb_mod_idP, CC_idP, frameP,current_rnti);
        }
knopp's avatar
knopp committed
405 406 407 408 409 410 411 412 413 414
	crnti_rx = 1;
	payload_ptr += 2;
	break;
      }

    case TRUNCATED_BSR:
    case SHORT_BSR:
      {
	uint8_t lcgid;
	lcgid = (payload_ptr[0] >> 6);
415 416

	LOG_D(MAC,
knopp's avatar
knopp committed
417 418 419 420 421 422 423 424 425 426
	      "[eNB %d] CC_id %d MAC CE_LCID %d : Received short BSR LCGID = %u bsr = %d\n",
	      enb_mod_idP, CC_idP, rx_ces[i], lcgid,
	      payload_ptr[0] & 0x3f);

	if (crnti_rx == 1)
	  LOG_D(MAC,
		"[eNB %d] CC_id %d MAC CE_LCID %d : Received short BSR LCGID = %u bsr = %d\n",
		enb_mod_idP, CC_idP, rx_ces[i], lcgid,
		payload_ptr[0] & 0x3f);
	if (UE_id != -1) {
427
          int bsr = payload_ptr[0] & 0x3f;
428

429
          lcgid_updated[lcgid] = 1;
430

431 432
          // update buffer info
          UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[lcgid] = BSR_TABLE[bsr];
433

434 435 436 437 438 439
          UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer =
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[0] +
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[1] +
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[2] +
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[3];
          //UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer += UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer / 4;
440

knopp's avatar
knopp committed
441 442 443 444 445 446 447 448 449
	  RC.eNB[enb_mod_idP][CC_idP]->pusch_stats_bsr[UE_id][(frameP * 10) + subframeP] = (payload_ptr[0] & 0x3f);
	  if (UE_id == UE_list->head)
	    VCD_SIGNAL_DUMPER_DUMP_VARIABLE_BY_NAME(VCD_SIGNAL_DUMPER_VARIABLES_UE0_BSR,
						    RC.eNB[enb_mod_idP][CC_idP]->pusch_stats_bsr
						    [UE_id][(frameP * 10) + subframeP]);
	  if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[lcgid] == 0) {
	    UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[lcgid] = frameP;
	  }
	  if (mac_eNB_get_rrc_status(enb_mod_idP,UE_RNTI(enb_mod_idP, UE_id)) < RRC_CONNECTED)
450
	    LOG_D(MAC,
451
		  "[eNB %d] CC_id %d MAC CE_LCID %d : estimated_ul_buffer = %d (lcg increment %d)\n",
knopp's avatar
knopp committed
452
		  enb_mod_idP, CC_idP, rx_ces[i],
453 454
		  UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer,
		  UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[lcgid]);
knopp's avatar
knopp committed
455
	} else {
456 457

	}
knopp's avatar
knopp committed
458 459 460 461 462 463
	payload_ptr += 1;	//sizeof(SHORT_BSR); // fixme
      }
      break;

    case LONG_BSR:
      if (UE_id != -1) {
464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505
        int bsr0 = (payload_ptr[0] & 0xFC) >> 2;
        int bsr1 = ((payload_ptr[0] & 0x03) << 4) | ((payload_ptr[1] & 0xF0) >> 4);
        int bsr2 = ((payload_ptr[1] & 0x0F) << 2) | ((payload_ptr[2] & 0xC0) >> 6);
        int bsr3 = payload_ptr[2] & 0x3F;

        lcgid_updated[0] = 1;
        lcgid_updated[1] = 1;
        lcgid_updated[2] = 1;
        lcgid_updated[3] = 1;

        // update buffer info
        UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID0] = BSR_TABLE[bsr0];
        UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID1] = BSR_TABLE[bsr1];
        UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID2] = BSR_TABLE[bsr2];
        UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID3] = BSR_TABLE[bsr3];

        UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer =
            UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[0] +
            UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[1] +
            UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[2] +
            UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[3];
        //UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer += UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer / 4;

        LOG_D(MAC,
              "[eNB %d] CC_id %d MAC CE_LCID %d: Received long BSR. Size is LCGID0 = %u LCGID1 = "
              "%u LCGID2 = %u LCGID3 = %u\n", enb_mod_idP, CC_idP,
              rx_ces[i],
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID0],
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID1],
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID2],
              UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID3]);
        if (crnti_rx == 1)
          LOG_D(MAC,
                "[eNB %d] CC_id %d MAC CE_LCID %d: Received long BSR. Size is LCGID0 = %u LCGID1 = "
                "%u LCGID2 = %u LCGID3 = %u\n", enb_mod_idP,
                CC_idP, rx_ces[i],
                UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID0],
                UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID1],
                UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID2],
                UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID3]);

	if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID0] == 0) {
knopp's avatar
knopp committed
506 507 508 509
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID0] = 0;
	} else if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID0] == 0) {
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID0] = frameP;
	}
510

511
	if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID1] == 0) {
knopp's avatar
knopp committed
512 513 514
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID1] = 0;
	} else if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID1] == 0) {
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID1] = frameP;
515 516
	}

517
	if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID2] == 0) {
knopp's avatar
knopp committed
518 519 520 521
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID2] = 0;
	} else if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID2] == 0) {
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID2] = frameP;
	}
522

523
	if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID3] == 0) {
knopp's avatar
knopp committed
524 525 526
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID3] = 0;
	} else if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID3] == 0) {
	  UE_list->UE_template[CC_idP][UE_id].ul_buffer_creation_time[LCGID3] = frameP;
527 528

	}
knopp's avatar
knopp committed
529 530 531 532 533 534 535 536 537 538
      }

      payload_ptr += 3;	////sizeof(LONG_BSR);
      break;

    default:
      LOG_E(MAC,
	    "[eNB %d] CC_id %d Received unknown MAC header (0x%02x)\n",
	    enb_mod_idP, CC_idP, rx_ces[i]);
      break;
539
    }
knopp's avatar
knopp committed
540
  }
541

knopp's avatar
knopp committed
542 543 544 545 546
  for (i = 0; i < num_sdu; i++) {
    LOG_D(MAC, "SDU Number %d MAC Subheader SDU_LCID %d, length %d\n",
	  i, rx_lcids[i], rx_lengths[i]);

    T(T_ENB_MAC_UE_UL_SDU, T_INT(enb_mod_idP), T_INT(CC_idP),
547
      T_INT(current_rnti), T_INT(frameP), T_INT(subframeP),
knopp's avatar
knopp committed
548 549
      T_INT(rx_lcids[i]), T_INT(rx_lengths[i]));
    T(T_ENB_MAC_UE_UL_SDU_WITH_DATA, T_INT(enb_mod_idP), T_INT(CC_idP),
550
      T_INT(current_rnti), T_INT(frameP), T_INT(subframeP),
knopp's avatar
knopp committed
551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
      T_INT(rx_lcids[i]), T_INT(rx_lengths[i]), T_BUFFER(payload_ptr,
							 rx_lengths
							 [i]));

    switch (rx_lcids[i]) {
    case CCCH:
      if (rx_lengths[i] > CCCH_PAYLOAD_SIZE_MAX) {
	LOG_E(MAC,
	      "[eNB %d/%d] frame %d received CCCH of size %d (too big, maximum allowed is %d, sdu_len %d), dropping packet\n",
	      enb_mod_idP, CC_idP, frameP, rx_lengths[i],
	      CCCH_PAYLOAD_SIZE_MAX, sdu_lenP);
	break;
      }
      LOG_D(MAC,
	    "[eNB %d][RAPROC] CC_id %d Frame %d, Received CCCH:  %x.%x.%x.%x.%x.%x, Terminating RA procedure for UE rnti %x\n",
	    enb_mod_idP, CC_idP, frameP, payload_ptr[0],
	    payload_ptr[1], payload_ptr[2], payload_ptr[3],
	    payload_ptr[4], payload_ptr[5], current_rnti);
      VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_TERMINATE_RA_PROC, 1);
      VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_TERMINATE_RA_PROC, 0);
      for (ii = 0; ii < NB_RA_PROC_MAX; ii++) {
	RA_t *ra = &mac->common_channels[CC_idP].ra[ii];
573

knopp's avatar
knopp committed
574 575 576 577
	LOG_D(MAC,
	      "[mac %d][RAPROC] CC_id %d Checking proc %d : rnti (%x, %x), state %d\n",
	      enb_mod_idP, CC_idP, ii, ra->rnti,
	      current_rnti, ra->state);
578

knopp's avatar
knopp committed
579
	if ((ra->rnti == current_rnti) && (ra->state != IDLE)) {
580

knopp's avatar
knopp committed
581
	  //payload_ptr = parse_ulsch_header(msg3,&num_ce,&num_sdu,rx_ces,rx_lcids,rx_lengths,msg3_len);
582

knopp's avatar
knopp committed
583 584
	  if (UE_id < 0) {
	    memcpy(&ra->cont_res_id[0], payload_ptr, 6);
585
	    LOG_D(MAC,
knopp's avatar
knopp committed
586 587 588 589 590 591 592
		  "[eNB %d][RAPROC] CC_id %d Frame %d CCCH: Received Msg3: length %d, offset %ld\n",
		  enb_mod_idP, CC_idP, frameP, rx_lengths[i],
		  payload_ptr - sduP);

	    if ((UE_id = add_new_ue(enb_mod_idP, CC_idP,
				    mac->common_channels[CC_idP].
				    ra[ii].rnti, harq_pid
593
#if (RRC_VERSION >= MAKE_VERSION(14, 0, 0))
knopp's avatar
knopp committed
594 595 596
				    ,
				    mac->common_channels[CC_idP].
				    ra[ii].rach_resource_type
597
#endif
knopp's avatar
knopp committed
598
				    )) == -1) {
599 600 601
              LOG_E(MAC,"[MAC][eNB] Max user count reached\n");
              cancel_ra_proc(enb_mod_idP, CC_idP, frameP,current_rnti);
              break;
knopp's avatar
knopp committed
602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633
	      // kill RA procedure
	    } else
	      LOG_D(MAC,
		    "[eNB %d][RAPROC] CC_id %d Frame %d Added user with rnti %x => UE %d\n",
		    enb_mod_idP, CC_idP, frameP, ra->rnti,
		    UE_id);
	  } else {
	    LOG_D(MAC,
		  "[eNB %d][RAPROC] CC_id %d Frame %d CCCH: Received Msg3 from already registered UE %d: length %d, offset %ld\n",
		  enb_mod_idP, CC_idP, frameP, UE_id,
		  rx_lengths[i], payload_ptr - sduP);
	    // kill RA procedure
	  }

	  mac_rrc_data_ind(enb_mod_idP,
			   CC_idP,
			   frameP, subframeP,
			   current_rnti,
			   CCCH,
			   (uint8_t *) payload_ptr,
			   rx_lengths[i],
			   0);


	  if (num_ce > 0) {	// handle msg3 which is not RRCConnectionRequest
	    //  process_ra_message(msg3,num_ce,rx_lcids,rx_ces);
	  }
	  // prepare transmission of Msg4
	  ra->state = MSG4;



634 635 636 637 638 639 640 641 642 643 644 645 646 647
          if(mac->common_channels[CC_idP].tdd_Config!=NULL){
            switch(mac->common_channels[CC_idP].tdd_Config->subframeAssignment){
            case 1:
              ra->Msg4_frame = frameP + ((subframeP > 2) ? 1 : 0);
              ra->Msg4_subframe = (subframeP + 7) % 10;
              break;
            default: printf("%s:%d: TODO\n", __FILE__, __LINE__); abort();
             // TODO need to be complete for other tdd configs.
            }
          }else{
            // Program Msg4 PDCCH+DLSCH/MPDCCH transmission 4 subframes from now, // Check if this is ok for BL/CE, or if the rule is different
            ra->Msg4_frame = frameP + ((subframeP > 5) ? 1 : 0);
            ra->Msg4_subframe = (subframeP + 4) % 10;
          }
knopp's avatar
knopp committed
648

649
          UE_list->UE_sched_ctrl[UE_id].crnti_reconfigurationcomplete_flag = 0;
knopp's avatar
knopp committed
650 651 652 653 654 655 656 657
	}		// if process is active
      }			// loop on RA processes

      break;

    case DCCH:
    case DCCH1:
      //      if(eNB_mac_inst[module_idP][CC_idP].Dcch_lchan[UE_id].Active==1){
Cedric Roux's avatar
Cedric Roux committed
658

gauthier's avatar
 
gauthier committed
659

knopp's avatar
 
knopp committed
660
#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
knopp's avatar
knopp committed
661 662 663 664 665 666
      LOG_T(MAC, "offset: %d\n",
	    (unsigned char) ((unsigned char *) payload_ptr - sduP));
      for (j = 0; j < 32; j++) {
	LOG_T(MAC, "%x ", payload_ptr[j]);
      }
      LOG_T(MAC, "\n");
knopp's avatar
 
knopp committed
667
#endif
gauthier's avatar
 
gauthier committed
668

knopp's avatar
knopp committed
669
      if (UE_id != -1) {
670 671 672 673 674 675 676 677 678 679 680 681 682 683
        if (lcgid_updated[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] == 0) {
	  // adjust buffer occupancy of the correponding logical channel group
	  if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] >= rx_lengths[i])
	    UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] -= rx_lengths[i];
	  else
	    UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] = 0;

          UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer =
          UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[0] +
          UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[1] +
          UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[2] +
          UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[3];
          //UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer += UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer / 4;
        }
684

knopp's avatar
knopp committed
685 686 687 688
	LOG_D(MAC,
	      "[eNB %d] CC_id %d Frame %d : ULSCH -> UL-DCCH, received %d bytes form UE %d on LCID %d \n",
	      enb_mod_idP, CC_idP, frameP, rx_lengths[i], UE_id,
	      rx_lcids[i]);
689

knopp's avatar
knopp committed
690 691 692
	mac_rlc_data_ind(enb_mod_idP, current_rnti, enb_mod_idP, frameP, ENB_FLAG_YES, MBMS_FLAG_NO, rx_lcids[i], (char *) payload_ptr, rx_lengths[i], 1, NULL);	//(unsigned int*)crc_status);
	UE_list->eNB_UE_stats[CC_idP][UE_id].num_pdu_rx[rx_lcids[i]] += 1;
	UE_list->eNB_UE_stats[CC_idP][UE_id].num_bytes_rx[rx_lcids[i]] += rx_lengths[i];
693 694


knopp's avatar
knopp committed
695
      }
696

knopp's avatar
knopp committed
697 698 699
      /* UE_id != -1 */
      // }
      break;
700

knopp's avatar
knopp committed
701 702 703
      // all the DRBS
    case DTCH:
    default:
gauthier's avatar
 
gauthier committed
704

knopp's avatar
 
knopp committed
705
#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
knopp's avatar
knopp committed
706 707 708 709 710 711
      LOG_T(MAC, "offset: %d\n",
	    (unsigned char) ((unsigned char *) payload_ptr - sduP));
      for (j = 0; j < 32; j++) {
	LOG_T(MAC, "%x ", payload_ptr[j]);
      }
      LOG_T(MAC, "\n");
712
#endif
knopp's avatar
knopp committed
713 714 715 716 717
      if (rx_lcids[i] < NB_RB_MAX) {
	LOG_D(MAC,
	      "[eNB %d] CC_id %d Frame %d : ULSCH -> UL-DTCH, received %d bytes from UE %d for lcid %d\n",
	      enb_mod_idP, CC_idP, frameP, rx_lengths[i], UE_id,
	      rx_lcids[i]);
718

knopp's avatar
knopp committed
719 720 721 722 723 724 725 726 727 728 729 730
	if (UE_id != -1) {
	  // adjust buffer occupancy of the correponding logical channel group
	  LOG_D(MAC,
		"[eNB %d] CC_id %d Frame %d : ULSCH -> UL-DTCH, received %d bytes from UE %d for lcid %d, removing from LCGID %ld, %d\n",
		enb_mod_idP, CC_idP, frameP, rx_lengths[i],
		UE_id, rx_lcids[i],
		UE_list->UE_template[CC_idP][UE_id].
		lcgidmap[rx_lcids[i]],
		UE_list->UE_template[CC_idP][UE_id].
		ul_buffer_info[UE_list->UE_template[CC_idP]
			       [UE_id].lcgidmap[rx_lcids[i]]]);

731 732 733 734 735 736 737 738 739 740 741 742 743 744
          if (lcgid_updated[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] == 0) {
	    if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] >= rx_lengths[i])
	      UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] -= rx_lengths[i];
	    else
	      UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] = 0;

            UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer =
               UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[0] +
               UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[1] +
               UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[2] +
               UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[3];
            //UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer += UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer / 4;
          }

knopp's avatar
knopp committed
745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762
	  if ((rx_lengths[i] < SCH_PAYLOAD_SIZE_MAX) && (rx_lengths[i] > 0)) {	// MAX SIZE OF transport block
	    mac_rlc_data_ind(enb_mod_idP, current_rnti, enb_mod_idP, frameP, ENB_FLAG_YES, MBMS_FLAG_NO, rx_lcids[i], (char *) payload_ptr, rx_lengths[i], 1, NULL);	//(unsigned int*)crc_status);

	    UE_list->eNB_UE_stats[CC_idP][UE_id].num_pdu_rx[rx_lcids[i]] += 1;
	    UE_list->eNB_UE_stats[CC_idP][UE_id].num_bytes_rx[rx_lcids[i]] += rx_lengths[i];
	    //clear uplane_inactivity_timer
	    UE_list->UE_sched_ctrl[UE_id].uplane_inactivity_timer = 0;
	  } else {	/* rx_length[i] */
	    UE_list->eNB_UE_stats[CC_idP][UE_id].num_errors_rx += 1;
	    LOG_E(MAC,
		  "[eNB %d] CC_id %d Frame %d : Max size of transport block reached LCID %d from UE %d ",
		  enb_mod_idP, CC_idP, frameP, rx_lcids[i],
		  UE_id);
	  }
	} else {	/*(UE_id != -1 */
	  LOG_E(MAC,
		"[eNB %d] CC_id %d Frame %d : received unsupported or unknown LCID %d from UE %d ",
		enb_mod_idP, CC_idP, frameP, rx_lcids[i], UE_id);
763
	}
knopp's avatar
knopp committed
764
      }
765

knopp's avatar
knopp committed
766
      break;
knopp's avatar
 
knopp committed
767
    }
Cedric Roux's avatar
Cedric Roux committed
768

knopp's avatar
knopp committed
769 770 771 772 773 774 775
    payload_ptr += rx_lengths[i];
  }

  // Program ACK for PHICH
  LOG_D(MAC,
	"Programming PHICH ACK for rnti %x harq_pid %d (first_rb %d)\n",
	current_rnti, harq_pid, first_rb);
776 777 778 779
  nfapi_hi_dci0_request_t *hi_dci0_req;
  uint8_t sf_ahead_dl = ul_subframe2_k_phich(&mac->common_channels[CC_idP] , subframeP);
  hi_dci0_req = &mac->HI_DCI0_req[CC_idP][(subframeP+sf_ahead_dl)%10];

knopp's avatar
knopp committed
780 781 782 783 784 785 786 787 788 789 790 791 792
  nfapi_hi_dci0_request_body_t *hi_dci0_req_body = &hi_dci0_req->hi_dci0_request_body;
  nfapi_hi_dci0_request_pdu_t *hi_dci0_pdu =
    &hi_dci0_req_body->hi_dci0_pdu_list[hi_dci0_req_body->number_of_dci + hi_dci0_req_body->number_of_hi];
  memset((void *) hi_dci0_pdu, 0, sizeof(nfapi_hi_dci0_request_pdu_t));
  hi_dci0_pdu->pdu_type = NFAPI_HI_DCI0_HI_PDU_TYPE;
  hi_dci0_pdu->pdu_size = 2 + sizeof(nfapi_hi_dci0_hi_pdu);
  hi_dci0_pdu->hi_pdu.hi_pdu_rel8.tl.tag = NFAPI_HI_DCI0_REQUEST_HI_PDU_REL8_TAG;
  hi_dci0_pdu->hi_pdu.hi_pdu_rel8.resource_block_start = first_rb;
  hi_dci0_pdu->hi_pdu.hi_pdu_rel8.cyclic_shift_2_for_drms = 0;
  hi_dci0_pdu->hi_pdu.hi_pdu_rel8.hi_value = 1;
  hi_dci0_req_body->number_of_hi++;
  hi_dci0_req_body->sfnsf = sfnsf_add_subframe(frameP,subframeP, 0);
  hi_dci0_req_body->tl.tag = NFAPI_HI_DCI0_REQUEST_BODY_TAG;
793
  hi_dci0_req->sfn_sf = sfnsf_add_subframe(frameP,subframeP, sf_ahead_dl);
knopp's avatar
knopp committed
794 795 796 797 798 799 800 801 802
  hi_dci0_req->header.message_id = NFAPI_HI_DCI0_REQUEST;

  /* NN--> FK: we could either check the payload, or use a phy helper to detect a false msg3 */
  if ((num_sdu == 0) && (num_ce == 0)) {
    if (UE_id != -1)
      UE_list->eNB_UE_stats[CC_idP][UE_id].total_num_errors_rx += 1;
    /*
      if (msg3_flagP != NULL) {
      if( *msg3_flagP == 1 ) {
803
      LOG_I(MAC,"[eNB %d] CC_id %d frame %d : false msg3 detection: signal phy to canceling RA and remove the UE\n", enb_mod_idP, CC_idP, frameP);
knopp's avatar
knopp committed
804 805 806 807 808 809 810 811
      *msg3_flagP=0;
      }
      } */
  } else {
    if (UE_id != -1) {
      UE_list->eNB_UE_stats[CC_idP][UE_id].pdu_bytes_rx        = sdu_lenP;
      UE_list->eNB_UE_stats[CC_idP][UE_id].total_pdu_bytes_rx += sdu_lenP;
      UE_list->eNB_UE_stats[CC_idP][UE_id].total_num_pdus_rx  += 1;
roux's avatar
roux committed
812
    }
knopp's avatar
knopp committed
813
  }
814

knopp's avatar
knopp committed
815 816
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME(VCD_SIGNAL_DUMPER_FUNCTIONS_RX_SDU, 0);
  stop_meas(&mac->rx_ulsch_sdu);
knopp's avatar
 
knopp committed
817 818
}

819 820
uint32_t bytes_to_bsr_index(int32_t nbytes)
{
knopp's avatar
knopp committed
821
  uint32_t i = 0;
822

knopp's avatar
knopp committed
823 824 825
  if (nbytes < 0) {
    return (0);
  }
826

knopp's avatar
knopp committed
827 828 829
  while ((i < BSR_TABLE_SIZE) && (BSR_TABLE[i] <= nbytes)) {
    i++;
  }
830

knopp's avatar
knopp committed
831
  return (i - 1);
832 833
}

834 835 836
void
add_ue_ulsch_info(module_id_t module_idP, int CC_id, int UE_id,
		  sub_frame_t subframeP, UE_ULSCH_STATUS status)
837
{
knopp's avatar
knopp committed
838 839 840
  eNB_ulsch_info[module_idP][CC_id][UE_id].rnti     = UE_RNTI(module_idP, UE_id);
  eNB_ulsch_info[module_idP][CC_id][UE_id].subframe = subframeP;
  eNB_ulsch_info[module_idP][CC_id][UE_id].status   = status;
841

knopp's avatar
knopp committed
842
  eNB_ulsch_info[module_idP][CC_id][UE_id].serving_num++;
843 844 845
}

unsigned char *parse_ulsch_header(unsigned char *mac_header,
846 847 848 849 850 851
				  unsigned char *num_ce,
				  unsigned char *num_sdu,
				  unsigned char *rx_ces,
				  unsigned char *rx_lcids,
				  unsigned short *rx_lengths,
				  unsigned short tb_length)
852
{
knopp's avatar
knopp committed
853 854 855 856
  unsigned char not_done = 1, num_ces = 0, num_sdus =
    0, lcid, num_sdu_cnt;
  unsigned char *mac_header_ptr = mac_header;
  unsigned short length, ce_len = 0;
857

knopp's avatar
knopp committed
858
  while (not_done == 1) {
859

knopp's avatar
knopp committed
860 861 862
    if (((SCH_SUBHEADER_FIXED *) mac_header_ptr)->E == 0) {
      not_done = 0;
    }
863

knopp's avatar
knopp committed
864
    lcid = ((SCH_SUBHEADER_FIXED *) mac_header_ptr)->LCID;
865

knopp's avatar
knopp committed
866 867 868 869
    if (lcid < EXTENDED_POWER_HEADROOM) {
      if (not_done == 0) {	// last MAC SDU, length is implicit
	mac_header_ptr++;
	length = tb_length - (mac_header_ptr - mac_header) - ce_len;
870

knopp's avatar
knopp committed
871 872 873
	for (num_sdu_cnt = 0; num_sdu_cnt < num_sdus;
	     num_sdu_cnt++) {
	  length -= rx_lengths[num_sdu_cnt];
874
	}
knopp's avatar
knopp committed
875 876 877 878 879 880 881 882 883 884
      } else {
	if (((SCH_SUBHEADER_SHORT *) mac_header_ptr)->F == 0) {
	  length = ((SCH_SUBHEADER_SHORT *) mac_header_ptr)->L;
	  mac_header_ptr += 2;	//sizeof(SCH_SUBHEADER_SHORT);
	} else {	// 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;	//sizeof(SCH_SUBHEADER_LONG);
885
	}
knopp's avatar
knopp committed
886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912
      }

      LOG_D(MAC,
	    "[eNB] sdu %d lcid %d tb_length %d length %d (offset now %ld)\n",
	    num_sdus, lcid, tb_length, length,
	    mac_header_ptr - mac_header);
      rx_lcids[num_sdus] = lcid;
      rx_lengths[num_sdus] = length;
      num_sdus++;
    } else {		// This is a control element subheader POWER_HEADROOM, BSR and CRNTI
      if (lcid == SHORT_PADDING) {
	mac_header_ptr++;
      } else {
	rx_ces[num_ces] = lcid;
	num_ces++;
	mac_header_ptr++;

	if (lcid == LONG_BSR) {
	  ce_len += 3;
	} else if (lcid == CRNTI) {
	  ce_len += 2;
	} else if ((lcid == POWER_HEADROOM)
		   || (lcid == TRUNCATED_BSR)
		   || (lcid == SHORT_BSR)) {
	  ce_len++;
	} else {
	  LOG_E(MAC, "unknown CE %d \n", lcid);
913 914
	  //AssertFatal(1 == 0, "unknown CE");
          return NULL;
knopp's avatar
knopp committed
915 916
	}
      }
knopp's avatar
 
knopp committed
917
    }
knopp's avatar
knopp committed
918
  }
919

knopp's avatar
knopp committed
920 921
  *num_ce = num_ces;
  *num_sdu = num_sdus;
922

knopp's avatar
knopp committed
923
  return (mac_header_ptr);
924 925
}

926 927 928 929 930
/* This function is called by PHY layer when it schedules some
 * uplink for a random access message 3.
 * The MAC scheduler has to skip the RBs used by this message 3
 * (done below in schedule_ulsch).
 */
931
void
932
set_msg3_subframe(module_id_t mod_id,
933 934 935 936
		  int CC_id,
		  int frame,
		  int subframe, int rnti, int Msg3_frame,
		  int Msg3_subframe)
937
{
938
  eNB_MAC_INST *mac = RC.mac[mod_id];
knopp's avatar
knopp committed
939 940 941 942 943 944 945
  int i;
  for (i = 0; i < NB_RA_PROC_MAX; i++) {
    if (mac->common_channels[CC_id].ra[i].state != IDLE &&
	mac->common_channels[CC_id].ra[i].rnti == rnti) {
      mac->common_channels[CC_id].ra[i].Msg3_subframe =
	Msg3_subframe;
      break;
946
    }
knopp's avatar
knopp committed
947
  }
948
}
949

950 951 952
void
schedule_ulsch(module_id_t module_idP, frame_t frameP,
	       sub_frame_t subframeP)
Cedric Roux's avatar
Cedric Roux committed
953
{
knopp's avatar
knopp committed
954 955 956 957 958 959 960
  uint16_t first_rb[MAX_NUM_CCs], i;
  int CC_id;
  eNB_MAC_INST *mac = RC.mac[module_idP];
  COMMON_channels_t *cc;

  start_meas(&mac->schedule_ulsch);

961
  int sched_frame=frameP;
knopp's avatar
knopp committed
962 963 964 965 966 967 968 969 970
  int sched_subframe = (subframeP + 4) % 10;

  cc = &mac->common_channels[0];
  int tdd_sfa;
  // for TDD: check subframes where we have to act and return if nothing should be done now
  if (cc->tdd_Config) {
    tdd_sfa = cc->tdd_Config->subframeAssignment;
    switch (subframeP) {
    case 0:
971
      if ((tdd_sfa == 0) || (tdd_sfa == 3))
knopp's avatar
knopp committed
972
	sched_subframe = 4;
973 974
      else if (tdd_sfa == 6)
	sched_subframe = 7;
knopp's avatar
knopp committed
975 976 977 978 979 980 981 982
      else
	return;
      break;
    case 1:
      if ((tdd_sfa == 0) || (tdd_sfa == 1))
	sched_subframe = 7;
      else if (tdd_sfa == 6)
	sched_subframe = 8;
983 984
      else
        return;
knopp's avatar
knopp committed
985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006
      break;
    default:
      return;

    case 2:		// Don't schedule UL in subframe 2 for TDD
      return;
    case 3:
      if (tdd_sfa == 2)
	sched_subframe = 7;
      else
	return;
      break;
    case 4:
      if (tdd_sfa == 1)
	sched_subframe = 8;
      else
	return;
      break;
    case 5:
      if (tdd_sfa == 0)
	sched_subframe = 9;
      else if (tdd_sfa == 6)
1007
	sched_subframe = 2;
knopp's avatar
knopp committed
1008 1009 1010 1011
      else
	return;
      break;
    case 6:
1012
      if (tdd_sfa == 0 || tdd_sfa == 1)
knopp's avatar
knopp committed
1013 1014 1015 1016 1017 1018 1019 1020 1021
	sched_subframe = 2;
      else if (tdd_sfa == 6)
	sched_subframe = 3;
      else
	return;
      break;
    case 7:
      return;
    case 8:
1022 1023
      if ((tdd_sfa >= 2) && (tdd_sfa <= 5))
        sched_subframe = 2;
knopp's avatar
knopp committed
1024
      else
1025
        return;
knopp's avatar
knopp committed
1026 1027 1028
      break;
    case 9:
      if ((tdd_sfa == 1) || (tdd_sfa == 3) || (tdd_sfa == 4))
1029
        sched_subframe = 3;
knopp's avatar
knopp committed
1030
      else if (tdd_sfa == 6)
1031
        sched_subframe = 4;
knopp's avatar
knopp committed
1032
      else
1033
        return;
knopp's avatar
knopp committed
1034
      break;
1035
    }
knopp's avatar
knopp committed
1036
  }
Wu Jing's avatar
Wu Jing committed
1037
  if (sched_subframe < subframeP) sched_frame++;
1038

knopp's avatar
knopp committed
1039
  for (CC_id = 0; CC_id < MAX_NUM_CCs; CC_id++) {
gauthier's avatar
 
gauthier committed
1040

1041 1042


knopp's avatar
knopp committed
1043 1044
    //leave out first RB for PUCCH
    first_rb[CC_id] = 1;
gauthier's avatar
 
gauthier committed
1045

knopp's avatar
knopp committed
1046 1047 1048 1049
    // UE data info;
    // check which UE has data to transmit
    // function to decide the scheduling
    // e.g. scheduling_rslt = Greedy(granted_UEs, nb_RB)
gauthier's avatar
 
gauthier committed
1050

knopp's avatar
knopp committed
1051 1052
    // default function for default scheduling
    //
gauthier's avatar
 
gauthier committed
1053

knopp's avatar
knopp committed
1054 1055 1056 1057
    // output of scheduling, the UE numbers in RBs, where it is in the code???
    // check if RA (Msg3) is active in this subframeP, if so skip the PRBs used for Msg3
    // Msg3 is using 1 PRB so we need to increase first_rb accordingly
    // not sure about the break (can there be more than 1 active RA procedure?)
gauthier's avatar
 
gauthier committed
1058

knopp's avatar
knopp committed
1059 1060 1061 1062 1063 1064 1065
    for (i = 0; i < NB_RA_PROC_MAX; i++) {
      if ((cc->ra[i].state == WAITMSG3) &&
	  (cc->ra[i].Msg3_subframe == sched_subframe)) {
	first_rb[CC_id]++;
	//    cc->ray[i].Msg3_subframe = -1;
	break;
      }
knopp's avatar
 
knopp committed
1066
    }
knopp's avatar
knopp committed
1067
  }
1068

1069
  // perform slice-specifc operations
1070

1071 1072