eNB_scheduler_ulsch.c 64.9 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
#include "RRC/L2_INTERFACE/openair_rrc_L2_interface.h"
48
49
50
51
/************************************************/
//#include "RRC/LTE/rrc_eNB_UE_context.h"
//#include "RRC/LTE/rrc_defs.h"
/************************************************/
52

53
#include "assertions.h"
54
55
56
57
//#include "LAYER2/MAC/pre_processor.c"
#include "pdcp.h"

#if defined(ENABLE_ITTI)
58
#include "intertask_interface.h"
59
60
#endif

61
62
63
64
65
#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"
66
#include <dlfcn.h>
67

Cedric Roux's avatar
Cedric Roux committed
68
69
#include "T.h"

70
71
72
#include "common/ran_context.h"
extern RAN_CONTEXT_t RC;

73
#define ENABLE_MAC_PAYLOAD_DEBUG
74
75
#define DEBUG_eNB_SCHEDULER 1

76
77
78
79
80
81
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;

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

Xu Bo's avatar
Xu Bo committed
88
extern mui_t    rrc_eNB_mui;
89

90
91
92
93
94
95
96
97
98
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
99
{
knopp's avatar
knopp committed
100
101
102
103
104
105
106
107
108
109
  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);
110
  int lcgid_updated[4] = {0, 0, 0, 0};
knopp's avatar
knopp committed
111
112
113
114
115
116
117

  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;

118
119
  rrc_eNB_ue_context_t *ue_contextP; // added by LA

knopp's avatar
knopp committed
120
121
  start_meas(&mac->rx_ulsch_sdu);

knopp's avatar
knopp committed
122
  if ((UE_id > MAX_MOBILES_PER_ENB) || (UE_id == -1))
knopp's avatar
knopp committed
123
124
125
126
127
128
129
    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
130
    trace_pdu(DIRECTION_UPLINK, sduP, sdu_lenP, 0, WS_C_RNTI, current_rnti, frameP, subframeP,
knopp's avatar
knopp committed
131
132
133
134
135
136
	      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) {
137
    LOG_D(MAC,
knopp's avatar
knopp committed
138
139
	  "[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
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
	  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));
      }
165
166
167
168
169

      /* 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
170
    } else {		// we've got an error
knopp's avatar
knopp committed
171
172
173
      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
174
175
176
	    UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid],
	    ul_cqi);

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

        /* 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;
192
193

        if (find_RA_id(enb_mod_idP, CC_idP, current_rnti) != -1)
194
          cancel_ra_proc(enb_mod_idP, CC_idP, frameP, current_rnti);
knopp's avatar
knopp committed
195
196
      } else
	UE_list->UE_sched_ctrl[UE_id].round_UL[CC_idP][harq_pid]++;
197
198
199
200
201
202
203

      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
204
205
206
      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];
207
208
209
210
211
212
213
214
215
216
217
218
219
      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;
220
      hi_dci0_req->sfn_sf = sfnsf_add_subframe(frameP,subframeP, sf_ahead_dl);
221
222
      hi_dci0_req->header.message_id = NFAPI_HI_DCI0_REQUEST;

knopp's avatar
knopp committed
223
      return;
224

Florian Kaltenberger's avatar
Florian Kaltenberger committed
225
    }
knopp's avatar
knopp committed
226
227
228
229
230
231
232
233
  } 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);
234

knopp's avatar
knopp committed
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
    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);
250
      if (ra[RA_id].msg3_round >= mac->common_channels[CC_idP].radioResourceConfigCommon->rach_ConfigCommon.maxHARQ_Msg3Tx - 1) {
knopp's avatar
knopp committed
251
252
253
254
255
256
257
	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
258
259
260
        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
261
262
	add_msg3(enb_mod_idP, CC_idP, &ra[RA_id], frameP, subframeP);
      }
263
264
265

      /* TODO: program NACK for PHICH? */

knopp's avatar
knopp committed
266
267
268
269
270
271
272
273
274
275
      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);

276
277
278
279
280
281
  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
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
  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]));
302

knopp's avatar
knopp committed
303
304
305
306
307
    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;
308
	LOG_D(MAC,
knopp's avatar
knopp committed
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
	      "[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 */
329
330
	//cancel_ra_proc(enb_mod_idP, CC_idP, frameP,
	//	       current_rnti);
knopp's avatar
knopp committed
331
332
333
334
335
336
337
338
339
340
341
342
	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
343
344
345
          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)) {
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
              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
373
              }
374
375
376
377
              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
378
          }
379
        } else {
Xu Bo's avatar
Xu Bo committed
380
381
          cancel_ra_proc(enb_mod_idP, CC_idP, frameP,current_rnti);
        }
knopp's avatar
knopp committed
382
383
384
385
386
387
388
389
390
391
	crnti_rx = 1;
	payload_ptr += 2;
	break;
      }

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

	LOG_D(MAC,
knopp's avatar
knopp committed
394
395
396
397
398
399
400
401
402
403
	      "[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) {
404
          int bsr = payload_ptr[0] & 0x3f;
405

406
          lcgid_updated[lcgid] = 1;
407

408
409
          // update buffer info
          UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[lcgid] = BSR_TABLE[bsr];
410

411
          UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer =
Niccolò Iardella's avatar
Niccolò Iardella committed
412
413
414
415
              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];
416
          //UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer += UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer / 4;
417

knopp's avatar
knopp committed
418
419
420
421
422
423
424
425
426
	  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)
427
	    LOG_D(MAC,
428
		  "[eNB %d] CC_id %d MAC CE_LCID %d : estimated_ul_buffer = %d (lcg increment %d)\n",
knopp's avatar
knopp committed
429
		  enb_mod_idP, CC_idP, rx_ces[i],
430
431
		  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
432
	} else {
433
434

	}
knopp's avatar
knopp committed
435
436
437
438
439
440
	payload_ptr += 1;	//sizeof(SHORT_BSR); // fixme
      }
      break;

    case LONG_BSR:
      if (UE_id != -1) {
441
442
443
444
445
        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;

Niccolò Iardella's avatar
Niccolò Iardella committed
446
447
448
449
        lcgid_updated[LCGID0] = 1;
        lcgid_updated[LCGID1] = 1;
        lcgid_updated[LCGID2] = 1;
        lcgid_updated[LCGID3] = 1;
450
451
452
453
454
455
456
457

        // 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 =
Niccolò Iardella's avatar
Niccolò Iardella committed
458
459
460
461
            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];
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
        //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
483
484
485
486
	  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;
	}
487

488
	if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID1] == 0) {
knopp's avatar
knopp committed
489
490
491
	  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;
492
493
	}

494
	if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID2] == 0) {
knopp's avatar
knopp committed
495
496
497
498
	  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;
	}
499

500
	if (UE_list->UE_template[CC_idP][UE_id].ul_buffer_info[LCGID3] == 0) {
knopp's avatar
knopp committed
501
502
503
	  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;
504
505

	}
knopp's avatar
knopp committed
506
507
508
509
510
511
512
513
514
515
      }

      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;
516
    }
knopp's avatar
knopp committed
517
  }
518

knopp's avatar
knopp committed
519
520
521
522
523
  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),
524
      T_INT(current_rnti), T_INT(frameP), T_INT(subframeP),
knopp's avatar
knopp committed
525
526
      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),
527
      T_INT(current_rnti), T_INT(frameP), T_INT(subframeP),
knopp's avatar
knopp committed
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
      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];
550

knopp's avatar
knopp committed
551
552
553
554
	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);
555

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

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

knopp's avatar
knopp committed
560
561
	  if (UE_id < 0) {
	    memcpy(&ra->cont_res_id[0], payload_ptr, 6);
562
	    LOG_D(MAC,
knopp's avatar
knopp committed
563
564
565
566
567
568
569
		  "[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
570
#if (RRC_VERSION >= MAKE_VERSION(14, 0, 0))
knopp's avatar
knopp committed
571
572
573
				    ,
				    mac->common_channels[CC_idP].
				    ra[ii].rach_resource_type
574
#endif
knopp's avatar
knopp committed
575
				    )) == -1) {
576
577
578
              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
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
	      // 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;



611
612
613
614
615
616
617
618
619
620
621
622
623
624
          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
625

626
          UE_list->UE_sched_ctrl[UE_id].crnti_reconfigurationcomplete_flag = 0;
knopp's avatar
knopp committed
627
628
629
630
631
632
633
634
	}		// 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
635

gauthier's avatar
   
gauthier committed
636

knopp's avatar
   
knopp committed
637
#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
knopp's avatar
knopp committed
638
639
640
641
642
643
      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
644
#endif
gauthier's avatar
   
gauthier committed
645

knopp's avatar
knopp committed
646
      if (UE_id != -1) {
647
648
649
650
651
652
653
654
655
656
657
658
659
660
        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;
        }
661

knopp's avatar
knopp committed
662
663
664
665
	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]);
666

knopp's avatar
knopp committed
667
668
669
	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];
670
671


knopp's avatar
knopp committed
672
      }
673

knopp's avatar
knopp committed
674
675
676
      /* UE_id != -1 */
      // }
      break;
677

678
    // all the DRBS
knopp's avatar
knopp committed
679
    case DTCH:
680
    
knopp's avatar
knopp committed
681
    default:
gauthier's avatar
   
gauthier committed
682

knopp's avatar
   
knopp committed
683
#if defined(ENABLE_MAC_PAYLOAD_DEBUG)
684
      
knopp's avatar
knopp committed
685
      LOG_T(MAC, "offset: %d\n",
686
687
	      (unsigned char) ((unsigned char *) payload_ptr - sduP));
      
knopp's avatar
knopp committed
688
      for (j = 0; j < 32; j++) {
689
	      LOG_T(MAC, "%x ", payload_ptr[j]);
knopp's avatar
knopp committed
690
      }
691
      
knopp's avatar
knopp committed
692
      LOG_T(MAC, "\n");
693

694
#endif
695

696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
      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]);

	      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]]]);
knopp's avatar
knopp committed
717

718
          if (lcgid_updated[UE_list->UE_template[CC_idP][UE_id].lcgidmap[rx_lcids[i]]] == 0) {
719
720
721
722
723
	          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;
            }
724
725

            UE_list->UE_template[CC_idP][UE_id].estimated_ul_buffer =
726
727
728
729
              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];
730
731
          }

732
733
734
735
736
737
738
739
740
	        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);

	          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;

741
742
743
744
745
746
747
748
749
750
751
752
            // reset RRC inactivity timer after uplane activity
            ue_contextP = rrc_eNB_get_ue_context(RC.rrc[enb_mod_idP], rntiP);
            ue_contextP->ue_context.ue_rrc_inactivity_timer = 1;

            LOG_W(RRC, "After reset, rrc_inactivity_timer is %d, of UE rntiP %d, ue_context_rnti %d, UE_id %d, ue_initial_id %d\n",
              ue_contextP->ue_context.ue_rrc_inactivity_timer,
              rntiP,
              ue_contextP->ue_id_rnti,
              UE_id,
              ue_contextP->ue_context.ue_initial_id);
            

753
754
755
756
757
758
759
760
761
762
763
          } 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);
          }

764
	      } else {	// end if (UE_id != -1)
765
766
767
768
769
770
771
          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);
	      }
knopp's avatar
knopp committed
772
      }
773

knopp's avatar
knopp committed
774
      break;
knopp's avatar
   
knopp committed
775
    }
Cedric Roux's avatar
Cedric Roux committed
776

knopp's avatar
knopp committed
777
778
779
780
781
782
783
    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);
784
785
786
787
  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
788
789
790
791
792
793
794
795
796
797
798
799
800
  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;
801
  hi_dci0_req->sfn_sf = sfnsf_add_subframe(frameP,subframeP, sf_ahead_dl);
knopp's avatar
knopp committed
802
803
804
805
806
807
808
809
810
  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 ) {
811
      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
812
813
814
815
816
817
818
819
      *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
820
    }
knopp's avatar
knopp committed
821
  }
822

knopp's avatar
knopp committed
823
824
  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
825
826
}

827
828
uint32_t bytes_to_bsr_index(int32_t nbytes)
{
knopp's avatar
knopp committed
829
  uint32_t i = 0;
830

knopp's avatar
knopp committed
831
832
833
  if (nbytes < 0) {
    return (0);
  }
834

knopp's avatar
knopp committed
835
836
837
  while ((i < BSR_TABLE_SIZE) && (BSR_TABLE[i] <= nbytes)) {
    i++;
  }
838

knopp's avatar
knopp committed
839
  return (i - 1);
840
841
}

842
843
844
void
add_ue_ulsch_info(module_id_t module_idP, int CC_id, int UE_id,
		  sub_frame_t subframeP, UE_ULSCH_STATUS status)
845
{
knopp's avatar
knopp committed
846
847
848
  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;
849

knopp's avatar
knopp committed
850
  eNB_ulsch_info[module_idP][CC_id][UE_id].serving_num++;
851
852
853
}

unsigned char *parse_ulsch_header(unsigned char *mac_header,
854
855
856
857
858
859
				  unsigned char *num_ce,
				  unsigned char *num_sdu,
				  unsigned char *rx_ces,
				  unsigned char *rx_lcids,
				  unsigned short *rx_lengths,
				  unsigned short tb_length)
860
{
knopp's avatar
knopp committed
861
862
863
864
  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;
865

knopp's avatar
knopp committed
866
  while (not_done == 1) {
867

knopp's avatar
knopp committed
868
869
870
    if (((SCH_SUBHEADER_FIXED *) mac_header_ptr)->E == 0) {
      not_done = 0;
    }
871

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

knopp's avatar
knopp committed
874
875
876
877
    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;
878

knopp's avatar
knopp committed
879
880
881
	for (num_sdu_cnt = 0; num_sdu_cnt < num_sdus;
	     num_sdu_cnt++) {
	  length -= rx_lengths[num_sdu_cnt];
882
	}
knopp's avatar
knopp committed
883
884
885
886
887
888
889
890
891
892
      } 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);
893
	}
knopp's avatar
knopp committed
894
895
896
897
898
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
      }

      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);
921
922
	  //AssertFatal(1 == 0, "unknown CE");
          return NULL;
knopp's avatar
knopp committed
923
924
	}
      }
knopp's avatar
   
knopp committed
925
    }
knopp's avatar
knopp committed
926
  }
927

knopp's avatar
knopp committed
928
929
  *num_ce = num_ces;
  *num_sdu = num_sdus;
930

knopp's avatar
knopp committed
931
  return (mac_header_ptr);
932
933
}

934
935
936
937
938
/* 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).
 */
939
void
940
set_msg3_subframe(module_id_t mod_id,
941
942
943
944
		  int CC_id,
		  int frame,
		  int subframe, int rnti, int Msg3_frame,
		  int Msg3_subframe)
945
{
946
  eNB_MAC_INST *mac = RC.mac[mod_id];
knopp's avatar
knopp committed
947
948
949
950
951
952
953
  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;
954
    }
knopp's avatar
knopp committed
955
  }
956
}
957

958
959
960
void
schedule_ulsch(module_id_t module_idP, frame_t frameP,
	       sub_frame_t subframeP)
Cedric Roux's avatar
Cedric Roux committed
961
{
Niccolò Iardella's avatar
Niccolò Iardella committed
962
  uint16_t first_rb[NFAPI_CC_MAX], i;
knopp's avatar
knopp committed
963
964
  int CC_id;
  eNB_MAC_INST *mac = RC.mac[module_idP];
965
  slice_info_t *sli = &RC.mac[module_idP]->slice_info;
knopp's avatar
knopp committed
966
967
968
969
  COMMON_channels_t *cc;

  start_meas(&mac->schedule_ulsch);

970
  int sched_frame=frameP;
knopp's avatar
knopp committed
971
972
973
974
975
976
977
978
979
  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:
980
      if ((tdd_sfa == 0) || (tdd_sfa == 3))
knopp's avatar
knopp committed
981
	sched_subframe = 4;
982
983
      else if (tdd_sfa == 6)
	sched_subframe = 7;
knopp's avatar
knopp committed
984
985
986
987
988
989
990
991
      else
	return;
      break;
    case 1:
      if ((tdd_sfa == 0) || (tdd_sfa == 1))
	sched_subframe = 7;
      else if (tdd_sfa == 6)
	sched_subframe = 8;
992
993
      else
        return;
knopp's avatar
knopp committed
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015
      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)
1016
	sched_subframe = 2;
knopp's avatar
knopp committed
1017
1018
1019
1020
      else
	return;
      break;
    case 6:
1021
      if (tdd_sfa == 0 || tdd_sfa == 1)
knopp's avatar
knopp committed
1022
1023
1024
1025
1026
1027
1028
1029
1030
	sched_subframe = 2;
      else if (tdd_sfa == 6)
	sched_subframe = 3;
      else
	return;
      break;
    case 7:
      return;
    case 8:
1031
1032
      if ((tdd_sfa >= 2) && (tdd_sfa <= 5))
        sched_subframe = 2;
knopp's avatar
knopp committed
1033
      else
1034
        return;
knopp's avatar
knopp committed
1035
1036
1037
      break;
    case 9:
      if ((tdd_sfa == 1) || (tdd_sfa == 3) || (tdd_sfa == 4))
1038
        sched_subframe = 3;
knopp's avatar
knopp committed
1039
      else if (tdd_sfa == 6)
1040
        sched_subframe = 4;
knopp's avatar
knopp committed
1041
      else
1042
        return;
knopp's avatar
knopp committed
1043
      break;
1044
    }
knopp's avatar
knopp committed
1045
  }
1046

1047
  if (sched_subframe < subframeP) sched_frame++;
1048

1049
  for (CC_id = 0; CC_id < RC.nb_mac_CC[module_idP]; CC_id++) {
knopp's avatar
knopp committed
1050
1051
    //leave out first RB for PUCCH
    first_rb[CC_id] = 1;
gauthier's avatar
   
gauthier committed
1052

knopp's avatar
knopp committed
1053
1054
1055
1056
    // 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
1057

knopp's avatar
knopp committed
1058
1059
    // default function for default scheduling
    //
gauthier's avatar
   
gauthier committed
1060

knopp's avatar
knopp committed
1061
1062
1063
1064
    // 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
1065

knopp's avatar
knopp committed
1066
1067
1068
1069
1070
1071
1072
    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
1073
    }
knopp's avatar
knopp committed
1074
  }
1075

1076
  for (i = 0; i < sli->n_ul; i++) {
1077
    // Run each enabled slice-specific schedulers one by one
1078
    sli->ul[i].sched_cb(module_idP, i, frameP, subframeP, sched_subframe, first_rb);
1079
  }
gauthier's avatar
   
gauthier committed
1080

knopp's avatar
knopp committed
1081
  stop_meas(&mac->schedule_ulsch);
1082
1083
}

1084
1085
void
schedule_ulsch_rnti(module_id_t module_idP,
1086
        int slice_idx,
1087
1088
1089
		    frame_t frameP,
		    sub_frame_t subframeP,
		    unsigned char sched_subframeP, uint16_t * first_rb)
1090
{
knopp's avatar
knopp committed
1091
1092
1093
1094
1095
1096
1097
1098
  int UE_id;
  uint8_t aggregation = 2;
  rnti_t rnti = -1;
  uint8_t round = 0;
  uint8_t harq_pid = 0;
  uint8_t status = 0;
  uint8_t rb_table_index = -1;
  uint32_t cqi_req, cshift, ndi, tpc;
1099
  int32_t normalized_rx_power, target_rx_power;
knopp's avatar
knopp committed
1100
1101
1102
1103
1104
1105
1106
1107
  static int32_t tpc_accumulated = 0;
  int n;
  int CC_id = 0;
  int drop_ue = 0;
  int N_RB_UL;
  eNB_MAC_INST *mac = RC.mac[module_idP];
  COMMON_channels_t *cc = mac->common_channels;
  UE_list_t *UE_list = &mac->UE_list;
1108
  slice_info_t *sli = &RC.mac[module_idP]->slice_info;
knopp's avatar
knopp committed
1109
1110
1111
1112
  UE_TEMPLATE *UE_template;
  UE_sched_ctrl *UE_sched_ctrl;
  int sched_frame = frameP;
  int rvidx_tab[4] = { 0, 2, 3, 1 };
1113
1114
  uint16_t          ul_req_index;
  uint8_t           dlsch_flag;
Niccolò Iardella's avatar
Niccolò Iardella committed
1115
  int first_rb_slice[NFAPI_CC_MAX];
knopp's avatar
knopp committed
1116
1117

  if (sched_subframeP < subframeP)
1118
      sched_frame++;
knopp's avatar
knopp committed
1119

1120
  nfapi_hi_dci0_request_t        *hi_dci0_req = &mac->HI_DCI0_req[CC_id][subframeP];
knopp's avatar
knopp committed
1121
1122
1123
1124
1125
  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;

  nfapi_ul_config_request_t *ul_req_tmp            = &mac->UL_req_tmp[CC_id][sched_subframeP];
  nfapi_ul_config_request_body_t *ul_req_tmp_body  = &ul_req_tmp->ul_config_request_body;
1126
  nfapi_ul_config_ulsch_harq_information *ulsch_harq_information;
Niccolò Iardella's avatar
Niccolò Iardella committed
1127

1128
	for (CC_id = 0; CC_id < RC.nb_mac_CC[module_idP]; ++CC_id) {
Niccolò Iardella's avatar
Niccolò Iardella committed
1129
    N_RB_UL = to_prb(cc[CC_id].ul_Bandwidth);
1130
		UE_list->first_rb_offset[CC_id][slice_idx] = cmin(N_RB_UL, sli->ul[slice_idx].first_rb);
Niccolò Iardella's avatar
Niccolò Iardella committed
1131
1132
	}

knopp's avatar
knopp committed
1133
  //LOG_D(MAC, "entering ulsch preprocesor\n");
1134
  ulsch_scheduler_pre_processor(module_idP, slice_idx, frameP, subframeP, sched_subframeP, first_rb);
knopp's avatar
knopp committed
1135

1136
	for (CC_id = 0; CC_id < RC.nb_mac_CC[module_idP]; ++CC_id) {
1137
    first_rb_slice[CC_id] = first_rb[CC_id] + UE_list->first_rb_offset[CC_id][slice_idx];
Niccolò Iardella's avatar
Niccolò Iardella committed
1138
  }
knopp's avatar
knopp committed
1139
1140
1141
1142
1143
1144
1145
1146
  //LOG_D(MAC, "exiting ulsch preprocesor\n");

  hi_dci0_req->sfn_sf = (frameP << 4) + subframeP;

  // loop over all active UEs
  for (UE_id = UE_list->head_ul; UE_id >= 0;
       UE_id = UE_list->next_ul[UE_id]) {

1147
    if (!ue_ul_slice_membership(module_idP, UE_id, slice_idx))
1148
1149
        continue;

knopp's avatar
knopp committed
1150
1151
    // don't schedule if Msg4 is not received yet
    if (UE_list->UE_template[UE_PCCID(module_idP, UE_id)][UE_id].
1152
1153
1154
1155
1156
        configured == FALSE) {
        LOG_D(MAC,
              "[eNB %d] frame %d subfarme %d, UE %d: not configured, skipping UE scheduling \n",
              module_idP, frameP, subframeP, UE_id);
        continue;
knopp's avatar
knopp committed
1157
    }
1158

knopp's avatar
knopp committed
1159
    rnti = UE_RNTI(module_idP, UE_id);