mirror of
https://gitlab.eurecom.fr/oai/openairinterface5g.git
synced 2026-07-13 04:30:28 +00:00
1093 lines
36 KiB
C
1093 lines
36 KiB
C
/*
|
|
* SPDX-License-Identifier: LicenseRef-CSSL-1.0
|
|
*/
|
|
|
|
/* from openair */
|
|
#include "rlc.h"
|
|
#include "LAYER2/nr_pdcp/nr_pdcp_oai_api.h"
|
|
|
|
/* from nr rlc module */
|
|
#include "nr_rlc_asn1_utils.h"
|
|
#include "nr_rlc_ue_manager.h"
|
|
#include "nr_rlc_entity.h"
|
|
#include "nr_rlc_oai_api.h"
|
|
#include "NR_RLC-BearerConfig.h"
|
|
#include "NR_DRB-ToAddMod.h"
|
|
#include "NR_DRB-ToAddModList.h"
|
|
#include "NR_SRB-ToAddModList.h"
|
|
#include "NR_DRB-ToReleaseList.h"
|
|
#include "NR_CellGroupConfig.h"
|
|
#include "NR_RLC-Config.h"
|
|
#include "common/ran_context.h"
|
|
#include "NR_UL-CCCH-Message.h"
|
|
|
|
#include "openair2/F1AP/f1ap_du_rrc_message_transfer.h"
|
|
#include "openair2/F1AP/f1ap_ids.h"
|
|
#include "openair3/ocp-gtpu/gtp_itf.h"
|
|
#include <stdint.h>
|
|
|
|
#include <executables/softmodem-common.h>
|
|
|
|
static nr_rlc_ue_manager_t *nr_rlc_ue_manager;
|
|
|
|
/* TODO: handle time a bit more properly */
|
|
static pthread_mutex_t nr_rlc_current_time_mutex = PTHREAD_MUTEX_INITIALIZER;
|
|
static uint64_t nr_rlc_current_time;
|
|
|
|
void lock_nr_rlc_current_time(void)
|
|
{
|
|
if (pthread_mutex_lock(&nr_rlc_current_time_mutex))
|
|
AssertFatal(0, "error locking mutex");
|
|
}
|
|
|
|
void unlock_nr_rlc_current_time(void)
|
|
{
|
|
if (pthread_mutex_unlock(&nr_rlc_current_time_mutex))
|
|
AssertFatal(0, "error locking mutex");
|
|
}
|
|
|
|
uint64_t get_nr_rlc_current_time(void)
|
|
{
|
|
lock_nr_rlc_current_time();
|
|
|
|
uint64_t ret = nr_rlc_current_time;
|
|
|
|
unlock_nr_rlc_current_time();
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void release_rlc_entity_from_lcid(nr_rlc_ue_t *ue, logical_chan_id_t channel_id)
|
|
{
|
|
AssertFatal(channel_id != 0, "LCID = 0 shouldn't be handled here\n");
|
|
nr_lcid_rb_t *rb = &ue->lcid2rb[channel_id - 1];
|
|
if (rb->type == NR_LCID_NONE)
|
|
return;
|
|
if (rb->type == NR_LCID_SRB) {
|
|
int id = rb->choice.srb_id - 1;
|
|
AssertFatal(id >= 0, "logic bug: impossible to have srb0 here\n");
|
|
if (ue->srb[id]) {
|
|
ue->srb[id]->delete_entity(ue->srb[id]);
|
|
ue->srb[id] = NULL;
|
|
}
|
|
else
|
|
LOG_E(RLC, "Trying to release a non-established enity with LCID %d\n", channel_id);
|
|
}
|
|
else {
|
|
AssertFatal(rb->type == NR_LCID_DRB,
|
|
"Invalid RB type\n");
|
|
int id = rb->choice.drb_id - 1;
|
|
if (ue->drb[id]) {
|
|
ue->drb[id]->delete_entity(ue->drb[id]);
|
|
ue->drb[id] = NULL;
|
|
}
|
|
else
|
|
LOG_E(RLC, "Trying to release a non-established enity with LCID %d\n", channel_id);
|
|
}
|
|
}
|
|
|
|
logical_chan_id_t nr_rlc_get_lcid_from_rb(int ue_id, bool is_srb, int rb_id)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
for (logical_chan_id_t id = 1; id <= 32; id++) {
|
|
nr_lcid_rb_t *rb = &ue->lcid2rb[id - 1];
|
|
if (is_srb) {
|
|
if (rb->type == NR_LCID_SRB && rb->choice.srb_id == rb_id) {
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
return id;
|
|
}
|
|
} else {
|
|
if (rb->type == NR_LCID_DRB && rb->choice.drb_id == rb_id) {
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
return id;
|
|
}
|
|
}
|
|
}
|
|
LOG_E(RLC, "Couldn't find LCID corresponding to %s %d\n", is_srb ? "SRB" : "DRB", rb_id);
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
return 0;
|
|
}
|
|
|
|
static nr_rlc_entity_t *get_rlc_entity_from_lcid(nr_rlc_ue_t *ue, logical_chan_id_t channel_id)
|
|
{
|
|
if (channel_id == 0)
|
|
return ue->srb0;
|
|
nr_lcid_rb_t *rb = &ue->lcid2rb[channel_id - 1];
|
|
if (rb->type == NR_LCID_NONE)
|
|
return NULL;
|
|
if (rb->type == NR_LCID_SRB) {
|
|
AssertFatal(rb->choice.srb_id > 0, "logic bug: impossible to have srb0 here\n");
|
|
return ue->srb[rb->choice.srb_id - 1];
|
|
} else {
|
|
AssertFatal(rb->type == NR_LCID_DRB,
|
|
"Invalid RB type\n");
|
|
return ue->drb[rb->choice.drb_id - 1];
|
|
}
|
|
}
|
|
|
|
void nr_rlc_release_entity(int ue_id, logical_chan_id_t channel_id)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
if (channel_id == 0) {
|
|
if (ue->srb0 != NULL) {
|
|
free(ue->srb0->deliver_sdu_data);
|
|
ue->srb0->delete_entity(ue->srb0);
|
|
ue->srb0 = NULL;
|
|
} else
|
|
LOG_E(RLC, "Trying to release a non-established enity with LCID %d\n", channel_id);
|
|
} else {
|
|
release_rlc_entity_from_lcid(ue, channel_id);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
void nr_mac_rlc_data_ind(const module_id_t module_idP,
|
|
const uint16_t ue_id,
|
|
const bool gnb_flagP,
|
|
const nr_rlc_data_ind_t *data,
|
|
int num_data)
|
|
{
|
|
if (gnb_flagP)
|
|
for (int i = 0; i < num_data; ++i)
|
|
T(T_ENB_RLC_MAC_UL, T_INT(module_idP), T_INT(ue_id), T_INT(data[i].ch), T_INT(data[i].len));
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
|
|
if(ue == NULL)
|
|
LOG_I(RLC, "RLC instance for the given UE was not found \n");
|
|
|
|
for (int i = 0; i < num_data; ++i) {
|
|
logical_chan_id_t ch = data[i].ch;
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, ch);
|
|
if (rb != NULL) {
|
|
LOG_D(RLC, "RB found! (instance %d channel ID %d) \n", module_idP, ch);
|
|
rb->set_time(rb, get_nr_rlc_current_time());
|
|
rb->recv_pdu(rb, (char *)data[i].buf, data[i].len);
|
|
} else {
|
|
LOG_W(RLC, "no RB found (channel ID %d UE ID %d)\n", ch, ue_id);
|
|
}
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
int nr_mac_rlc_multi_data_req(const module_id_t module_idP,
|
|
const uint16_t ue_id,
|
|
const bool gnb_flagP,
|
|
const logical_chan_id_t channel_idP,
|
|
tb_size_t tb_sizeP,
|
|
char *buffer_pP,
|
|
tb_size_t *pdu_siz,
|
|
int pdu_siz_len)
|
|
{
|
|
int ret = 0;
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, channel_idP);
|
|
|
|
if (rb != NULL) {
|
|
rb->set_time(rb, get_nr_rlc_current_time());
|
|
while (tb_sizeP - 3 > 0 && pdu_siz_len > 0) {
|
|
// fill PDU in buffer, store size of PDU
|
|
pdu_siz[0] = rb->generate_pdu(rb, buffer_pP + 3, tb_sizeP - 3);
|
|
if (pdu_siz[0] == 0)
|
|
break;
|
|
LOG_D(RLC, "MAC PDU created: instance %d channel_idP %d len %d\n", module_idP, channel_idP, pdu_siz[0]);
|
|
// reserve header
|
|
tb_sizeP -= 3 + pdu_siz[0];
|
|
buffer_pP += 3 + pdu_siz[0];
|
|
pdu_siz++;
|
|
pdu_siz_len--;
|
|
ret++;
|
|
}
|
|
} else {
|
|
LOG_D(RLC, "MAC PDU failed to get created for channel_idP:%d \n", channel_idP);
|
|
ret = 0;
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
|
|
if (gnb_flagP)
|
|
T(T_ENB_RLC_MAC_DL, T_INT(module_idP), T_INT(ue_id),
|
|
T_INT(channel_idP), T_INT(ret));
|
|
|
|
return ret;
|
|
}
|
|
|
|
tbs_size_t nr_mac_rlc_data_req(const module_id_t module_idP,
|
|
const uint16_t ue_id,
|
|
const bool gnb_flagP,
|
|
const logical_chan_id_t channel_idP,
|
|
const tb_size_t tb_sizeP,
|
|
char *buffer_pP)
|
|
{
|
|
int ret;
|
|
int maxsize;
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, channel_idP);
|
|
|
|
if (rb != NULL) {
|
|
LOG_D(RLC, "MAC PDU to get created for channel_idP:%d instance %d\n", channel_idP, module_idP);
|
|
rb->set_time(rb, get_nr_rlc_current_time());
|
|
maxsize = tb_sizeP;
|
|
ret = rb->generate_pdu(rb, buffer_pP, maxsize);
|
|
} else {
|
|
LOG_D(RLC, "MAC PDU failed to get created for channel_idP:%d \n", channel_idP);
|
|
ret = 0;
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
|
|
if (gnb_flagP)
|
|
T(T_ENB_RLC_MAC_DL, T_INT(module_idP), T_INT(ue_id), T_INT(channel_idP), T_INT(ret));
|
|
|
|
return ret;
|
|
}
|
|
|
|
static mac_rlc_status_resp_t _nr_rlc_status_ind(nr_rlc_ue_t *ue, frame_t frame, logical_chan_id_t channel_idP)
|
|
{
|
|
mac_rlc_status_resp_t ret;
|
|
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, channel_idP);
|
|
|
|
if (rb != NULL) {
|
|
nr_rlc_entity_buffer_status_t buf_stat;
|
|
rb->set_time(rb, get_nr_rlc_current_time());
|
|
/* 38.321 deals with BSR values up to 81338368 bytes, after what it
|
|
* reports '> 81338368' (table 6.1.3.1-2). Passing 100000000 is thus
|
|
* more than enough.
|
|
*/
|
|
// Fix me: temproary reduction meanwhile cpu cost of this computation is optimized
|
|
buf_stat = rb->buffer_status(rb, 1000 * 1000);
|
|
ret.bytes_in_buffer = buf_stat.status_size + buf_stat.retx_size + buf_stat.tx_size;
|
|
ret.oldest_sdu_arrival_ms = buf_stat.oldest_sdu_arrival_ms;
|
|
} else {
|
|
if (!(frame % 128) || channel_idP == 0) //to suppress this warning message
|
|
LOG_W(RLC, "Radio Bearer (channel ID %d) is NULL for UE %d\n", channel_idP, ue->ue_id);
|
|
ret.bytes_in_buffer = 0;
|
|
ret.oldest_sdu_arrival_ms = 0;
|
|
}
|
|
|
|
ret.pdus_in_buffer = 0;
|
|
/* TODO: creation time may be important (unit: frame, as it seems) */
|
|
ret.head_sdu_creation_time = 0;
|
|
ret.head_sdu_remaining_size_to_send = 0;
|
|
ret.head_sdu_is_segmented = 0;
|
|
return ret;
|
|
}
|
|
|
|
void nr_mac_rlc_status_ind(uint16_t ue_id, frame_t frame, int n_ch, const logical_chan_id_t *ch, mac_rlc_status_resp_t *ret)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
for (int i = 0; i < n_ch; ++i) {
|
|
ret[i] = _nr_rlc_status_ind(ue, frame, ch[i]);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
rlc_op_status_t nr_rlc_data_req(const protocol_ctxt_t *const ctxt_pP,
|
|
const srb_flag_t srb_flagP,
|
|
const rb_id_t rb_idP,
|
|
const mui_t muiP,
|
|
sdu_size_t sdu_sizeP,
|
|
uint8_t *sdu_pP)
|
|
{
|
|
int ue_id = ctxt_pP->rntiMaybeUEid;
|
|
nr_rlc_ue_t *ue;
|
|
nr_rlc_entity_t *rb;
|
|
|
|
LOG_D(RLC, "UE %d srb_flag %d rb_id %ld mui %d sdu_size %d\n", ue_id, srb_flagP, rb_idP, muiP, sdu_sizeP);
|
|
|
|
if (ctxt_pP->enb_flag)
|
|
T(T_ENB_RLC_DL, T_INT(ctxt_pP->module_id), T_INT(ctxt_pP->rntiMaybeUEid), T_INT(rb_idP), T_INT(sdu_sizeP));
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
|
|
rb = NULL;
|
|
|
|
if (srb_flagP) {
|
|
if (rb_idP >= 1 && rb_idP <= 2)
|
|
rb = ue->srb[rb_idP - 1];
|
|
} else {
|
|
if (rb_idP >= 1 && rb_idP <= MAX_DRBS_PER_UE)
|
|
rb = ue->drb[rb_idP - 1];
|
|
}
|
|
|
|
if (rb != NULL) {
|
|
rb->set_time(rb, get_nr_rlc_current_time());
|
|
rb->recv_sdu(rb, (char *)sdu_pP, sdu_sizeP, muiP);
|
|
} else {
|
|
LOG_E(RLC, "%s:%d:%s: fatal: SDU sent to unknown RB\n", __FILE__, __LINE__, __FUNCTION__);
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
|
|
free(sdu_pP);
|
|
|
|
return RLC_OP_STATUS_OK;
|
|
}
|
|
|
|
int nr_rlc_get_available_tx_space(const int ue_id, const logical_chan_id_t channel_idP)
|
|
{
|
|
int ret;
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, channel_idP);
|
|
|
|
if (rb != NULL) {
|
|
ret = rb->available_tx_space(rb);
|
|
} else {
|
|
LOG_E(RLC, "Radio Bearer (channel ID %d) is NULL for UE %d\n", channel_idP, ue_id);
|
|
ret = -1;
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int nr_rlc_tx_list_occupancy(int ue_id, logical_chan_id_t lcid)
|
|
{
|
|
int ret;
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, lcid);
|
|
|
|
if (rb != NULL) {
|
|
ret = rb->tx_list_occupancy(rb);
|
|
} else {
|
|
ret = 0;
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int nr_rlc_module_init(nr_rlc_op_mode_t mode)
|
|
{
|
|
static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
|
|
static int inited = 0;
|
|
static int inited_ue = 0;
|
|
|
|
if (pthread_mutex_lock(&lock)) abort();
|
|
|
|
bool gnb_flag = mode != NR_RLC_OP_MODE_UE;
|
|
if (gnb_flag == 1 && inited) {
|
|
LOG_E(RLC, "%s:%d:%s: fatal, inited already 1\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
|
|
if (gnb_flag == 0 && inited_ue) {
|
|
LOG_E(RLC, "%s:%d:%s: fatal, inited_ue already 1\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
|
|
if (gnb_flag == 1)
|
|
inited = 1;
|
|
if (gnb_flag == 0)
|
|
inited_ue = 1;
|
|
|
|
nr_rlc_ue_manager = new_nr_rlc_ue_manager(mode);
|
|
|
|
if (pthread_mutex_unlock(&lock)) abort();
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void deliver_sdu(void *_ue, nr_rlc_entity_t *entity, char *buf, int size)
|
|
{
|
|
nr_rlc_ue_t *ue = _ue;
|
|
int is_srb;
|
|
int rb_id;
|
|
protocol_ctxt_t ctx;
|
|
uint8_t *memblock;
|
|
int i;
|
|
|
|
/* is it SRB? */
|
|
for (i = 0; i < sizeofArray(ue->srb); i++) {
|
|
if (entity == ue->srb[i]) {
|
|
is_srb = 1;
|
|
rb_id = i+1;
|
|
goto rb_found;
|
|
}
|
|
}
|
|
|
|
/* maybe DRB? */
|
|
for (i = 0; i < sizeofArray(ue->drb) ; i++) {
|
|
if (entity == ue->drb[i]) {
|
|
is_srb = 0;
|
|
rb_id = i+1;
|
|
goto rb_found;
|
|
}
|
|
}
|
|
|
|
LOG_E(RLC, "Fatal, no RB found for ue %d\n", ue->ue_id);
|
|
exit(1);
|
|
|
|
rb_found:
|
|
LOG_D(RLC, "Delivering SDU (ue_id %d is_srb %d rb_id %d) size %d\n", ue->ue_id, is_srb, rb_id, size);
|
|
|
|
/* unused fields? */
|
|
ctx.instance = 0;
|
|
ctx.frame = 0;
|
|
ctx.subframe = 0;
|
|
ctx.eNB_index = 0;
|
|
ctx.brOption = 0;
|
|
|
|
int is_gnb = nr_rlc_manager_get_gnb_flag(nr_rlc_ue_manager);
|
|
|
|
/* used fields? */
|
|
ctx.module_id = 0;
|
|
/* CU (PDCP, RRC, SDAP) use a different ID than RNTI, so below set the CU UE
|
|
* ID if in gNB, else use RNTI normally */
|
|
ctx.rntiMaybeUEid = ue->ue_id;
|
|
if (is_gnb) {
|
|
f1_ue_data_t ue_data = du_get_f1_ue_data(ue->ue_id);
|
|
ctx.rntiMaybeUEid = ue_data.secondary_ue;
|
|
}
|
|
|
|
ctx.enb_flag = is_gnb;
|
|
|
|
if (is_gnb) {
|
|
T(T_ENB_RLC_UL,
|
|
T_INT(0 /*ctxt_pP->module_id*/),
|
|
T_INT(ue->ue_id), T_INT(rb_id), T_INT(size));
|
|
|
|
// if (NODE_IS_DU(type) && is_srb == 0) {
|
|
// LOG_D(RLC, "call proto_agent_send_pdcp_data_ind() \n");
|
|
// proto_agent_send_pdcp_data_ind(&ctx, is_srb, 0, rb_id, size, memblock);
|
|
// return;
|
|
// }
|
|
|
|
bool rlc_split = nr_rlc_manager_rlc_is_split(nr_rlc_ue_manager);
|
|
if (rlc_split) {
|
|
if(is_srb) {
|
|
MessageDef *msg;
|
|
msg = itti_alloc_new_message(TASK_RLC_ENB, 0, F1AP_UL_RRC_MESSAGE);
|
|
uint8_t *message_buffer = itti_malloc (TASK_RLC_ENB, TASK_DU_F1, size);
|
|
memcpy (message_buffer, buf, size);
|
|
F1AP_UL_RRC_MESSAGE(msg).gNB_CU_ue_id = ctx.rntiMaybeUEid;
|
|
F1AP_UL_RRC_MESSAGE(msg).gNB_DU_ue_id = ue->ue_id;
|
|
F1AP_UL_RRC_MESSAGE(msg).srb_id = rb_id;
|
|
F1AP_UL_RRC_MESSAGE(msg).rrc_container = message_buffer;
|
|
F1AP_UL_RRC_MESSAGE(msg).rrc_container_length = size;
|
|
itti_send_msg_to_task(TASK_DU_F1, ENB_MODULE_ID_TO_INSTANCE(0 /*ctxt_pP->module_id*/), msg);
|
|
return;
|
|
} else {
|
|
LOG_D(RLC, "Received uplink user-plane traffic at RLC-DU to be sent to the CU, size %d \n", size);
|
|
extern instance_t DUuniqInstance;
|
|
gtpv1uSendDirect(DUuniqInstance, ue->ue_id, rb_id, (uint8_t*) buf, size, false, false);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* UE or monolithic gNB */
|
|
memblock = malloc16(size);
|
|
if (memblock == NULL) {
|
|
LOG_E(RLC, "%s:%d:%s: ERROR: malloc16 failed\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
memcpy(memblock, buf, size);
|
|
LOG_D(PDCP, "Calling PDCP layer from RLC in %s\n", __FUNCTION__);
|
|
if (!nr_pdcp_data_ind(&ctx, is_srb, rb_id, size, memblock)) {
|
|
LOG_E(RLC, "%s:%d:%s: ERROR: pdcp_data_ind failed\n", __FILE__, __LINE__, __FUNCTION__);
|
|
/* what to do in case of failure? for the moment: nothing */
|
|
}
|
|
}
|
|
|
|
static void successful_delivery(void *_ue, nr_rlc_entity_t *entity, int sdu_id)
|
|
{
|
|
nr_rlc_ue_t *ue = _ue;
|
|
int i;
|
|
int is_srb;
|
|
int rb_id;
|
|
#if 0
|
|
MessageDef *msg;
|
|
#endif
|
|
|
|
/* is it SRB? */
|
|
for (i = 0; i < 2; i++) {
|
|
if (entity == ue->srb[i]) {
|
|
is_srb = 1;
|
|
rb_id = i+1;
|
|
goto rb_found;
|
|
}
|
|
}
|
|
|
|
/* maybe DRB? */
|
|
for (i = 0; i < MAX_DRBS_PER_UE; i++) {
|
|
if (entity == ue->drb[i]) {
|
|
is_srb = 0;
|
|
rb_id = i+1;
|
|
goto rb_found;
|
|
}
|
|
}
|
|
|
|
LOG_E(RLC, "Fatal, no RB found for ue %d\n", ue->ue_id);
|
|
exit(1);
|
|
|
|
rb_found:
|
|
LOG_D(RLC, "sdu %d was successfully delivered on %s %d\n",
|
|
sdu_id,
|
|
is_srb ? "SRB" : "DRB",
|
|
rb_id);
|
|
|
|
/* TODO: do something for DRBs? */
|
|
if (is_srb == 0)
|
|
return;
|
|
|
|
int is_gnb = nr_rlc_manager_get_gnb_flag(nr_rlc_ue_manager);
|
|
if (!is_gnb)
|
|
return;
|
|
|
|
#if 0
|
|
msg = itti_alloc_new_message(TASK_RLC_ENB, RLC_SDU_INDICATION);
|
|
RLC_SDU_INDICATION(msg).rnti = ue->rnti;
|
|
RLC_SDU_INDICATION(msg).is_successful = 1;
|
|
RLC_SDU_INDICATION(msg).srb_id = rb_id;
|
|
RLC_SDU_INDICATION(msg).message_id = sdu_id;
|
|
/* TODO: accept more than 1 instance? here we send to instance id 0 */
|
|
itti_send_msg_to_task(TASK_RRC_ENB, 0, msg);
|
|
#endif
|
|
}
|
|
|
|
static void max_retx_reached(void *_ue, nr_rlc_entity_t *entity)
|
|
{
|
|
nr_rlc_ue_t *ue = _ue;
|
|
int i;
|
|
int is_srb;
|
|
int rb_id;
|
|
|
|
/* is it SRB? */
|
|
for (i = 0; i < 2; i++) {
|
|
if (entity == ue->srb[i]) {
|
|
is_srb = 1;
|
|
rb_id = i+1;
|
|
goto rb_found;
|
|
}
|
|
}
|
|
|
|
/* maybe DRB? */
|
|
for (i = 0; i < MAX_DRBS_PER_UE; i++) {
|
|
if (entity == ue->drb[i]) {
|
|
is_srb = 0;
|
|
rb_id = i+1;
|
|
goto rb_found;
|
|
}
|
|
}
|
|
|
|
LOG_E(RLC, "Fatal, no RB found for ue %d\n", ue->ue_id);
|
|
exit(1);
|
|
|
|
rb_found:
|
|
LOG_E(RLC, "max RETX reached on %s %d\n",
|
|
is_srb ? "SRB" : "DRB",
|
|
rb_id);
|
|
|
|
if (ue->rlf_handler)
|
|
ue->rlf_handler(ue->ue_id);
|
|
else
|
|
LOG_W(RLC, "UE %04x: RLF detected, but no callable RLF handler registered\n", ue->ue_id);
|
|
}
|
|
|
|
void nr_rlc_set_rlf_handler(int ue_id, rlf_handler_t rlf_h)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
ue->rlf_handler = rlf_h;
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
void nr_rlc_reestablish_entity(int ue_id, int lc_id)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
|
|
if (ue == NULL) {
|
|
LOG_E(RLC, "RLC instance for the given UE was not found \n");
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
return;
|
|
}
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, lc_id);
|
|
|
|
if (rb != NULL) {
|
|
LOG_D(RLC, "RB found! (channel ID %d), re-establish RLC\n", lc_id);
|
|
rb->reestablishment(rb);
|
|
} else {
|
|
LOG_E(RLC, "no RLC entity found (channel ID %d) for reestablishment\n", lc_id);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
void nr_rlc_reconfigure_entity(int ue_id, int lc_id, NR_RLC_Config_t *rlc_Config)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
|
|
if (ue == NULL)
|
|
LOG_E(RLC, "RLC instance for the given UE was not found \n");
|
|
|
|
nr_rlc_entity_t *rb = get_rlc_entity_from_lcid(ue, lc_id);
|
|
if (rlc_Config) {
|
|
AssertFatal(rb->stats.mode != NR_RLC_TM, "Cannot reconfigure TM mode\n");
|
|
if (rb->stats.mode == NR_RLC_AM) {
|
|
AssertFatal(rlc_Config->present == NR_RLC_Config_PR_am, "Invalid RLC Config type\n");
|
|
struct NR_RLC_Config__am *am = rlc_Config->choice.am;
|
|
int t_reassembly = decode_t_reassembly(am->dl_AM_RLC.t_Reassembly);
|
|
int t_status_prohibit = decode_t_status_prohibit(am->dl_AM_RLC.t_StatusProhibit);
|
|
int t_poll_retransmit = decode_t_poll_retransmit(am->ul_AM_RLC.t_PollRetransmit);
|
|
int poll_pdu = decode_poll_pdu(am->ul_AM_RLC.pollPDU);
|
|
int poll_byte = decode_poll_byte(am->ul_AM_RLC.pollByte);
|
|
int max_retx_threshold = decode_max_retx_threshold(am->ul_AM_RLC.maxRetxThreshold);
|
|
int _sn_field_length;
|
|
int *sn_field_length = NULL;
|
|
if (am->dl_AM_RLC.sn_FieldLength) {
|
|
AssertFatal(am->ul_AM_RLC.sn_FieldLength != NULL, "Cannot handle different sn_FieldLength for DL and UL\n");
|
|
if (am->ul_AM_RLC.sn_FieldLength) {
|
|
AssertFatal(*am->dl_AM_RLC.sn_FieldLength == *am->ul_AM_RLC.sn_FieldLength,
|
|
"Cannot handle different sn_FieldLength for DL and UL\n");
|
|
_sn_field_length = decode_sn_field_length_am(*am->dl_AM_RLC.sn_FieldLength);
|
|
sn_field_length = &_sn_field_length;
|
|
}
|
|
} else
|
|
AssertFatal(am->ul_AM_RLC.sn_FieldLength == NULL, "Cannot handle different sn_FieldLength for DL and UL\n");
|
|
nr_rlc_entity_am_reconfigure(rb,
|
|
t_poll_retransmit,
|
|
t_reassembly,
|
|
t_status_prohibit,
|
|
poll_pdu,
|
|
poll_byte,
|
|
max_retx_threshold,
|
|
sn_field_length);
|
|
} else { // UM
|
|
AssertFatal(rlc_Config->present == NR_RLC_Config_PR_um_Bi_Directional, "Invalid RLC Config type\n");
|
|
struct NR_RLC_Config__um_Bi_Directional *um = rlc_Config->choice.um_Bi_Directional;
|
|
int t_reassembly = decode_t_reassembly(um->dl_UM_RLC.t_Reassembly);
|
|
int _sn_field_length;
|
|
int *sn_field_length = NULL;
|
|
if (um->dl_UM_RLC.sn_FieldLength) {
|
|
AssertFatal(um->ul_UM_RLC.sn_FieldLength != NULL, "Cannot handle different sn_FieldLength for DL and UL\n");
|
|
if (um->ul_UM_RLC.sn_FieldLength) {
|
|
AssertFatal(*um->dl_UM_RLC.sn_FieldLength == *um->ul_UM_RLC.sn_FieldLength,
|
|
"Cannot handle different sn_FieldLength for DL and UL\n");
|
|
_sn_field_length = decode_sn_field_length_um(*um->dl_UM_RLC.sn_FieldLength);
|
|
sn_field_length = &_sn_field_length;
|
|
}
|
|
} else
|
|
AssertFatal(um->ul_UM_RLC.sn_FieldLength == NULL, "Cannot handle different sn_FieldLength for DL and UL\n");
|
|
nr_rlc_entity_um_reconfigure(rb, t_reassembly, sn_field_length);
|
|
}
|
|
} else {
|
|
AssertFatal(rb->stats.mode == NR_RLC_AM, "Invalid RLC mode\n");
|
|
// default values as in 9.2.1 of 38.331
|
|
int sn_field_length = 12;
|
|
nr_rlc_entity_am_reconfigure(rb,
|
|
45, //t_poll_retransmit
|
|
35, //t_reassembly
|
|
0, //t_status_prohibit
|
|
-1, //poll_pdu
|
|
-1, //poll_byte
|
|
8, //max_retx_threshold
|
|
&sn_field_length);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
void nr_rlc_add_srb(int ue_id, int srb_id, const NR_RLC_BearerConfig_t *rlc_BearerConfig)
|
|
{
|
|
NR_RLC_Config_t *r = rlc_BearerConfig->rlc_Config;
|
|
int t_status_prohibit;
|
|
int t_poll_retransmit;
|
|
int poll_pdu;
|
|
int poll_byte;
|
|
int max_retx_threshold;
|
|
int t_reassembly;
|
|
int sn_field_length;
|
|
|
|
LOG_D(RLC, "Trying to add SRB %d\n", srb_id);
|
|
AssertFatal(srb_id > 0 && srb_id < 4, "Invalid srb id %d\n", srb_id);
|
|
|
|
if (r && r->present == NR_RLC_Config_PR_am) {
|
|
struct NR_RLC_Config__am *am;
|
|
am = r->choice.am;
|
|
t_reassembly = decode_t_reassembly(am->dl_AM_RLC.t_Reassembly);
|
|
t_status_prohibit = decode_t_status_prohibit(am->dl_AM_RLC.t_StatusProhibit);
|
|
t_poll_retransmit = decode_t_poll_retransmit(am->ul_AM_RLC.t_PollRetransmit);
|
|
poll_pdu = decode_poll_pdu(am->ul_AM_RLC.pollPDU);
|
|
poll_byte = decode_poll_byte(am->ul_AM_RLC.pollByte);
|
|
max_retx_threshold = decode_max_retx_threshold(am->ul_AM_RLC.maxRetxThreshold);
|
|
if (*am->dl_AM_RLC.sn_FieldLength != *am->ul_AM_RLC.sn_FieldLength) {
|
|
LOG_E(RLC, "%s:%d:%s: fatal\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
sn_field_length = decode_sn_field_length_am(*am->dl_AM_RLC.sn_FieldLength);
|
|
} else {
|
|
// default values as in 9.2.1 of 38.331
|
|
t_reassembly = 35;
|
|
t_status_prohibit = 0;
|
|
t_poll_retransmit = 45;
|
|
poll_pdu = -1;
|
|
poll_byte = -1;
|
|
max_retx_threshold = 8;
|
|
sn_field_length = 12;
|
|
}
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
AssertFatal(rlc_BearerConfig->servedRadioBearer &&
|
|
(rlc_BearerConfig->servedRadioBearer->present ==
|
|
NR_RLC_BearerConfig__servedRadioBearer_PR_srb_Identity),
|
|
"servedRadioBearer for SRB mandatory present when setting up an SRB RLC entity\n");
|
|
int local_id = rlc_BearerConfig->logicalChannelIdentity - 1; // LCID 0 for SRB 0 not mapped
|
|
ue->lcid2rb[local_id].type = NR_LCID_SRB;
|
|
ue->lcid2rb[local_id].choice.srb_id = rlc_BearerConfig->servedRadioBearer->choice.srb_Identity;
|
|
if (ue->srb[srb_id-1] != NULL) {
|
|
LOG_E(RLC, "SRB %d already exists for UE %d, do nothing\n", srb_id, ue_id);
|
|
} else {
|
|
nr_rlc_entity_t *nr_rlc_am = new_nr_rlc_entity_am(RLC_RX_MAXSIZE,
|
|
RLC_TX_MAXSIZE,
|
|
deliver_sdu, ue,
|
|
successful_delivery, ue,
|
|
max_retx_reached, ue,
|
|
t_poll_retransmit,
|
|
t_reassembly, t_status_prohibit,
|
|
poll_pdu, poll_byte, max_retx_threshold,
|
|
sn_field_length);
|
|
nr_rlc_ue_add_srb_rlc_entity(ue, srb_id, nr_rlc_am);
|
|
|
|
LOG_I(RLC, "Added srb %d to UE %d\n", srb_id, ue_id);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
static void add_drb_am(int ue_id, int drb_id, const NR_RLC_BearerConfig_t *rlc_BearerConfig)
|
|
{
|
|
struct NR_RLC_Config *r = rlc_BearerConfig->rlc_Config;
|
|
|
|
int t_status_prohibit;
|
|
int t_poll_retransmit;
|
|
int poll_pdu;
|
|
int poll_byte;
|
|
int max_retx_threshold;
|
|
int t_reassembly;
|
|
int sn_field_length;
|
|
|
|
AssertFatal(drb_id > 0 && drb_id <= MAX_DRBS_PER_UE,
|
|
"Invalid DRB ID %d\n", drb_id);
|
|
|
|
switch (r->present) {
|
|
case NR_RLC_Config_PR_am: {
|
|
struct NR_RLC_Config__am *am;
|
|
am = r->choice.am;
|
|
t_reassembly = decode_t_reassembly(am->dl_AM_RLC.t_Reassembly);
|
|
t_status_prohibit = decode_t_status_prohibit(am->dl_AM_RLC.t_StatusProhibit);
|
|
t_poll_retransmit = decode_t_poll_retransmit(am->ul_AM_RLC.t_PollRetransmit);
|
|
poll_pdu = decode_poll_pdu(am->ul_AM_RLC.pollPDU);
|
|
poll_byte = decode_poll_byte(am->ul_AM_RLC.pollByte);
|
|
max_retx_threshold = decode_max_retx_threshold(am->ul_AM_RLC.maxRetxThreshold);
|
|
if (*am->dl_AM_RLC.sn_FieldLength != *am->ul_AM_RLC.sn_FieldLength) {
|
|
LOG_E(RLC, "%s:%d:%s: fatal\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
sn_field_length = decode_sn_field_length_am(*am->dl_AM_RLC.sn_FieldLength);
|
|
break;
|
|
}
|
|
default:
|
|
LOG_E(RLC, "%s:%d:%s: fatal error\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
AssertFatal(rlc_BearerConfig->servedRadioBearer &&
|
|
(rlc_BearerConfig->servedRadioBearer->present ==
|
|
NR_RLC_BearerConfig__servedRadioBearer_PR_drb_Identity),
|
|
"servedRadioBearer for DRB mandatory present when setting up an SRB RLC entity\n");
|
|
int local_id = rlc_BearerConfig->logicalChannelIdentity - 1; // LCID 0 for SRB 0 not mapped
|
|
ue->lcid2rb[local_id].type = NR_LCID_DRB;
|
|
ue->lcid2rb[local_id].choice.drb_id = rlc_BearerConfig->servedRadioBearer->choice.drb_Identity;
|
|
if (ue->drb[drb_id-1] != NULL) {
|
|
LOG_E(RLC, "DRB %d already exists for UE %d, do nothing\n", drb_id, ue_id);
|
|
} else {
|
|
nr_rlc_entity_t *nr_rlc_am = new_nr_rlc_entity_am(RLC_RX_MAXSIZE,
|
|
RLC_TX_MAXSIZE,
|
|
deliver_sdu, ue,
|
|
successful_delivery, ue,
|
|
max_retx_reached, ue,
|
|
t_poll_retransmit,
|
|
t_reassembly, t_status_prohibit,
|
|
poll_pdu, poll_byte, max_retx_threshold,
|
|
sn_field_length);
|
|
nr_rlc_ue_add_drb_rlc_entity(ue, drb_id, nr_rlc_am);
|
|
|
|
LOG_I(RLC, "Added drb %d to UE %d\n", drb_id, ue_id);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
static void add_drb_um(int ue_id, int drb_id, const NR_RLC_BearerConfig_t *rlc_BearerConfig)
|
|
{
|
|
struct NR_RLC_Config *r = rlc_BearerConfig->rlc_Config;
|
|
|
|
int sn_field_length;
|
|
int t_reassembly;
|
|
|
|
AssertFatal(drb_id > 0 && drb_id <= MAX_DRBS_PER_UE,
|
|
"Invalid DRB ID %d\n", drb_id);
|
|
|
|
switch (r->present) {
|
|
case NR_RLC_Config_PR_um_Bi_Directional: {
|
|
struct NR_RLC_Config__um_Bi_Directional *um;
|
|
um = r->choice.um_Bi_Directional;
|
|
t_reassembly = decode_t_reassembly(um->dl_UM_RLC.t_Reassembly);
|
|
if (*um->dl_UM_RLC.sn_FieldLength != *um->ul_UM_RLC.sn_FieldLength) {
|
|
LOG_E(RLC, "%s:%d:%s: fatal\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
sn_field_length = decode_sn_field_length_um(*um->dl_UM_RLC.sn_FieldLength);
|
|
break;
|
|
}
|
|
default:
|
|
LOG_E(RLC, "%s:%d:%s: fatal error\n", __FILE__, __LINE__, __FUNCTION__);
|
|
exit(1);
|
|
}
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
AssertFatal(rlc_BearerConfig->servedRadioBearer &&
|
|
(rlc_BearerConfig->servedRadioBearer->present ==
|
|
NR_RLC_BearerConfig__servedRadioBearer_PR_drb_Identity),
|
|
"servedRadioBearer for DRB mandatory present when setting up an SRB RLC entity\n");
|
|
int local_id = rlc_BearerConfig->logicalChannelIdentity - 1; // LCID 0 for SRB 0 not mapped
|
|
ue->lcid2rb[local_id].type = NR_LCID_DRB;
|
|
ue->lcid2rb[local_id].choice.drb_id = rlc_BearerConfig->servedRadioBearer->choice.drb_Identity;
|
|
if (ue->drb[drb_id-1] != NULL) {
|
|
LOG_E(RLC, "DEBUG add_drb_um: warning DRB %d already exist for ue %d, do nothing\n", drb_id, ue_id);
|
|
} else {
|
|
nr_rlc_entity_t *nr_rlc_um = new_nr_rlc_entity_um(RLC_RX_MAXSIZE,
|
|
RLC_TX_MAXSIZE,
|
|
deliver_sdu, ue,
|
|
t_reassembly,
|
|
sn_field_length);
|
|
nr_rlc_ue_add_drb_rlc_entity(ue, drb_id, nr_rlc_um);
|
|
|
|
LOG_D(RLC, "Added drb %d to UE %d\n", drb_id, ue_id);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
void nr_rlc_add_drb(int ue_id, int drb_id, const NR_RLC_BearerConfig_t *rlc_BearerConfig)
|
|
{
|
|
switch (rlc_BearerConfig->rlc_Config->present) {
|
|
case NR_RLC_Config_PR_am:
|
|
add_drb_am(ue_id, drb_id, rlc_BearerConfig);
|
|
break;
|
|
case NR_RLC_Config_PR_um_Bi_Directional:
|
|
add_drb_um(ue_id, drb_id, rlc_BearerConfig);
|
|
break;
|
|
default:
|
|
LOG_E(RLC, "Fatal: unhandled DRB type\n");
|
|
exit(1);
|
|
}
|
|
LOG_I(RLC, "Added DRB to UE %d\n", ue_id);
|
|
}
|
|
|
|
struct srb0_data {
|
|
int ue_id;
|
|
void *data;
|
|
void (*send_initial_ul_rrc_message)(int ue_id, const uint8_t *sdu, sdu_size_t sdu_len, void *data);
|
|
};
|
|
|
|
void deliver_sdu_srb0(void *deliver_sdu_data, nr_rlc_entity_t *entity, char *buf, int size)
|
|
{
|
|
UNUSED(entity);
|
|
struct srb0_data *s0 = (struct srb0_data *)deliver_sdu_data;
|
|
s0->send_initial_ul_rrc_message(s0->ue_id, (unsigned char *)buf, size, s0->data);
|
|
}
|
|
|
|
bool nr_rlc_activate_srb0(int ue_id,
|
|
void *data,
|
|
void (*send_initial_ul_rrc_message)(int ue_id, const uint8_t *sdu, sdu_size_t sdu_len, void *data))
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
if (ue->srb0 != NULL) {
|
|
LOG_W(RLC, "SRB0 already exists for UE %x, do nothing\n", ue_id);
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
return false;
|
|
}
|
|
struct srb0_data *srb0_data = calloc(1, sizeof(struct srb0_data));
|
|
AssertFatal(srb0_data, "out of memory\n");
|
|
|
|
srb0_data->ue_id = ue_id;
|
|
srb0_data->data = data;
|
|
srb0_data->send_initial_ul_rrc_message = send_initial_ul_rrc_message;
|
|
|
|
nr_rlc_entity_t *nr_rlc_tm = new_nr_rlc_entity_tm(10000, deliver_sdu_srb0, srb0_data);
|
|
nr_rlc_ue_add_srb_rlc_entity(ue, 0, nr_rlc_tm);
|
|
|
|
LOG_I(RLC, "Activated srb0 for UE %d\n", ue_id);
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
return true;
|
|
}
|
|
|
|
void nr_rlc_remove_ue(int ue_id)
|
|
{
|
|
LOG_W(RLC, "Remove UE %d\n", ue_id);
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_manager_remove_ue(nr_rlc_ue_manager, ue_id);
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
bool nr_rlc_update_id(int from_id, int to_id)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, from_id);
|
|
if (ue == NULL) {
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
LOG_E(RLC, "Cannot find RLC entity for UE %d\n", from_id);
|
|
return false;
|
|
}
|
|
ue->ue_id = to_id;
|
|
LOG_I(RLC, "Update old UE ID %d context to ID %d\n", from_id, to_id);
|
|
/* re-establish RLC for SRB1: according to 5.3.7.4 of TS 38.331 */
|
|
if (ue->srb[0]) {
|
|
LOG_I(RLC, "Re-establish RLC for SRB 1\n");
|
|
ue->srb[0]->reestablishment(ue->srb[0]);
|
|
}
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
return true;
|
|
}
|
|
|
|
/**
|
|
* @brief This function is for testing purposes.
|
|
* Re-establishment is triggered by resetting RLC counters of the bearer,
|
|
* which leads to UE reaching maximum RLC retransmissions, RLF detection
|
|
* and RRC triggering re-sync. It is assumed that there is ongoing traffic on the bearer.
|
|
* - With COTS UEs, triggers re-establishment on SRB 1, where periodical measurement reports are sent.
|
|
* - With OAI UE, triggers re-establishment on DRB 1, assuming there is ongoing data traffic.
|
|
*/
|
|
void nr_rlc_test_trigger_reestablishment(int ue_id)
|
|
{
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
if (ue == NULL) {
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
LOG_E(RLC, "Cannot find RLC entity for UE %04x\n", ue_id);
|
|
return;
|
|
}
|
|
/* we simply assume the SRB exists, because the scheduler creates it as soon
|
|
* as the UE context is created. */
|
|
nr_rlc_entity_t *ent = ue->srb[0];
|
|
ent->reestablishment(ent);
|
|
/* Trigger re-establishment on OAI UE */
|
|
nr_rlc_entity_t *drb = ue->drb[0];
|
|
if (drb) {
|
|
drb->reestablishment(drb);
|
|
} else {
|
|
LOG_W(RLC, "DRB[0] is NULL for UE %04x\n", ue_id);
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
void nr_rlc_ms_tick(void)
|
|
{
|
|
lock_nr_rlc_current_time();
|
|
nr_rlc_current_time++;
|
|
unlock_nr_rlc_current_time();
|
|
}
|
|
|
|
void nr_rlc_activate_avg_time_to_tx(const int ue_id,
|
|
const logical_chan_id_t channel_id,
|
|
const bool is_on)
|
|
{
|
|
nr_rlc_entity_t *rb;
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
|
|
switch (channel_id) {
|
|
case 1 ... 3: rb = ue->srb[channel_id - 1]; break;
|
|
case 4 ... 8: rb = ue->drb[channel_id - 4]; break;
|
|
default: rb = NULL; break;
|
|
}
|
|
|
|
if (rb != NULL) {
|
|
rb->avg_time_is_on = is_on;
|
|
time_average_reset(rb->txsdu_avg_time_to_tx);
|
|
} else {
|
|
LOG_E(RLC, "Radio Bearer (channel ID %d) is NULL for UE %d\n", channel_id, ue_id);
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|
|
|
|
/* returns false in case of error, true if everything ok */
|
|
bool nr_rlc_get_statistics(int ue_id, int srb_flag, int rb_id, nr_rlc_statistics_t *out)
|
|
{
|
|
bool ret;
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
|
|
nr_rlc_entity_t *rb = NULL;
|
|
|
|
if (srb_flag) {
|
|
if (rb_id >= 1 && rb_id <= 2)
|
|
rb = ue->srb[rb_id - 1];
|
|
} else {
|
|
if (rb_id >= 1 && rb_id <= 5)
|
|
rb = ue->drb[rb_id - 1];
|
|
}
|
|
|
|
if (rb != NULL) {
|
|
rb->get_stats(rb, out);
|
|
ret = true;
|
|
|
|
// Patch buffer status using OAI results (no need to change anything in the RB)
|
|
// rb->set_time(rb, get_nr_rlc_current_time());
|
|
nr_rlc_entity_buffer_status_t oai_stat = rb->buffer_status(rb, 256 * 1000);
|
|
out->rxbuf_occ_bytes = oai_stat.status_size;
|
|
out->txbuf_occ_bytes = oai_stat.tx_size + oai_stat.retx_size;
|
|
} else {
|
|
ret = false;
|
|
}
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
|
|
return ret;
|
|
}
|
|
|
|
void nr_rlc_srb_recv_sdu(const int ue_id, const logical_chan_id_t channel_id, unsigned char *buf, int size)
|
|
{
|
|
T(T_ENB_RLC_DL, T_INT(0), T_INT(ue_id), T_INT(0), T_INT(size));
|
|
|
|
nr_rlc_manager_lock(nr_rlc_ue_manager);
|
|
nr_rlc_ue_t *ue = nr_rlc_manager_get_ue(nr_rlc_ue_manager, ue_id);
|
|
|
|
nr_rlc_entity_t *rb = NULL;
|
|
if (channel_id == 0) {
|
|
rb = ue->srb0;
|
|
} else {
|
|
rb = ue->srb[channel_id - 1];
|
|
}
|
|
|
|
AssertFatal(rb != NULL, "SDU sent to unknown RB UE-ID %d SRB %d\n", ue_id, channel_id);
|
|
|
|
rb->set_time(rb, get_nr_rlc_current_time());
|
|
rb->recv_sdu(rb, (char *)buf, size, -1);
|
|
|
|
nr_rlc_manager_unlock(nr_rlc_ue_manager);
|
|
}
|