eNB_scheduler_primitives.c 44.4 KB
Newer Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
/*
 * Licensed to the OpenAirInterface (OAI) Software Alliance under one or more
 * contributor license agreements.  See the NOTICE file distributed with
 * this work for additional information regarding copyright ownership.
 * The OpenAirInterface Software Alliance licenses this file to You under
 * the OAI Public License, Version 1.0  (the "License"); you may not use this file
 * 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
22
23
/*! \file eNB_scheduler_primitives.c
 * \brief primitives used by eNB for BCH, RACH, ULSCH, DLSCH scheduling
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
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
 * @ingroup _mac

 */

#include "assertions.h"
#include "PHY/defs.h"
#include "PHY/extern.h"

#include "SCHED/defs.h"
#include "SCHED/extern.h"

#include "LAYER2/MAC/defs.h"
#include "LAYER2/MAC/extern.h"

#include "LAYER2/MAC/proto.h"
#include "UTIL/LOG/log.h"
#include "UTIL/LOG/vcd_signal_dumper.h"
#include "UTIL/OPT/opt.h"
#include "OCG.h"
#include "OCG_extern.h"

#include "RRC/LITE/extern.h"
#include "RRC/L2_INTERFACE/openair_rrc_L2_interface.h"

//#include "LAYER2/MAC/pre_processor.c"
#include "pdcp.h"

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

#define ENABLE_MAC_PAYLOAD_DEBUG
#define DEBUG_eNB_SCHEDULER 1

knopp's avatar
knopp committed
62
63
int to_prb(int dl_Bandwidth) {
  int prbmap[6] = {6,15,25,50,75,100};
64

knopp's avatar
knopp committed
65
66
67
68
69
70
71
72
73
74
  AssertFatal(dl_Bandwidth < 6,"dl_Bandwidth is 0..5\n");
  return(prbmap[dl_Bandwidth]);
}

int to_rbg(int dl_Bandwidth) {
  int rbgmap[6] = {6,8,13,17,19,25};

  AssertFatal(dl_Bandwidth < 6,"dl_Bandwidth is 0..5\n");
  return(rbgmap[dl_Bandwidth]);
}
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99


int get_phich_resource_times6(COMMON_channels_t *cc) {
  int phichmap[4] = {1,3,6,12};
  AssertFatal(cc!=NULL,"cc is null\n");
  AssertFatal(cc->mib!=NULL,"cc->mib is null\n");
  AssertFatal((cc->mib->message.phich_Config.phich_Resource>=0) && 
	      (cc->mib->message.phich_Config.phich_Resource<4),
	      "phich_Resource %d not in 0..3\n",(int)cc->mib->message.phich_Config.phich_Resource);

  return(phichmap[cc->mib->message.phich_Config.phich_Resource]);
}

uint16_t mac_computeRIV(uint16_t N_RB_DL,uint16_t RBstart,uint16_t Lcrbs) {

  uint16_t RIV;

  if (Lcrbs<=(1+(N_RB_DL>>1)))
    RIV = (N_RB_DL*(Lcrbs-1)) + RBstart;
  else
    RIV = (N_RB_DL*(N_RB_DL+1-Lcrbs)) + (N_RB_DL-1-RBstart);

  return(RIV);
}

100
//------------------------------------------------------------------------------
101
void init_ue_sched_info(void)
102
//------------------------------------------------------------------------------
103
{
104
  module_id_t i,j,k;
105
106

  for (i=0; i<NUMBER_OF_eNB_MAX; i++) {
Cedric Roux's avatar
Cedric Roux committed
107
    for (k=0; k<MAX_NUM_CCs; k++) {
108
109
110
111
112
113
114
115
116
117
      for (j=0; j<NUMBER_OF_UE_MAX; j++) {
        // init DL
        eNB_dlsch_info[i][k][j].weight           = 0;
        eNB_dlsch_info[i][k][j].subframe         = 0;
        eNB_dlsch_info[i][k][j].serving_num      = 0;
        eNB_dlsch_info[i][k][j].status           = S_DL_NONE;
        // init UL
        eNB_ulsch_info[i][k][j].subframe         = 0;
        eNB_ulsch_info[i][k][j].serving_num      = 0;
        eNB_ulsch_info[i][k][j].status           = S_UL_NONE;
118
      }
119
    }
120
121
122
123
124
  }
}



125
//------------------------------------------------------------------------------
126
unsigned char get_ue_weight(module_id_t module_idP, int CC_idP, int ue_idP)
127
//------------------------------------------------------------------------------
128
{
129

130
  return(eNB_dlsch_info[module_idP][CC_idP][ue_idP].weight);
131
132
133

}

134
//------------------------------------------------------------------------------
135
int find_UE_id(module_id_t mod_idP, rnti_t rntiP)
136
//------------------------------------------------------------------------------
137
{
knopp's avatar
   
knopp committed
138
  int UE_id;
139
  UE_list_t *UE_list = &RC.mac[mod_idP]->UE_list;
140

141
142
  for (UE_id = 0; UE_id < NUMBER_OF_UE_MAX; UE_id++) {
    if (UE_list->active[UE_id] != TRUE) continue;
knopp's avatar
   
knopp committed
143
144
145
    if (UE_list->UE_template[UE_PCCID(mod_idP,UE_id)][UE_id].rnti==rntiP) {
      return(UE_id);
    }
146
  }
147

knopp's avatar
   
knopp committed
148
  return(-1);
149
150
}

151
//------------------------------------------------------------------------------
152
int UE_num_active_CC(UE_list_t *listP,int ue_idP)
153
//------------------------------------------------------------------------------
154
{
knopp's avatar
   
knopp committed
155
156
  return(listP->numactiveCCs[ue_idP]);
}
157

158
//------------------------------------------------------------------------------
159
int UE_PCCID(module_id_t mod_idP,int ue_idP)
160
//------------------------------------------------------------------------------
161
{
162
  return(RC.mac[mod_idP]->UE_list.pCC_id[ue_idP]);
knopp's avatar
   
knopp committed
163
}
164

165
//------------------------------------------------------------------------------
166
rnti_t UE_RNTI(module_id_t mod_idP, int ue_idP)
167
//------------------------------------------------------------------------------
168
{
169

170
  rnti_t rnti = RC.mac[mod_idP]->UE_list.UE_template[UE_PCCID(mod_idP,ue_idP)][ue_idP].rnti;
171

172
  if (rnti>0) {
knopp's avatar
   
knopp committed
173
    return (rnti);
174
  }
175

176
  LOG_D(MAC,"[eNB %d] Couldn't find RNTI for UE %d\n",mod_idP,ue_idP);
177
178
  //display_backtrace();
  return(NOT_A_RNTI);
179
}
knopp's avatar
   
knopp committed
180

181
//------------------------------------------------------------------------------
182
boolean_t is_UE_active(module_id_t mod_idP, int ue_idP)
183
//------------------------------------------------------------------------------
184
{
185
  return(RC.mac[mod_idP]->UE_list.active[ue_idP]);
186
}
knopp's avatar
   
knopp committed
187
188
189

/*
uint8_t find_active_UEs(module_id_t module_idP,int CC_id){
190
191
192
193
194
195
196

  module_id_t        ue_mod_id      = 0;
  rnti_t        rnti         = 0;
  uint8_t            nb_active_ue = 0;

  for (ue_mod_id=0;ue_mod_id<NUMBER_OF_UE_MAX;ue_mod_id++) {

knopp's avatar
   
knopp committed
197
      if (((rnti=eNB_mac_inst[module_idP][CC_id].UE_template[ue_mod_id].rnti) !=0)&&(eNB_mac_inst[module_idP][CC_id].UE_template[ue_mod_id].ul_active==TRUE)){
198
199

          if (mac_xface->get_eNB_UE_stats(module_idP,rnti) != NULL){ // check at the phy enb_ue state for this rnti
200
      nb_active_ue++;
201
202
          }
          else { // this ue is removed at the phy => remove it at the mac as well
203
      mac_remove_ue(module_idP, CC_id, ue_mod_id);
204
205
206
207
208
          }
      }
  }
  return(nb_active_ue);
}
knopp's avatar
   
knopp committed
209
*/
210
211


212
213
// get aggregation (L) form phy for a give UE
unsigned char get_aggregation (uint8_t bw_index, uint8_t cqi, uint8_t dci_fmt)
214
{
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
  unsigned char aggregation=3;
  
  switch (dci_fmt){
    
  case format0:
    aggregation = cqi2fmt0_agg[bw_index][cqi];
    break;
  case format1:
  case format1A:
  case format1B:
  case format1D:
    aggregation = cqi2fmt1x_agg[bw_index][cqi]; 
    break;
  case format2:
  case format2A:
  case format2B:
  case format2C:
  case format2D:
    aggregation = cqi2fmt2x_agg[bw_index][cqi]; 
    break;
  case format1C:
  case format1E_2A_M10PRB:
  case format3:
  case format3A:
  case format4:
  default:
    LOG_W(MAC,"unsupported DCI format %d\n",dci_fmt);
  }

   LOG_D(MAC,"Aggregation level %d (cqi %d, bw_index %d, format %d)\n", 
   	1<<aggregation, cqi,bw_index,dci_fmt);
   
247
  return 1<<aggregation;
248
}
knopp's avatar
   
knopp committed
249

250
251
void dump_ue_list(UE_list_t *listP, int ul_flag)
{
knopp's avatar
   
knopp committed
252
  int j;
253
254
255

  if ( ul_flag == 0 ) {
    for (j=listP->head; j>=0; j=listP->next[j]) {
256
257
258
      LOG_T(MAC,"node %d => %d\n",j,listP->next[j]);
    }
  } else {
259
    for (j=listP->head_ul; j>=0; j=listP->next_ul[j]) {
260
261
      LOG_T(MAC,"node %d => %d\n",j,listP->next_ul[j]);
    }
knopp's avatar
   
knopp committed
262
263
264
  }
}

265
266
int add_new_ue(module_id_t mod_idP, int cc_idP, rnti_t rntiP,int harq_pidP)
{
knopp's avatar
   
knopp committed
267
  int UE_id;
268
  int i, j;
269

270
  UE_list_t *UE_list = &RC.mac[mod_idP]->UE_list;
271

knopp's avatar
   
knopp committed
272
  LOG_D(MAC,"[eNB %d, CC_id %d] Adding UE with rnti %x (next avail %d, num_UEs %d)\n",mod_idP,cc_idP,rntiP,UE_list->avail,UE_list->num_UEs);
273
  dump_ue_list(UE_list,0);
knopp's avatar
   
knopp committed
274

275
276
  for (i = 0; i < NUMBER_OF_UE_MAX; i++) {
    if (UE_list->active[i] == TRUE) continue;
277
printf("MAC: new UE id %d rnti %x\n", i, rntiP);
278
    UE_id = i;
knopp's avatar
   
knopp committed
279
280
281
282
283
284
285
    UE_list->UE_template[cc_idP][UE_id].rnti       = rntiP;
    UE_list->UE_template[cc_idP][UE_id].configured = FALSE;
    UE_list->numactiveCCs[UE_id]                   = 1;
    UE_list->numactiveULCCs[UE_id]                 = 1;
    UE_list->pCC_id[UE_id]                         = cc_idP;
    UE_list->ordered_CCids[0][UE_id]               = cc_idP;
    UE_list->ordered_ULCCids[0][UE_id]             = cc_idP;
knopp's avatar
   
knopp committed
286
    UE_list->num_UEs++;
knopp's avatar
   
knopp committed
287
    UE_list->active[UE_id]                         = TRUE;
288
    memset((void*)&UE_list->UE_sched_ctrl[UE_id],0,sizeof(UE_sched_ctrl));
knopp's avatar
   
knopp committed
289

290
291
    for (j=0; j<8; j++) {
      UE_list->UE_template[cc_idP][UE_id].oldNDI[j]    = (j==0)?1:0;   // 1 because first transmission is with format1A (Msg4) for harq_pid 0
knopp's avatar
   
knopp committed
292
      UE_list->UE_template[cc_idP][UE_id].oldNDI_UL[j] = (j==harq_pidP)?0:1; // 1st transmission is with Msg3;
knopp's avatar
   
knopp committed
293
    }
294

295
    eNB_ulsch_info[mod_idP][cc_idP][UE_id].status = S_UL_WAITING;
296
    eNB_dlsch_info[mod_idP][cc_idP][UE_id].status = S_DL_WAITING;
knopp's avatar
   
knopp committed
297
    LOG_D(MAC,"[eNB %d] Add UE_id %d on Primary CC_id %d: rnti %x\n",mod_idP,UE_id,cc_idP,rntiP);
298
    dump_ue_list(UE_list,0);
knopp's avatar
   
knopp committed
299
    return(UE_id);
300
  }
knopp's avatar
   
knopp committed
301

302
printf("MAC: cannot add new UE for rnti %x\n", rntiP);
knopp's avatar
   
knopp committed
303
  LOG_E(MAC,"error in add_new_ue(), could not find space in UE_list, Dumping UE list\n");
304
  dump_ue_list(UE_list,0);
305
306
307
  return(-1);
}

308
//------------------------------------------------------------------------------
309
int rrc_mac_remove_ue(module_id_t mod_idP,rnti_t rntiP) 
310
//------------------------------------------------------------------------------
311
{
312
  int i;
313
  UE_list_t *UE_list = &RC.mac[mod_idP]->UE_list;
314
  int UE_id = find_UE_id(mod_idP,rntiP);
315
  int pCC_id;
316

317
  if (UE_id == -1) {
318
printf("MAC: cannot remove UE rnti %x\n", rntiP);
319
    LOG_W(MAC,"rrc_mac_remove_ue: UE %x not found\n", rntiP);
320
    mac_phy_remove_ue(mod_idP, rntiP);
321
322
323
    return 0;
  }

324
325
  pCC_id = UE_PCCID(mod_idP,UE_id);

326
printf("MAC: remove UE %d rnti %x\n", UE_id, rntiP);
327
  LOG_I(MAC,"Removing UE %d from Primary CC_id %d (rnti %x)\n",UE_id,pCC_id, rntiP);
328
  dump_ue_list(UE_list,0);
329

330
331
332
  UE_list->active[UE_id] = FALSE;
  UE_list->num_UEs--;

333
  // clear all remaining pending transmissions
334
335
336
337
338
339
340
341
342
343
344
345
  UE_list->UE_template[pCC_id][UE_id].bsr_info[LCGID0]  = 0;
  UE_list->UE_template[pCC_id][UE_id].bsr_info[LCGID1]  = 0;
  UE_list->UE_template[pCC_id][UE_id].bsr_info[LCGID2]  = 0;
  UE_list->UE_template[pCC_id][UE_id].bsr_info[LCGID3]  = 0;

  UE_list->UE_template[pCC_id][UE_id].ul_SR             = 0;
  UE_list->UE_template[pCC_id][UE_id].rnti              = NOT_A_RNTI;
  UE_list->UE_template[pCC_id][UE_id].ul_active         = FALSE;
  eNB_ulsch_info[mod_idP][pCC_id][UE_id].rnti                        = NOT_A_RNTI;
  eNB_ulsch_info[mod_idP][pCC_id][UE_id].status                      = S_UL_NONE;
  eNB_dlsch_info[mod_idP][pCC_id][UE_id].rnti                        = NOT_A_RNTI;
  eNB_dlsch_info[mod_idP][pCC_id][UE_id].status                      = S_DL_NONE;
knopp's avatar
   
knopp committed
346

347
348
  mac_phy_remove_ue(mod_idP,rntiP);

349
350
351
  // check if this has an RA process active
  RA_TEMPLATE *RA_template;
  for (i=0;i<NB_RA_PROC_MAX;i++) {
352
    RA_template = (RA_TEMPLATE *)&RC.mac[mod_idP]->common_channels[pCC_id].RA_template[i];
353
    if (RA_template->rnti == rntiP){
354
355
356
357
358
359
360
      RA_template->RA_active=FALSE;
      RA_template->generate_rar=0;
      RA_template->generate_Msg4=0;
      RA_template->wait_ack_Msg4=0;
      RA_template->timing_offset=0;
      RA_template->RRC_timer=20;
      RA_template->rnti = 0;
361
      //break;
362
363
    }
  }
knopp's avatar
   
knopp committed
364

365
  return 0;
366
367
368
}


knopp's avatar
   
knopp committed
369

370
371
int prev(UE_list_t *listP, int nodeP, int ul_flag)
{
knopp's avatar
   
knopp committed
372
  int j;
373

374
  if (ul_flag == 0 ) {
375
    if (nodeP==listP->head) {
376
      return(nodeP);
377
    }
378
379

    for (j=listP->head; j>=0; j=listP->next[j]) {
380
      if (listP->next[j]==nodeP) {
381
        return(j);
382
    }
383
    }
384
  } else {
385
    if (nodeP==listP->head_ul) {
386
      return(nodeP);
387
    }
388
389

    for (j=listP->head_ul; j>=0; j=listP->next_ul[j]) {
390
      if (listP->next_ul[j]==nodeP) {
391
        return(j);
392
      }
393
    }
knopp's avatar
   
knopp committed
394
  }
knopp's avatar
   
knopp committed
395

396
  LOG_E(MAC,"error in prev(), could not find previous to %d in UE_list %s, should never happen, Dumping UE list\n",
397
        nodeP, (ul_flag == 0)? "DL" : "UL");
398
  dump_ue_list(listP, ul_flag);
knopp's avatar
   
knopp committed
399
400


knopp's avatar
   
knopp committed
401
402
  return(-1);
}
403

404
405
void swap_UEs(UE_list_t *listP,int nodeiP, int nodejP, int ul_flag)
{
406

knopp's avatar
   
knopp committed
407
408
  int prev_i,prev_j,next_i,next_j;

409
410
  LOG_T(MAC,"Swapping UE %d,%d\n",nodeiP,nodejP);
  dump_ue_list(listP,ul_flag);
knopp's avatar
   
knopp committed
411

412
413
  prev_i = prev(listP,nodeiP,ul_flag);
  prev_j = prev(listP,nodejP,ul_flag);
414

415
416
  AssertFatal((prev_i>=0) && (prev_j>=0),
	      "swap_UEs: problem");
knopp's avatar
   
knopp committed
417

418
  if (ul_flag == 0) {
419
420
421
422
423
    next_i = listP->next[nodeiP];
    next_j = listP->next[nodejP];
  } else {
    next_i = listP->next_ul[nodeiP];
    next_j = listP->next_ul[nodejP];
knopp's avatar
   
knopp committed
424
  }
knopp's avatar
   
knopp committed
425

426
  LOG_T(MAC,"[%s] next_i %d, next_i, next_j %d, head %d \n",
427
428
        (ul_flag == 0)? "DL" : "UL",
        next_i,next_j,listP->head);
429
430

  if (ul_flag == 0 ) {
knopp's avatar
   
knopp committed
431

432
433
    if (next_i == nodejP) {   // case ... p(i) i j n(j) ... => ... p(j) j i n(i) ...
      LOG_T(MAC,"Case ... p(i) i j n(j) ... => ... p(j) j i n(i) ...\n");
434

435
436
      listP->next[nodeiP] = next_j;
      listP->next[nodejP] = nodeiP;
437

438
      if (nodeiP==listP->head) { // case i j n(j)
439
        listP->head = nodejP;
440
      } else {
441
        listP->next[prev_i] = nodejP;
442
      }
443
    } else if (next_j == nodeiP) {  // case ... p(j) j i n(i) ... => ... p(i) i j n(j) ...
444
445
446
      LOG_T(MAC,"Case ... p(j) j i n(i) ... => ... p(i) i j n(j) ...\n");
      listP->next[nodejP] = next_i;
      listP->next[nodeiP] = nodejP;
447

448
      if (nodejP==listP->head) { // case j i n(i)
449
        listP->head = nodeiP;
450
      } else {
451
        listP->next[prev_j] = nodeiP;
452
      }
453
    } else {  // case ...  p(i) i n(i) ... p(j) j n(j) ...
454
455
      listP->next[nodejP] = next_i;
      listP->next[nodeiP] = next_j;
456
457


458
      if (nodeiP==listP->head) {
459
460
461
462
463
464
465
466
467
468
        LOG_T(MAC,"changing head to %d\n",nodejP);
        listP->head=nodejP;
        listP->next[prev_j] = nodeiP;
      } else if (nodejP==listP->head) {
        LOG_D(MAC,"changing head to %d\n",nodeiP);
        listP->head=nodeiP;
        listP->next[prev_i] = nodejP;
      } else {
        listP->next[prev_i] = nodejP;
        listP->next[prev_j] = nodeiP;
469
470
471
472
473
474
      }
    }
  } else { // ul_flag

    if (next_i == nodejP) {   // case ... p(i) i j n(j) ... => ... p(j) j i n(i) ...
      LOG_T(MAC,"[UL] Case ... p(i) i j n(j) ... => ... p(j) j i n(i) ...\n");
475

476
477
      listP->next_ul[nodeiP] = next_j;
      listP->next_ul[nodejP] = nodeiP;
478

479
      if (nodeiP==listP->head_ul) { // case i j n(j)
480
        listP->head_ul = nodejP;
481
      } else {
482
        listP->next_ul[prev_i] = nodejP;
483
      }
484
    } else if (next_j == nodeiP) {  // case ... p(j) j i n(i) ... => ... p(i) i j n(j) ...
485
486
487
      LOG_T(MAC,"[UL]Case ... p(j) j i n(i) ... => ... p(i) i j n(j) ...\n");
      listP->next_ul[nodejP] = next_i;
      listP->next_ul[nodeiP] = nodejP;
488

489
      if (nodejP==listP->head_ul) { // case j i n(i)
490
        listP->head_ul = nodeiP;
491
      } else {
492
        listP->next_ul[prev_j] = nodeiP;
493
      }
494
495
    } else {  // case ...  p(i) i n(i) ... p(j) j n(j) ...

496
497
      listP->next_ul[nodejP] = next_i;
      listP->next_ul[nodeiP] = next_j;
498
499


500
      if (nodeiP==listP->head_ul) {
501
502
503
504
505
506
507
508
509
510
        LOG_T(MAC,"[UL]changing head to %d\n",nodejP);
        listP->head_ul=nodejP;
        listP->next_ul[prev_j] = nodeiP;
      } else if (nodejP==listP->head_ul) {
        LOG_T(MAC,"[UL]changing head to %d\n",nodeiP);
        listP->head_ul=nodeiP;
        listP->next_ul[prev_i] = nodejP;
      } else {
        listP->next_ul[prev_i] = nodejP;
        listP->next_ul[prev_j] = nodeiP;
511
      }
knopp's avatar
   
knopp committed
512
513
    }
  }
514

515
516
  LOG_T(MAC,"After swap\n");
  dump_ue_list(listP,ul_flag);
knopp's avatar
   
knopp committed
517
518
519
520
}



521

522
523
524
525
526




/*
Cedric Roux's avatar
Cedric Roux committed
527
  #if defined(Rel10) || defined(Rel14)
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
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
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
  unsigned char generate_mch_header( unsigned char *mac_header,
  unsigned char num_sdus,
  unsigned short *sdu_lengths,
  unsigned char *sdu_lcids,
  unsigned char msi,
  unsigned char short_padding,
  unsigned short post_padding) {

  SCH_SUBHEADER_FIXED *mac_header_ptr = (SCH_SUBHEADER_FIXED *)mac_header;
  uint8_t first_element=0,last_size=0,i;
  uint8_t mac_header_control_elements[2*num_sdus],*ce_ptr;

  ce_ptr = &mac_header_control_elements[0];

  if ((short_padding == 1) || (short_padding == 2)) {
  mac_header_ptr->R    = 0;
  mac_header_ptr->E    = 0;
  mac_header_ptr->LCID = SHORT_PADDING;
  first_element=1;
  last_size=1;
  }
  if (short_padding == 2) {
  mac_header_ptr->E = 1;
  mac_header_ptr++;
  mac_header_ptr->R = 0;
  mac_header_ptr->E    = 0;
  mac_header_ptr->LCID = SHORT_PADDING;
  last_size=1;
  }

  // SUBHEADER for MSI CE
  if (msi != 0) {// there is MSI MAC Control Element
  if (first_element>0) {
  mac_header_ptr->E = 1;
  mac_header_ptr+=last_size;
  }
  else {
  first_element = 1;
  }
  if (num_sdus*2 < 128) {
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->R    = 0;
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->E    = 0;
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->F    = 0;
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->LCID = MCH_SCHDL_INFO;
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->L    = num_sdus*2;
  last_size=2;
  }
  else {
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->R    = 0;
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->E    = 0;
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->F    = 1;
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->LCID = MCH_SCHDL_INFO;
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->L    = (num_sdus*2)&0x7fff;
  last_size=3;
  }
  // Create the MSI MAC Control Element here
  }

  // SUBHEADER for MAC SDU (MCCH+MTCHs)
  for (i=0;i<num_sdus;i++) {
  if (first_element>0) {
  mac_header_ptr->E = 1;
  mac_header_ptr+=last_size;
  }
  else {
  first_element = 1;
  }
  if (sdu_lengths[i] < 128) {
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->R    = 0;
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->E    = 0;
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->F    = 0;
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->LCID = sdu_lcids[i];
  ((SCH_SUBHEADER_SHORT *)mac_header_ptr)->L    = (unsigned char)sdu_lengths[i];
  last_size=2;
  }
  else {
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->R    = 0;
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->E    = 0;
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->F    = 1;
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->LCID = sdu_lcids[i];
  ((SCH_SUBHEADER_LONG *)mac_header_ptr)->L    = (unsigned short) sdu_lengths[i]&0x7fff;
  last_size=3;
  }
  }

  if (post_padding>0) {// we have lots of padding at the end of the packet
  mac_header_ptr->E = 1;
  mac_header_ptr+=last_size;
  // add a padding element
  mac_header_ptr->R    = 0;
  mac_header_ptr->E    = 0;
  mac_header_ptr->LCID = SHORT_PADDING;
  mac_header_ptr++;
  }
  else { // no end of packet padding
  // last SDU subhead is of fixed type (sdu length implicitly to be computed at UE)
  mac_header_ptr++;
  }

  // Copy MSI Control Element to the end of the MAC Header if it presents
  if ((ce_ptr-mac_header_control_elements) > 0) {
  // printf("Copying %d bytes for control elements\n",ce_ptr-mac_header_control_elements);
  memcpy((void*)mac_header_ptr,mac_header_control_elements,ce_ptr-mac_header_control_elements);
  mac_header_ptr+=(unsigned char)(ce_ptr-mac_header_control_elements);
  }

  return((unsigned char*)mac_header_ptr - mac_header);
  }
  #endif
 */



// This has to be updated to include BSR information
642
643
uint8_t UE_is_to_be_scheduled(module_id_t module_idP,int CC_id,uint8_t UE_id)
{
644

645
646
  UE_TEMPLATE *UE_template    = &RC.mac[module_idP]->UE_list.UE_template[CC_id][UE_id];
  UE_sched_ctrl *UE_sched_ctl = &RC.mac[module_idP]->UE_list.UE_sched_ctrl[UE_id];
647

648

Florian Kaltenberger's avatar
Florian Kaltenberger committed
649
650
651
652
653
654
  // do not schedule UE if UL is not working
  if (UE_sched_ctl->ul_failure_timer>0)
    return(0);
  if (UE_sched_ctl->ul_out_of_sync>0)
    return(0);

655
656
  LOG_D(MAC,"[eNB %d][PUSCH] Checking UL requirements UE %d/%x\n",module_idP,UE_id,UE_RNTI(module_idP,UE_id));

knopp's avatar
   
knopp committed
657
658
659
660
  if ((UE_template->bsr_info[LCGID0]>0) ||
      (UE_template->bsr_info[LCGID1]>0) ||
      (UE_template->bsr_info[LCGID2]>0) ||
      (UE_template->bsr_info[LCGID3]>0) ||
gauthier's avatar
gauthier committed
661
      (UE_template->ul_SR>0) || // uplink scheduling request
662
      ((UE_sched_ctl->ul_inactivity_timer>20)&&
663
664
665
666
667
       (UE_sched_ctl->ul_scheduled==0))||  // every 2 frames when RRC_CONNECTED
      ((UE_sched_ctl->ul_inactivity_timer>10)&&
       (UE_sched_ctl->ul_scheduled==0)&&
       (mac_eNB_get_rrc_status(module_idP,UE_RNTI(module_idP,UE_id)) < RRC_CONNECTED))) // every Frame when not RRC_CONNECTED
    { 
668

669
    LOG_D(MAC,"[eNB %d][PUSCH] UE %d/%x should be scheduled\n",module_idP,UE_id,UE_RNTI(module_idP,UE_id));
670
    return(1);
671
  } else {
672
    return(0);
673
  }
674
675
676
}


677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
uint8_t get_tmode(module_id_t module_idP,int CC_idP,int UE_idP) {

  eNB_MAC_INST         *eNB                                = RC.mac[module_idP];
  COMMON_channels_t    *cc                                 = &eNB->common_channels[CC_idP];

  struct PhysicalConfigDedicated  *physicalConfigDedicated = eNB->UE_list.physicalConfigDedicated[CC_idP][UE_idP];

  AssertFatal(physicalConfigDedicated->antennaInfo!=NULL,
	      "antennaInfo is null for CCId %d, UEid %d\n",CC_idP,UE_idP);

  AssertFatal(physicalConfigDedicated->antennaInfo->present != PhysicalConfigDedicated__antennaInfo_PR_NOTHING, 
	      "antennaInfo (mod_id %d, CC_id %d) is set to NOTHING\n",module_idP,CC_idP);

  if (physicalConfigDedicated->antennaInfo->present == PhysicalConfigDedicated__antennaInfo_PR_explicitValue) {
    return(physicalConfigDedicated->antennaInfo->choice.explicitValue.transmissionMode);
  }
  else if (physicalConfigDedicated->antennaInfo->present == PhysicalConfigDedicated__antennaInfo_PR_defaultValue) {
    AssertFatal(cc->p_eNB<=2,"p_eNB is %d, should be <2\n",cc->p_eNB);
    return(cc->p_eNB);
  }
  else AssertFatal(1==0,"Shouldn't be here\n");

}

int8_t get_UL_harq(module_id_t module_idP,int CC_idP,uint16_t frameP,uint8_t subframeP) {

  uint8_t           ret       = -1;
  eNB_MAC_INST      *eNB      = RC.mac[module_idP];
  COMMON_channels_t *cc       = &eNB->common_channels[CC_idP];

  if (cc->tdd_Config==NULL) { // FDD
    ret = (((frameP<<1)+subframeP)&7);
  } else {

    switch (cc->tdd_Config->subframeAssignment) {

    case 1:
      if ((subframeP==2) ||
          (subframeP==3) ||
          (subframeP==7) ||
          (subframeP==8))
        switch (subframeP) {
        case 2:
        case 3:
          ret = (subframeP-2);
          break;

        case 7:
        case 8:
          ret = (subframeP-5);
          break;

        default:
          LOG_E(PHY,"subframe2_harq_pid, Illegal subframe %d for TDD mode %d\n",subframeP,cc->tdd_Config->subframeAssignment);
          ret = -1;
          break;
        }

      break;

    case 2:
      if ((subframeP!=2) && (subframeP!=7)) {
	LOG_E(PHY,"subframe2_harq_pid, Illegal subframe %d for TDD mode %d\n",subframeP,cc->tdd_Config->subframeAssignment);
	ret=-1;
      }
      else ret = (subframeP/7);
      break;

    case 3:
      if ((subframeP<2) || (subframeP>4)) {
        LOG_E(PHY,"subframe2_harq_pid, Illegal subframe %d for TDD mode %d\n",subframeP,cc->tdd_Config->subframeAssignment);
        ret = -1;
      }
      else ret = (subframeP-2);
      break;

    case 4:
      if ((subframeP<2) || (subframeP>3)) {
        LOG_E(PHY,"subframe2_harq_pid, Illegal subframe %d for TDD mode %d\n",subframeP,cc->tdd_Config->subframeAssignment);
        ret = -1;
      }
      else ret = (subframeP-2);
      break;

    case 5:
      if (subframeP!=2) {
        LOG_E(PHY,"subframe2_harq_pid, Illegal subframe %d for TDD mode %d\n",subframeP,cc->tdd_Config->subframeAssignment);
        ret = -1;
      }
      else ret = (subframeP-2);
      break;

    default:
      LOG_E(PHY,"subframe2_harq_pid, Unsupported TDD mode %d\n",cc->tdd_Config->subframeAssignment);
      ret = -1;
    }
  }

  AssertFatal(ret!=-1,
	      "invalid harq_pid(%d) at SFN/SF = %d/%d\n", (int8_t)ret, frameP, subframeP);
  return ret;
}


uint16_t getRIV(uint16_t N_RB_DL,uint16_t RBstart,uint16_t Lcrbs)
{

  uint16_t RIV;

  if (Lcrbs<=(1+(N_RB_DL>>1)))
    RIV = (N_RB_DL*(Lcrbs-1)) + RBstart;
  else
    RIV = (N_RB_DL*(N_RB_DL+1-Lcrbs)) + (N_RB_DL-1-RBstart);
790

791
792
  return(RIV);
}
793

knopp's avatar
knopp committed
794
uint32_t allocate_prbs(int UE_id,unsigned char nb_rb, int N_RB_DL, uint32_t *rballoc)
795
{
796
797
798
799
800

  int i;
  uint32_t rballoc_dci=0;
  unsigned char nb_rb_alloc=0;

knopp's avatar
knopp committed
801
  for (i=0; i<(N_RB_DL-2); i+=2) {
802
803
804
805
806
807
    if (((*rballoc>>i)&3)==0) {
      *rballoc |= (3<<i);
      rballoc_dci |= (1<<((12-i)>>1));
      nb_rb_alloc+=2;
    }

808
    if (nb_rb_alloc==nb_rb) {
809
      return(rballoc_dci);
810
    }
811
812
  }

knopp's avatar
knopp committed
813
814
815
816
  if ((N_RB_DL&1)==1) {
    if ((*rballoc>>(N_RB_DL-1)&1)==0) {
      *rballoc |= (1<<(N_RB_DL-1));
      rballoc_dci |= 1;
817
    }
818
  }
819

820
821
822
  return(rballoc_dci);
}

823
824
825
826
int get_bw_index(module_id_t module_id, uint8_t CC_id)
{

  int bw_index=0;
knopp's avatar
knopp committed
827
828
 
  int N_RB_DL = to_prb(RC.mac[module_id]->common_channels[CC_id].mib->message.dl_Bandwidth);
829

knopp's avatar
knopp committed
830
  switch (N_RB_DL) {
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
  case 6: // 1.4 MHz
    bw_index=0;
    break;

  case 25: // 5HMz
    bw_index=1;
    break;

  case 50: // 10HMz
    bw_index=2;
    break;

  case 100: // 20HMz
    bw_index=3;
    break;

  default:
    bw_index=1;
knopp's avatar
knopp committed
849
    LOG_W(MAC,"[eNB %d] N_RB_DL %d unknown for CC_id %d, setting bw_index to 1\n", module_id, N_RB_DL,CC_id);
850
851
852
853
854
855
    break;
  }

  return bw_index;
}

856
857
858
int get_min_rb_unit(module_id_t module_id, uint8_t CC_id)
{

859
  int min_rb_unit=0;
knopp's avatar
knopp committed
860
  int N_RB_DL = to_prb(RC.mac[module_id]->common_channels[CC_id].mib->message.dl_Bandwidth);
861

knopp's avatar
knopp committed
862
  switch (N_RB_DL) {
863
864
865
  case 6: // 1.4 MHz
    min_rb_unit=1;
    break;
866

867
868
869
  case 25: // 5HMz
    min_rb_unit=2;
    break;
870

871
872
873
  case 50: // 10HMz
    min_rb_unit=3;
    break;
874

875
876
877
  case 100: // 20HMz
    min_rb_unit=4;
    break;
878

879
880
  default:
    min_rb_unit=2;
Cedric Roux's avatar
Cedric Roux committed
881
    LOG_W(MAC,"[eNB %d] N_DL_RB %d unknown for CC_id %d, setting min_rb_unit to 2\n",
knopp's avatar
knopp committed
882
          module_id, N_RB_DL, CC_id);
883
884
    break;
  }
885

886
887
  return min_rb_unit;
}
888

knopp's avatar
knopp committed
889
uint32_t allocate_prbs_sub(int nb_rb, int N_RB_DL, int N_RBG, uint8_t *rballoc)
890
{
891
892
893
894
895

  int check=0;//check1=0,check2=0;
  uint32_t rballoc_dci=0;
  //uint8_t number_of_subbands=13;

896
  LOG_T(MAC,"*****Check1RBALLOC****: %d%d%d%d (nb_rb %d,N_RBG %d)\n",
knopp's avatar
knopp committed
897
        rballoc[3],rballoc[2],rballoc[1],rballoc[0],nb_rb,N_RBG);
898

knopp's avatar
knopp committed
899
  while((nb_rb >0) && (check < N_RBG)) {
knopp's avatar
   
knopp committed
900
    //printf("rballoc[%d] %d\n",check,rballoc[check]);
901
    if(rballoc[check] == 1) {
knopp's avatar
knopp committed
902
      rballoc_dci |= (1<<((N_RBG-1)-check));
903

knopp's avatar
knopp committed
904
      switch (N_RB_DL) {
905
906
907
908
909
      case 6:
        nb_rb--;
        break;

      case 25:
knopp's avatar
knopp committed
910
        if ((check == N_RBG-1)) {
911
          nb_rb--;
912
        } else {
913
          nb_rb-=2;
914
        }
915
916
917
918

        break;

      case 50:
knopp's avatar
knopp committed
919
        if ((check == N_RBG-1)) {
920
          nb_rb-=2;
921
        } else {
922
          nb_rb-=3;
923
        }
924
925
926
927
928
929

        break;

      case 100:
        nb_rb-=4;
        break;
930
      }
931
932
933
934
935
    }

    //      printf("rb_alloc %x\n",rballoc_dci);
    check = check+1;
    //    check1 = check1+2;
936
  }
937

938
939
940
941
942
943
  // rballoc_dci = (rballoc_dci)&(0x1fff);
  LOG_T(MAC,"*********RBALLOC : %x\n",rballoc_dci);
  // exit(-1);
  return (rballoc_dci);
}

944
945
946
947
int get_subbandsize(uint8_t dl_Bandwidth) {
  uint8_t ss[6] = {6,4,4,6,8,8};

  AssertFatal(dl_Bandwidth<6,"dl_Bandwidth %d is out of bounds\n",dl_Bandwidth);
948

949
950
  return(ss[dl_Bandwidth]);
}
knopp's avatar
knopp committed
951
int get_nb_subband(int N_RB_DL)
952
953
{

954
955
  int nb_sb=0;

knopp's avatar
knopp committed
956
  switch (N_RB_DL) {
957
  case 6:
958
    nb_sb=0;
959
    break;
960

961
962
  case 15:
    nb_sb = 4;  // sb_size =4
963
964

  case 25:
965
966
    nb_sb = 7; // sb_size =4, 1 sb with 1PRB, 6 with 2 RBG, each has 2 PRBs
    break;
967

968
969
970
  case 50:    // sb_size =6
    nb_sb = 9;
    break;
971

972
973
974
  case 75:  // sb_size =8
    nb_sb = 10;
    break;
975

976
977
978
  case 100: // sb_size =8 , 1 sb with 1 RBG + 12 sb with 2RBG, each RBG has 4 PRBs
    nb_sb = 13;
    break;
979

980
981
982
983
  default:
    nb_sb=0;
    break;
  }
984

985
  return nb_sb;
986
987

}
988
989
990

void init_CCE_table(int module_idP,int CC_idP)
{
991
  memset(RC.mac[module_idP]->CCE_table[CC_idP],0,800*sizeof(int));
992
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
} 


int get_nCCE_offset(int *CCE_table,
		    const unsigned char L, 
		    const int nCCE, 
		    const int common_dci, 
		    const unsigned short rnti, 
		    const unsigned char subframe)
{

  int search_space_free,m,nb_candidates = 0,l,i;
  unsigned int Yk;
   /*
    printf("CCE Allocation: ");
    for (i=0;i<nCCE;i++)
    printf("%d.",CCE_table[i]);
    printf("\n");
  */
  if (common_dci == 1) {
    // check CCE(0 ... L-1)
    nb_candidates = (L==4) ? 4 : 2;
    nb_candidates = min(nb_candidates,nCCE/L);
knopp's avatar
knopp committed
1015

1016
    //    printf("Common DCI nb_candidates %d, L %d\n",nb_candidates,L);
knopp's avatar
knopp committed
1017

1018
1019
1020
1021
    for (m = nb_candidates-1 ; m >=0 ; m--) {

      search_space_free = 1;
      for (l=0; l<L; l++) {
knopp's avatar
knopp committed
1022

1023
	//	printf("CCE_table[%d] %d\n",(m*L)+l,CCE_table[(m*L)+l]);
1024
1025
1026
1027
1028
1029
1030
        if (CCE_table[(m*L) + l] == 1) {
          search_space_free = 0;
          break;
        }
      }
     
      if (search_space_free == 1) {
knopp's avatar
knopp committed
1031

1032
	//	printf("returning %d\n",m*L);
knopp's avatar
knopp committed
1033

1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
        for (l=0; l<L; l++)
          CCE_table[(m*L)+l]=1;
        return(m*L);
      }
    }

    return(-1);

  } else { // Find first available in ue specific search space
    // according to procedure in Section 9.1.1 of 36.213 (v. 8.6)
    // compute Yk
    Yk = (unsigned int)rnti;

    for (i=0; i<=subframe; i++)
      Yk = (Yk*39827)%65537;

    Yk = Yk % (nCCE/L);


    switch (L) {
    case 1:
    case 2:
      nb_candidates = 6;
      break;

    case 4:
    case 8:
      nb_candidates = 2;
      break;

    default:
      DevParam(L, nCCE, rnti);
      break;
    }

knopp's avatar
knopp committed
1069

1070
    LOG_D(MAC,"rnti %x, Yk = %d, nCCE %d (nCCE/L %d),nb_cand %d\n",rnti,Yk,nCCE,nCCE/L,nb_candidates);
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093

    for (m = 0 ; m < nb_candidates ; m++) {
      search_space_free = 1;

      for (l=0; l<L; l++) {
        if (CCE_table[(((Yk+m)%(nCCE/L))*L) + l] == 1) {
          search_space_free = 0;
          break;
        }
      }

      if (search_space_free == 1) {
        for (l=0; l<L; l++)
          CCE_table[(((Yk+m)%(nCCE/L))*L)+l]=1;

        return(((Yk+m)%(nCCE/L))*L);
      }
    }

    return(-1);
  }
}

1094
1095
1096
1097
1098
void dump_CCE_table(int *CCE_table,const int nCCE,const unsigned short rnti,const int subframe,int L) {

  int nb_candidates = 0,i;
  unsigned int Yk;
  
1099
  printf("CCE 0: ");
1100
1101
  for (i=0;i<nCCE;i++) {
    printf("%1d.",CCE_table[i]);
1102
    if ((i&7) == 7)
knopp's avatar
knopp committed
1103
      printf("\n CCE %d: ",i);
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
1134
  }

  Yk = (unsigned int)rnti;
  
  for (i=0; i<=subframe; i++)
    Yk = (Yk*39827)%65537;
  
  Yk = Yk % (nCCE/L);
  
  
  switch (L) {
  case 1:
  case 2:
    nb_candidates = 6;
    break;
    
  case 4:
  case 8:
    nb_candidates = 2;
    break;
    
  default:
    DevParam(L, nCCE, rnti);
    break;
  }
  
  
  printf("rnti %x, Yk*L = %d, nCCE %d (nCCE/L %d),nb_cand*L %d\n",rnti,Yk*L,nCCE,nCCE/L,nb_candidates*L);

}

1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253