783 lines
24 KiB
C++
783 lines
24 KiB
C++
/* Copied from tbf.cpp
|
|
*
|
|
* Copyright (C) 2012 Ivan Klyuchnikov
|
|
* Copyright (C) 2012 Andreas Eversberg <jolly@eversberg.eu>
|
|
* Copyright (C) 2013 by Holger Hans Peter Freyther
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*/
|
|
|
|
#include <bts.h>
|
|
#include <bts_pch_timer.h>
|
|
#include <tbf.h>
|
|
#include <tbf_ul.h>
|
|
#include <rlc.h>
|
|
#include <encoding.h>
|
|
#include <gprs_rlcmac.h>
|
|
#include <gprs_debug.h>
|
|
#include <gprs_bssgp_pcu.h>
|
|
#include <decoding.h>
|
|
#include <pcu_l1_if.h>
|
|
#include <gprs_ms.h>
|
|
#include <llc.h>
|
|
#include "pcu_utils.h"
|
|
|
|
extern "C" {
|
|
#include <osmocom/core/msgb.h>
|
|
#include <osmocom/core/talloc.h>
|
|
#include <osmocom/core/bitvec.h>
|
|
#include <osmocom/core/logging.h>
|
|
#include <osmocom/core/rate_ctr.h>
|
|
#include <osmocom/core/stats.h>
|
|
#include <osmocom/core/utils.h>
|
|
#include <osmocom/gprs/gprs_bssgp_bss.h>
|
|
#include <osmocom/gprs/protocol/gsm_08_18.h>
|
|
#include <osmocom/gsm/tlv.h>
|
|
#include "coding_scheme.h"
|
|
}
|
|
|
|
#include <errno.h>
|
|
#include <string.h>
|
|
|
|
/* After receiving these frames, we send ack/nack. */
|
|
#define SEND_ACK_AFTER_FRAMES 20
|
|
|
|
extern void *tall_pcu_ctx;
|
|
|
|
static const struct rate_ctr_desc tbf_ul_gprs_ctr_description[] = {
|
|
{ "gprs:uplink:cs1", "CS1 " },
|
|
{ "gprs:uplink:cs2", "CS2 " },
|
|
{ "gprs:uplink:cs3", "CS3 " },
|
|
{ "gprs:uplink:cs4", "CS4 " },
|
|
};
|
|
|
|
static const struct rate_ctr_desc tbf_ul_egprs_ctr_description[] = {
|
|
{ "egprs:uplink:mcs1", "MCS1 " },
|
|
{ "egprs:uplink:mcs2", "MCS2 " },
|
|
{ "egprs:uplink:mcs3", "MCS3 " },
|
|
{ "egprs:uplink:mcs4", "MCS4 " },
|
|
{ "egprs:uplink:mcs5", "MCS5 " },
|
|
{ "egprs:uplink:mcs6", "MCS6 " },
|
|
{ "egprs:uplink:mcs7", "MCS7 " },
|
|
{ "egprs:uplink:mcs8", "MCS8 " },
|
|
{ "egprs:uplink:mcs9", "MCS9 " },
|
|
};
|
|
|
|
static const struct rate_ctr_group_desc tbf_ul_gprs_ctrg_desc = {
|
|
"tbf:gprs",
|
|
"Data Blocks",
|
|
OSMO_STATS_CLASS_SUBSCRIBER,
|
|
ARRAY_SIZE(tbf_ul_gprs_ctr_description),
|
|
tbf_ul_gprs_ctr_description,
|
|
};
|
|
|
|
static const struct rate_ctr_group_desc tbf_ul_egprs_ctrg_desc = {
|
|
"tbf:egprs",
|
|
"Data Blocks",
|
|
OSMO_STATS_CLASS_SUBSCRIBER,
|
|
ARRAY_SIZE(tbf_ul_egprs_ctr_description),
|
|
tbf_ul_egprs_ctr_description,
|
|
};
|
|
|
|
gprs_rlcmac_ul_tbf::~gprs_rlcmac_ul_tbf()
|
|
{
|
|
osmo_fsm_inst_free(ul_ack_fsm.fi);
|
|
ul_ack_fsm.fi = NULL;
|
|
|
|
rate_ctr_group_free(m_ul_egprs_ctrs);
|
|
rate_ctr_group_free(m_ul_gprs_ctrs);
|
|
/* ~gprs_rlcmac_tbf() is called automatically upon return */
|
|
}
|
|
|
|
static int ul_tbf_dtor(struct gprs_rlcmac_ul_tbf *tbf)
|
|
{
|
|
tbf->~gprs_rlcmac_ul_tbf();
|
|
return 0;
|
|
}
|
|
|
|
/* Generic function to alloc a UL TBF, later configured to be assigned either over CCCH or PACCH */
|
|
struct gprs_rlcmac_ul_tbf *tbf_alloc_ul_tbf(struct gprs_rlcmac_bts *bts, GprsMs *ms, int8_t use_trx, bool single_slot)
|
|
{
|
|
struct gprs_rlcmac_ul_tbf *tbf;
|
|
int rc;
|
|
|
|
OSMO_ASSERT(ms != NULL);
|
|
|
|
LOGPMS(ms, DTBF, LOGL_DEBUG, "********** UL-TBF starts here **********\n");
|
|
LOGPMS(ms, DTBF, LOGL_INFO, "Allocating UL TBF\n");
|
|
|
|
tbf = talloc(tall_pcu_ctx, struct gprs_rlcmac_ul_tbf);
|
|
if (!tbf)
|
|
return NULL;
|
|
talloc_set_destructor(tbf, ul_tbf_dtor);
|
|
new (tbf) gprs_rlcmac_ul_tbf(bts, ms);
|
|
|
|
rc = tbf->setup(use_trx, single_slot);
|
|
|
|
/* if no resource */
|
|
if (rc < 0) {
|
|
talloc_free(tbf);
|
|
return NULL;
|
|
}
|
|
|
|
if (tbf->is_egprs_enabled())
|
|
tbf->set_window_size();
|
|
|
|
tbf->m_ul_egprs_ctrs = rate_ctr_group_alloc(tbf,
|
|
&tbf_ul_egprs_ctrg_desc, tbf->m_ctrs->idx);
|
|
tbf->m_ul_gprs_ctrs = rate_ctr_group_alloc(tbf,
|
|
&tbf_ul_gprs_ctrg_desc, tbf->m_ctrs->idx);
|
|
if (!tbf->m_ul_egprs_ctrs || !tbf->m_ul_gprs_ctrs) {
|
|
LOGPTBF(tbf, LOGL_ERROR, "Couldn't allocate TBF UL counters\n");
|
|
talloc_free(tbf);
|
|
return NULL;
|
|
}
|
|
|
|
llist_add_tail(tbf_trx_list(tbf), &tbf->trx->ul_tbfs);
|
|
bts_do_rate_ctr_inc(tbf->bts, CTR_TBF_UL_ALLOCATED);
|
|
|
|
return tbf;
|
|
}
|
|
|
|
/* Alloc a UL TBF to be assigned over PACCH */
|
|
gprs_rlcmac_ul_tbf *tbf_alloc_ul_pacch(struct gprs_rlcmac_bts *bts, GprsMs *ms, int8_t use_trx,
|
|
uint32_t tlli)
|
|
{
|
|
struct gprs_rlcmac_ul_tbf *tbf;
|
|
|
|
tbf = tbf_alloc_ul_tbf(bts, ms, use_trx, false);
|
|
if (!tbf) {
|
|
LOGPMS(ms, DTBF, LOGL_NOTICE, "No PDCH resource\n");
|
|
/* Caller will most probably send a Imm Ass Reject after return */
|
|
return NULL;
|
|
}
|
|
tbf->m_contention_resolution_done = 1;
|
|
osmo_fsm_inst_dispatch(tbf->state_fsm.fi, TBF_EV_ASSIGN_ADD_PACCH, NULL);
|
|
tbf->update_ms(tlli, GPRS_RLCMAC_UL_TBF);
|
|
OSMO_ASSERT(tbf->ms());
|
|
|
|
return tbf;
|
|
}
|
|
|
|
/* Alloc a UL TBF to be assigned over CCCH */
|
|
struct gprs_rlcmac_ul_tbf *tbf_alloc_ul_ccch(struct gprs_rlcmac_bts *bts, struct GprsMs *ms)
|
|
{
|
|
struct gprs_rlcmac_ul_tbf *tbf;
|
|
|
|
tbf = tbf_alloc_ul_tbf(bts, ms, -1, true);
|
|
if (!tbf) {
|
|
LOGP(DTBF, LOGL_NOTICE, "No PDCH resource for Uplink TBF\n");
|
|
/* Caller will most probably send a Imm Ass Reject after return */
|
|
return NULL;
|
|
}
|
|
osmo_fsm_inst_dispatch(tbf->state_fsm.fi, TBF_EV_ASSIGN_ADD_CCCH, NULL);
|
|
tbf->contention_resolution_start();
|
|
OSMO_ASSERT(tbf->ms());
|
|
|
|
return tbf;
|
|
}
|
|
|
|
/* Create a temporary dummy TBF to Tx a ImmAssReject if allocating a new one during
|
|
* packet resource Request failed. This is similar as tbf_alloc_ul() but without
|
|
* calling tbf->setup() (in charge of TFI/USF allocation), and reusing resources
|
|
* from Packet Resource Request we received. See TS 44.060 sec 7.1.3.2.1 */
|
|
struct gprs_rlcmac_ul_tbf *handle_tbf_reject(struct gprs_rlcmac_bts *bts,
|
|
GprsMs *ms, uint8_t trx_no, uint8_t ts)
|
|
{
|
|
struct gprs_rlcmac_ul_tbf *ul_tbf = NULL;
|
|
struct gprs_rlcmac_trx *trx = &bts->trx[trx_no];
|
|
OSMO_ASSERT(ms);
|
|
|
|
ul_tbf = talloc(tall_pcu_ctx, struct gprs_rlcmac_ul_tbf);
|
|
if (!ul_tbf)
|
|
return ul_tbf;
|
|
talloc_set_destructor(ul_tbf, ul_tbf_dtor);
|
|
new (ul_tbf) gprs_rlcmac_ul_tbf(bts, ms);
|
|
|
|
ul_tbf->control_ts = ts;
|
|
ul_tbf->trx = trx;
|
|
ul_tbf->m_ctrs = rate_ctr_group_alloc(ul_tbf, &tbf_ctrg_desc, next_tbf_ctr_group_id++);
|
|
ul_tbf->m_ul_egprs_ctrs = rate_ctr_group_alloc(ul_tbf,
|
|
&tbf_ul_egprs_ctrg_desc,
|
|
ul_tbf->m_ctrs->idx);
|
|
ul_tbf->m_ul_gprs_ctrs = rate_ctr_group_alloc(ul_tbf,
|
|
&tbf_ul_gprs_ctrg_desc,
|
|
ul_tbf->m_ctrs->idx);
|
|
if (!ul_tbf->m_ctrs || !ul_tbf->m_ul_egprs_ctrs || !ul_tbf->m_ul_gprs_ctrs) {
|
|
LOGPTBF(ul_tbf, LOGL_ERROR, "Cound not allocate TBF UL rate counters\n");
|
|
talloc_free(ul_tbf);
|
|
return NULL;
|
|
}
|
|
|
|
ms_attach_tbf(ms, ul_tbf);
|
|
llist_add(tbf_trx_list((struct gprs_rlcmac_tbf *)ul_tbf), &trx->ul_tbfs);
|
|
bts_do_rate_ctr_inc(ul_tbf->bts, CTR_TBF_UL_ALLOCATED);
|
|
osmo_fsm_inst_dispatch(ul_tbf->state_fsm.fi, TBF_EV_ASSIGN_ADD_PACCH, NULL);
|
|
osmo_fsm_inst_dispatch(ul_tbf->ul_ass_fsm.fi, TBF_UL_ASS_EV_SCHED_ASS_REJ, NULL);
|
|
|
|
return ul_tbf;
|
|
}
|
|
|
|
gprs_rlcmac_ul_tbf::gprs_rlcmac_ul_tbf(struct gprs_rlcmac_bts *bts_, GprsMs *ms) :
|
|
gprs_rlcmac_tbf(bts_, ms, GPRS_RLCMAC_UL_TBF),
|
|
m_rx_counter(0),
|
|
m_contention_resolution_done(0),
|
|
m_ul_gprs_ctrs(NULL),
|
|
m_ul_egprs_ctrs(NULL)
|
|
{
|
|
memset(&m_usf, USF_INVALID, sizeof(m_usf));
|
|
|
|
memset(&ul_ack_fsm, 0, sizeof(ul_ack_fsm));
|
|
ul_ack_fsm.tbf = this;
|
|
ul_ack_fsm.fi = osmo_fsm_inst_alloc(&tbf_ul_ack_fsm, this, &ul_ack_fsm, LOGL_INFO, NULL);
|
|
|
|
}
|
|
|
|
/*
|
|
* Store received block data in LLC message(s) and forward to SGSN
|
|
* if complete.
|
|
*/
|
|
int gprs_rlcmac_ul_tbf::assemble_forward_llc(const gprs_rlc_data *_data)
|
|
{
|
|
const uint8_t *data = _data->block;
|
|
uint8_t len = _data->len;
|
|
const struct gprs_rlc_data_block_info *rdbi = &_data->block_info;
|
|
enum CodingScheme cs = _data->cs_last;
|
|
|
|
Decoding::RlcData frames[16], *frame;
|
|
int i, num_frames = 0;
|
|
uint32_t dummy_tlli;
|
|
|
|
LOGPTBFUL(this, LOGL_DEBUG, "Assembling frames: (len=%d)\n", len);
|
|
|
|
num_frames = Decoding::rlc_data_from_ul_data(
|
|
rdbi, cs, data, &(frames[0]), ARRAY_SIZE(frames),
|
|
&dummy_tlli);
|
|
|
|
/* create LLC frames */
|
|
for (i = 0; i < num_frames; i++) {
|
|
frame = frames + i;
|
|
|
|
if (frame->length) {
|
|
bts_do_rate_ctr_add(bts, CTR_RLC_UL_PAYLOAD_BYTES, frame->length);
|
|
|
|
LOGPTBFUL(this, LOGL_DEBUG, "Frame %d "
|
|
"starts at offset %d, "
|
|
"length=%d, is_complete=%d\n",
|
|
i + 1, frame->offset, frame->length,
|
|
frame->is_complete);
|
|
|
|
m_llc.append_frame(data + frame->offset, frame->length);
|
|
llc_consume(&m_llc, frame->length);
|
|
}
|
|
|
|
if (frame->is_complete) {
|
|
/* send frame to SGSN */
|
|
LOGPTBFUL(this, LOGL_DEBUG, "complete UL frame len=%d\n", llc_frame_length(&m_llc));
|
|
snd_ul_ud();
|
|
bts_do_rate_ctr_add(bts, CTR_LLC_UL_BYTES, llc_frame_length(&m_llc));
|
|
m_llc.reset();
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void gprs_rlcmac_ul_tbf::contention_resolution_start()
|
|
{
|
|
/* 3GPP TS 44.018 sec 11.1.2 Timers on the network side: "This timer is
|
|
* started when a temporary block flow is allocated with an IMMEDIATE
|
|
* ASSIGNMENT or an IMMEDIATE PACKET ASSIGNMENT or an EC IMMEDIATE
|
|
* ASSIGNMENT TYPE 1 message during a packet access procedure. It is
|
|
* stopped when the mobile station has correctly seized the temporary
|
|
* block flow."
|
|
* In our code base, it means we want to do contention resolution
|
|
* timeout only for one-phase packet access, since two-phase is handled
|
|
* through SBA structs, which are freed by the PDCH UL Controller if the
|
|
* single allocated block is lost. */
|
|
T_START(this, T3141, 3141, "Contention resolution (UL-TBF, CCCH)", true);
|
|
}
|
|
void gprs_rlcmac_ul_tbf::contention_resolution_success()
|
|
{
|
|
if (m_contention_resolution_done)
|
|
return;
|
|
|
|
/* 3GPP TS 44.060 sec 7a.2.1 Contention Resolution */
|
|
/* 3GPP TS 44.018 3.5.2.1.4 Packet access completion: The one phase
|
|
packet access procedure is completed at a successful contention
|
|
resolution. The mobile station has entered the packet transfer mode.
|
|
Timer T3141 is stopped on the network side */
|
|
t_stop(T3141, "Contention resolution success (UL-TBF, CCCH)");
|
|
|
|
/* now we must set this flag, so we are allowed to assign downlink
|
|
* TBF on PACCH. it is only allowed when TLLI is acknowledged. */
|
|
m_contention_resolution_done = 1;
|
|
}
|
|
|
|
/*! \brief receive data from PDCH/L1 */
|
|
int gprs_rlcmac_ul_tbf::rcv_data_block_acknowledged(
|
|
const struct gprs_rlc_data_info *rlc,
|
|
uint8_t *data, struct pcu_l1_meas *meas)
|
|
{
|
|
const struct gprs_rlc_data_block_info *rdbi;
|
|
struct gprs_rlc_data *block;
|
|
|
|
int8_t rssi = meas->have_rssi ? meas->rssi : 0;
|
|
|
|
const uint16_t ws = m_window.ws();
|
|
|
|
LOGPTBFUL(this, LOGL_DEBUG, "UL DATA TFI=%d received (V(Q)=%d .. "
|
|
"V(R)=%d)\n", rlc->tfi, this->m_window.v_q(),
|
|
this->m_window.v_r());
|
|
|
|
/* process RSSI */
|
|
gprs_rlcmac_rssi(this, rssi);
|
|
|
|
/* store measurement values */
|
|
ms_update_l1_meas(ms(), meas);
|
|
|
|
uint32_t new_tlli = GSM_RESERVED_TMSI;
|
|
unsigned int block_idx;
|
|
|
|
/* Increment RX-counter */
|
|
this->m_rx_counter++;
|
|
update_coding_scheme_counter_ul(rlc->cs);
|
|
/* Loop over num_blocks */
|
|
for (block_idx = 0; block_idx < rlc->num_data_blocks; block_idx++) {
|
|
int num_chunks;
|
|
uint8_t *rlc_data;
|
|
rdbi = &rlc->block_info[block_idx];
|
|
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Got %s RLC data block: CV=%d, BSN=%d, SPB=%d, PI=%d, E=%d, TI=%d, bitoffs=%d\n",
|
|
mcs_name(rlc->cs),
|
|
rdbi->cv, rdbi->bsn, rdbi->spb,
|
|
rdbi->pi, rdbi->e, rdbi->ti,
|
|
rlc->data_offs_bits[block_idx]);
|
|
|
|
/* Check whether the block needs to be decoded */
|
|
|
|
if (!m_window.is_in_window(rdbi->bsn)) {
|
|
LOGPTBFUL(this, LOGL_DEBUG, "BSN %d out of window %d..%d (it's normal)\n",
|
|
rdbi->bsn,
|
|
m_window.v_q(), m_window.mod_sns(m_window.v_q() + ws - 1));
|
|
continue;
|
|
} else if (m_window.is_received(rdbi->bsn)) {
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"BSN %d already received\n", rdbi->bsn);
|
|
continue;
|
|
}
|
|
|
|
/* Store block and meta info to BSN buffer */
|
|
|
|
LOGPTBFUL(this, LOGL_DEBUG, "BSN %d storing in window (%d..%d)\n",
|
|
rdbi->bsn, m_window.v_q(),
|
|
m_window.mod_sns(m_window.v_q() + ws - 1));
|
|
block = m_rlc.block(rdbi->bsn);
|
|
OSMO_ASSERT(rdbi->data_len <= sizeof(block->block));
|
|
rlc_data = &(block->block[0]);
|
|
|
|
if (rdbi->spb) {
|
|
egprs_rlc_ul_reseg_bsn_state assemble_status;
|
|
|
|
assemble_status = handle_egprs_ul_spb(rlc,
|
|
block, data, block_idx);
|
|
|
|
if (assemble_status != EGPRS_RESEG_DEFAULT)
|
|
return 0;
|
|
} else {
|
|
block->block_info = *rdbi;
|
|
block->cs_last = rlc->cs;
|
|
block->len =
|
|
Decoding::rlc_copy_to_aligned_buffer(rlc,
|
|
block_idx, data, rlc_data);
|
|
}
|
|
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"data_length=%d, data=%s\n",
|
|
block->len, osmo_hexdump(rlc_data, block->len));
|
|
/* Get/Handle TLLI */
|
|
if (rdbi->ti) {
|
|
num_chunks = Decoding::rlc_data_from_ul_data(
|
|
rdbi, rlc->cs, rlc_data, NULL, 0, &new_tlli);
|
|
|
|
if (num_chunks < 0) {
|
|
bts_do_rate_ctr_inc(bts, CTR_DECODE_ERRORS);
|
|
LOGPTBFUL(this, LOGL_NOTICE,
|
|
"Failed to decode TLLI of %s UL DATA TFI=%d.\n",
|
|
mcs_name(rlc->cs), rlc->tfi);
|
|
m_window.invalidate_bsn(rdbi->bsn);
|
|
continue;
|
|
}
|
|
if (!this->is_tlli_valid()) {
|
|
if (new_tlli == GSM_RESERVED_TMSI) {
|
|
LOGPTBFUL(this, LOGL_NOTICE,
|
|
"TLLI is 0x%08x within UL DATA?!?\n",
|
|
new_tlli);
|
|
m_window.invalidate_bsn(rdbi->bsn);
|
|
continue;
|
|
}
|
|
LOGPTBFUL(this, LOGL_INFO,
|
|
"Decoded premier TLLI=0x%08x of UL DATA TFI=%d.\n",
|
|
new_tlli, rlc->tfi);
|
|
update_ms(new_tlli, GPRS_RLCMAC_UL_TBF);
|
|
bts_pch_timer_stop(bts, ms_imsi(ms()));
|
|
} else if (new_tlli != GSM_RESERVED_TMSI && new_tlli != tlli()) {
|
|
LOGPTBFUL(this, LOGL_NOTICE,
|
|
"Decoded TLLI=%08x mismatch on UL DATA TFI=%d. (Ignoring due to contention resolution)\n",
|
|
new_tlli, rlc->tfi);
|
|
m_window.invalidate_bsn(rdbi->bsn);
|
|
continue;
|
|
}
|
|
} else if (!is_tlli_valid()) {
|
|
LOGPTBFUL(this, LOGL_NOTICE, "Missing TLLI within UL DATA.\n");
|
|
m_window.invalidate_bsn(rdbi->bsn);
|
|
continue;
|
|
}
|
|
|
|
m_window.receive_bsn(rdbi->bsn);
|
|
}
|
|
|
|
/* Raise V(Q) if possible, and retrieve LLC frames from blocks.
|
|
* This is looped until there is a gap (non received block) or
|
|
* the window is empty.*/
|
|
const uint16_t v_q_beg = m_window.v_q();
|
|
const uint16_t count = m_window.raise_v_q();
|
|
|
|
/* Retrieve LLC frames from blocks that are ready */
|
|
for (uint16_t i = 0; i < count; ++i) {
|
|
uint16_t index = m_window.mod_sns(v_q_beg + i);
|
|
assemble_forward_llc(m_rlc.block(index));
|
|
}
|
|
|
|
/* Last frame in buffer: */
|
|
block = m_rlc.block(m_window.mod_sns(m_window.v_r() - 1));
|
|
rdbi = &block->block_info;
|
|
|
|
/* Check if we already received all data TBF had to send: */
|
|
if (this->state_is(TBF_ST_FLOW) /* still in flow state */
|
|
&& this->m_window.v_q() == this->m_window.v_r() /* if complete */
|
|
&& block->len) { /* if there was ever a last block received */
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"No gaps in received block, last block: BSN=%d CV=%d\n",
|
|
rdbi->bsn, rdbi->cv);
|
|
if (rdbi->cv == 0) {
|
|
LOGPTBFUL(this, LOGL_DEBUG, "Finished with UL TBF\n");
|
|
osmo_fsm_inst_dispatch(this->state_fsm.fi, TBF_EV_LAST_UL_DATA_RECVD, NULL);
|
|
/* Reset N3103 counter. */
|
|
this->n_reset(N3103);
|
|
}
|
|
}
|
|
|
|
/* If TLLI is included or if we received half of the window, we send
|
|
* an ack/nack */
|
|
maybe_schedule_uplink_acknack(rlc, block->len && rdbi->cv == 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void gprs_rlcmac_ul_tbf::maybe_schedule_uplink_acknack(
|
|
const gprs_rlc_data_info *rlc, bool countdown_finished)
|
|
{
|
|
bool require_ack = false;
|
|
bool have_ti = rlc->block_info[0].ti ||
|
|
(rlc->num_data_blocks > 1 && rlc->block_info[1].ti);
|
|
|
|
if (rlc->si) {
|
|
require_ack = true;
|
|
LOGPTBFUL(this, LOGL_NOTICE,
|
|
"Scheduling Ack/Nack, because MS is stalled.\n");
|
|
}
|
|
if (have_ti) {
|
|
require_ack = true;
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Scheduling Ack/Nack, because TLLI is included.\n");
|
|
}
|
|
if (countdown_finished) {
|
|
require_ack = true;
|
|
if (state_is(TBF_ST_FLOW))
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Scheduling Ack/Nack, because some data is missing and last block has CV==0.\n");
|
|
else if (state_is(TBF_ST_FINISHED))
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Scheduling final Ack/Nack, because all data was received and last block has CV==0.\n");
|
|
}
|
|
if ((m_rx_counter % SEND_ACK_AFTER_FRAMES) == 0) {
|
|
require_ack = true;
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Scheduling Ack/Nack, because %d frames received.\n",
|
|
SEND_ACK_AFTER_FRAMES);
|
|
}
|
|
|
|
if (!require_ack)
|
|
return;
|
|
|
|
osmo_fsm_inst_dispatch(this->ul_ack_fsm.fi, TBF_UL_ACK_EV_SCHED_ACK, NULL);
|
|
}
|
|
|
|
/* Send Uplink unit-data to SGSN. */
|
|
int gprs_rlcmac_ul_tbf::snd_ul_ud()
|
|
{
|
|
uint8_t qos_profile[3];
|
|
struct msgb *llc_pdu;
|
|
unsigned msg_len = NS_HDR_LEN + BSSGP_HDR_LEN + llc_frame_length(&m_llc);
|
|
struct bssgp_bvc_ctx *bctx = bts->pcu->bssgp.bctx;
|
|
|
|
LOGP(DBSSGP, LOGL_INFO, "LLC [PCU -> SGSN] %s len=%d\n", tbf_name(this), llc_frame_length(&m_llc));
|
|
if (!bctx) {
|
|
LOGP(DBSSGP, LOGL_ERROR, "No bctx\n");
|
|
m_llc.reset_frame_space();
|
|
return -EIO;
|
|
}
|
|
|
|
llc_pdu = msgb_alloc_headroom(msg_len, msg_len,"llc_pdu");
|
|
uint8_t *buf = msgb_push(llc_pdu, TL16V_GROSS_LEN(sizeof(uint8_t)*llc_frame_length(&m_llc)));
|
|
tl16v_put(buf, BSSGP_IE_LLC_PDU, sizeof(uint8_t)*llc_frame_length(&m_llc), m_llc.frame);
|
|
qos_profile[0] = QOS_PROFILE >> 16;
|
|
qos_profile[1] = QOS_PROFILE >> 8;
|
|
qos_profile[2] = QOS_PROFILE;
|
|
bssgp_tx_ul_ud(bctx, tlli(), qos_profile, llc_pdu);
|
|
|
|
m_llc.reset_frame_space();
|
|
return 0;
|
|
}
|
|
|
|
egprs_rlc_ul_reseg_bsn_state gprs_rlcmac_ul_tbf::handle_egprs_ul_second_seg(
|
|
const struct gprs_rlc_data_info *rlc, struct gprs_rlc_data *block,
|
|
uint8_t *data, const uint8_t block_idx)
|
|
{
|
|
const gprs_rlc_data_block_info *rdbi = &rlc->block_info[block_idx];
|
|
union split_block_status *spb_status = &block->spb_status;
|
|
uint8_t *rlc_data = &block->block[0];
|
|
|
|
bts_do_rate_ctr_inc(bts, CTR_SPB_UL_SECOND_SEGMENT);
|
|
|
|
if (spb_status->block_status_ul &
|
|
EGPRS_RESEG_FIRST_SEG_RXD) {
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Second seg is received first seg is already present set the status to complete\n");
|
|
spb_status->block_status_ul = EGPRS_RESEG_DEFAULT;
|
|
|
|
block->len += Decoding::rlc_copy_to_aligned_buffer(rlc,
|
|
block_idx, data, rlc_data + block->len);
|
|
block->block_info.data_len += rdbi->data_len;
|
|
} else if (spb_status->block_status_ul == EGPRS_RESEG_DEFAULT) {
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Second seg is received first seg is not received set the status to second seg received\n");
|
|
|
|
block->len = Decoding::rlc_copy_to_aligned_buffer(rlc,
|
|
block_idx, data,
|
|
rlc_data + rlc->block_info[block_idx].data_len);
|
|
|
|
spb_status->block_status_ul = EGPRS_RESEG_SECOND_SEG_RXD;
|
|
block->block_info = *rdbi;
|
|
}
|
|
return spb_status->block_status_ul;
|
|
}
|
|
|
|
egprs_rlc_ul_reseg_bsn_state gprs_rlcmac_ul_tbf::handle_egprs_ul_first_seg(
|
|
const struct gprs_rlc_data_info *rlc, struct gprs_rlc_data *block,
|
|
uint8_t *data, const uint8_t block_idx)
|
|
{
|
|
const gprs_rlc_data_block_info *rdbi = &rlc->block_info[block_idx];
|
|
uint8_t *rlc_data = &block->block[0];
|
|
union split_block_status *spb_status = &block->spb_status;
|
|
|
|
bts_do_rate_ctr_inc(bts, CTR_SPB_UL_FIRST_SEGMENT);
|
|
|
|
if (spb_status->block_status_ul & EGPRS_RESEG_SECOND_SEG_RXD) {
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"First seg is received second seg is already present set the status to complete\n");
|
|
|
|
block->len += Decoding::rlc_copy_to_aligned_buffer(rlc,
|
|
block_idx, data, rlc_data);
|
|
|
|
block->block_info.data_len = block->len;
|
|
spb_status->block_status_ul = EGPRS_RESEG_DEFAULT;
|
|
} else if (spb_status->block_status_ul == EGPRS_RESEG_DEFAULT) {
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"First seg is received second seg is not received set the status to first seg received\n");
|
|
|
|
spb_status->block_status_ul = EGPRS_RESEG_FIRST_SEG_RXD;
|
|
block->len = Decoding::rlc_copy_to_aligned_buffer(rlc,
|
|
block_idx, data, rlc_data);
|
|
block->block_info = *rdbi;
|
|
}
|
|
return spb_status->block_status_ul;
|
|
}
|
|
|
|
egprs_rlc_ul_reseg_bsn_state gprs_rlcmac_ul_tbf::handle_egprs_ul_spb(
|
|
const struct gprs_rlc_data_info *rlc, struct gprs_rlc_data *block,
|
|
uint8_t *data, const uint8_t block_idx)
|
|
{
|
|
const gprs_rlc_data_block_info *rdbi = &rlc->block_info[block_idx];
|
|
|
|
LOGPTBFUL(this, LOGL_DEBUG,
|
|
"Got SPB(%d) cs(%s) data block with BSN (%d), TFI(%d).\n",
|
|
rdbi->spb, mcs_name(rlc->cs), rdbi->bsn, rlc->tfi);
|
|
|
|
egprs_rlc_ul_reseg_bsn_state assemble_status = EGPRS_RESEG_INVALID;
|
|
|
|
/* Section 10.4.8b of 44.060*/
|
|
if (rdbi->spb == 2)
|
|
assemble_status = handle_egprs_ul_first_seg(rlc,
|
|
block, data, block_idx);
|
|
else if (rdbi->spb == 3)
|
|
assemble_status = handle_egprs_ul_second_seg(rlc,
|
|
block, data, block_idx);
|
|
else {
|
|
LOGPTBFUL(this, LOGL_ERROR,
|
|
"spb(%d) Not supported SPB for this EGPRS configuration\n",
|
|
rdbi->spb);
|
|
}
|
|
|
|
/*
|
|
* When the block is successfully constructed out of segmented blocks
|
|
* upgrade the MCS to the type 2
|
|
*/
|
|
if (assemble_status == EGPRS_RESEG_DEFAULT) {
|
|
switch (rlc->cs) {
|
|
case MCS3 :
|
|
block->cs_last = MCS6;
|
|
LOGPTBFUL(this, LOGL_DEBUG, "Upgrading to MCS6\n");
|
|
break;
|
|
case MCS2 :
|
|
block->cs_last = MCS5;
|
|
LOGPTBFUL(this, LOGL_DEBUG, "Upgrading to MCS5\n");
|
|
break;
|
|
case MCS1 :
|
|
LOGPTBFUL(this, LOGL_DEBUG, "Upgrading to MCS4\n");
|
|
block->cs_last = MCS4;
|
|
break;
|
|
default:
|
|
LOGPTBFUL(this, LOGL_ERROR,
|
|
"cs(%s) Error in Upgrading to higher MCS\n",
|
|
mcs_name(rlc->cs));
|
|
break;
|
|
}
|
|
}
|
|
return assemble_status;
|
|
}
|
|
|
|
void gprs_rlcmac_ul_tbf::update_coding_scheme_counter_ul(enum CodingScheme cs)
|
|
{
|
|
switch (cs) {
|
|
case CS1:
|
|
bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS1);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS1));
|
|
break;
|
|
case CS2:
|
|
bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS2);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS2));
|
|
break;
|
|
case CS3:
|
|
bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS3);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS3));
|
|
break;
|
|
case CS4:
|
|
bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS4);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS4));
|
|
break;
|
|
case MCS1:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS1);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS1));
|
|
break;
|
|
case MCS2:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS2);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS2));
|
|
break;
|
|
case MCS3:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS3);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS3));
|
|
break;
|
|
case MCS4:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS4);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS4));
|
|
break;
|
|
case MCS5:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS5);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS5));
|
|
break;
|
|
case MCS6:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS6);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS6));
|
|
break;
|
|
case MCS7:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS7);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS7));
|
|
break;
|
|
case MCS8:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS8);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS8));
|
|
break;
|
|
case MCS9:
|
|
bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS9);
|
|
rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS9));
|
|
break;
|
|
default:
|
|
LOGPTBFUL(this, LOGL_ERROR, "attempting to update rate counters for unsupported (M)CS %s\n",
|
|
mcs_name(cs));
|
|
}
|
|
}
|
|
|
|
void gprs_rlcmac_ul_tbf::set_window_size()
|
|
{
|
|
const struct gprs_rlcmac_bts *b = bts;
|
|
uint16_t ws = egprs_window_size(b, ul_slots());
|
|
LOGPTBFUL(this, LOGL_INFO, "setting EGPRS UL window size to %u, base(%u) slots(%u) ws_pdch(%u)\n",
|
|
ws, bts->pcu->vty.ws_base, pcu_bitcount(ul_slots()), bts->pcu->vty.ws_pdch);
|
|
m_window.set_ws(ws);
|
|
}
|
|
|
|
gprs_rlc_window *gprs_rlcmac_ul_tbf::window()
|
|
{
|
|
return &m_window;
|
|
}
|
|
|
|
void gprs_rlcmac_ul_tbf::usf_timeout()
|
|
{
|
|
if (n_inc(N3101))
|
|
osmo_fsm_inst_dispatch(this->state_fsm.fi, TBF_EV_MAX_N3101, NULL);
|
|
}
|
|
|
|
struct gprs_rlcmac_ul_tbf *as_ul_tbf(struct gprs_rlcmac_tbf *tbf)
|
|
{
|
|
if (tbf && tbf->direction == GPRS_RLCMAC_UL_TBF)
|
|
return static_cast<gprs_rlcmac_ul_tbf *>(tbf);
|
|
else
|
|
return NULL;
|
|
}
|
|
|
|
void tbf_usf_timeout(struct gprs_rlcmac_ul_tbf *tbf)
|
|
{
|
|
tbf->usf_timeout();
|
|
}
|
|
|
|
|
|
bool ul_tbf_contention_resolution_done(const struct gprs_rlcmac_ul_tbf *tbf)
|
|
{
|
|
return tbf->m_contention_resolution_done;
|
|
}
|
|
|
|
struct osmo_fsm_inst *tbf_ul_ack_fi(const struct gprs_rlcmac_ul_tbf *tbf)
|
|
{
|
|
return tbf->ul_ack_fsm.fi;
|
|
}
|
|
|
|
void ul_tbf_contention_resolution_success(struct gprs_rlcmac_ul_tbf *tbf)
|
|
{
|
|
return tbf->contention_resolution_success();
|
|
}
|