Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 1 | /* Copied from tbf.cpp |
| 2 | * |
| 3 | * Copyright (C) 2012 Ivan Klyuchnikov |
| 4 | * Copyright (C) 2012 Andreas Eversberg <jolly@eversberg.eu> |
| 5 | * Copyright (C) 2013 by Holger Hans Peter Freyther |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or |
| 8 | * modify it under the terms of the GNU General Public License |
| 9 | * as published by the Free Software Foundation; either version 2 |
| 10 | * of the License, or (at your option) any later version. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 15 | * GNU General Public License for more details. |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 16 | */ |
| 17 | |
| 18 | #include <bts.h> |
Oliver Smith | d3c7591 | 2021-07-09 16:37:16 +0200 | [diff] [blame] | 19 | #include <bts_pch_timer.h> |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 20 | #include <tbf.h> |
Pau Espin Pedrol | 9d1cdb1 | 2019-09-25 17:47:02 +0200 | [diff] [blame] | 21 | #include <tbf_ul.h> |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 22 | #include <rlc.h> |
| 23 | #include <encoding.h> |
| 24 | #include <gprs_rlcmac.h> |
| 25 | #include <gprs_debug.h> |
| 26 | #include <gprs_bssgp_pcu.h> |
| 27 | #include <decoding.h> |
Jacob Erlbeck | 20f6fd1 | 2015-06-08 11:05:45 +0200 | [diff] [blame] | 28 | #include <pcu_l1_if.h> |
Max | 1187a77 | 2018-01-26 13:31:42 +0100 | [diff] [blame] | 29 | #include <gprs_ms.h> |
| 30 | #include <llc.h> |
sivasankari | 8adfcd0 | 2017-01-16 15:41:21 +0530 | [diff] [blame] | 31 | #include "pcu_utils.h" |
Pau Espin Pedrol | d6c555e | 2023-04-20 20:10:53 +0200 | [diff] [blame] | 32 | #include "alloc_algo.h" |
sivasankari | 8adfcd0 | 2017-01-16 15:41:21 +0530 | [diff] [blame] | 33 | |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 34 | extern "C" { |
| 35 | #include <osmocom/core/msgb.h> |
| 36 | #include <osmocom/core/talloc.h> |
Max | 1187a77 | 2018-01-26 13:31:42 +0100 | [diff] [blame] | 37 | #include <osmocom/core/bitvec.h> |
| 38 | #include <osmocom/core/logging.h> |
| 39 | #include <osmocom/core/rate_ctr.h> |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 40 | #include <osmocom/core/stats.h> |
Max | 1187a77 | 2018-01-26 13:31:42 +0100 | [diff] [blame] | 41 | #include <osmocom/core/utils.h> |
| 42 | #include <osmocom/gprs/gprs_bssgp_bss.h> |
| 43 | #include <osmocom/gprs/protocol/gsm_08_18.h> |
| 44 | #include <osmocom/gsm/tlv.h> |
Max | 136ebcc | 2019-03-05 14:59:03 +0100 | [diff] [blame] | 45 | #include "coding_scheme.h" |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 46 | } |
| 47 | |
| 48 | #include <errno.h> |
| 49 | #include <string.h> |
| 50 | |
| 51 | /* After receiving these frames, we send ack/nack. */ |
| 52 | #define SEND_ACK_AFTER_FRAMES 20 |
| 53 | |
| 54 | extern void *tall_pcu_ctx; |
| 55 | |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 56 | static const struct rate_ctr_desc tbf_ul_gprs_ctr_description[] = { |
| 57 | { "gprs:uplink:cs1", "CS1 " }, |
| 58 | { "gprs:uplink:cs2", "CS2 " }, |
| 59 | { "gprs:uplink:cs3", "CS3 " }, |
| 60 | { "gprs:uplink:cs4", "CS4 " }, |
| 61 | }; |
| 62 | |
| 63 | static const struct rate_ctr_desc tbf_ul_egprs_ctr_description[] = { |
| 64 | { "egprs:uplink:mcs1", "MCS1 " }, |
| 65 | { "egprs:uplink:mcs2", "MCS2 " }, |
| 66 | { "egprs:uplink:mcs3", "MCS3 " }, |
| 67 | { "egprs:uplink:mcs4", "MCS4 " }, |
| 68 | { "egprs:uplink:mcs5", "MCS5 " }, |
| 69 | { "egprs:uplink:mcs6", "MCS6 " }, |
| 70 | { "egprs:uplink:mcs7", "MCS7 " }, |
| 71 | { "egprs:uplink:mcs8", "MCS8 " }, |
| 72 | { "egprs:uplink:mcs9", "MCS9 " }, |
| 73 | }; |
| 74 | |
| 75 | static const struct rate_ctr_group_desc tbf_ul_gprs_ctrg_desc = { |
| 76 | "tbf:gprs", |
| 77 | "Data Blocks", |
| 78 | OSMO_STATS_CLASS_SUBSCRIBER, |
| 79 | ARRAY_SIZE(tbf_ul_gprs_ctr_description), |
| 80 | tbf_ul_gprs_ctr_description, |
| 81 | }; |
| 82 | |
| 83 | static const struct rate_ctr_group_desc tbf_ul_egprs_ctrg_desc = { |
| 84 | "tbf:egprs", |
| 85 | "Data Blocks", |
| 86 | OSMO_STATS_CLASS_SUBSCRIBER, |
| 87 | ARRAY_SIZE(tbf_ul_egprs_ctr_description), |
| 88 | tbf_ul_egprs_ctr_description, |
| 89 | }; |
| 90 | |
Pau Espin Pedrol | 131deb0 | 2021-07-26 18:24:14 +0200 | [diff] [blame] | 91 | gprs_rlcmac_ul_tbf::~gprs_rlcmac_ul_tbf() |
| 92 | { |
Pau Espin Pedrol | ea8dbdd | 2021-07-29 18:39:16 +0200 | [diff] [blame] | 93 | osmo_fsm_inst_free(ul_ack_fsm.fi); |
| 94 | ul_ack_fsm.fi = NULL; |
| 95 | |
Pau Espin Pedrol | 131deb0 | 2021-07-26 18:24:14 +0200 | [diff] [blame] | 96 | rate_ctr_group_free(m_ul_egprs_ctrs); |
| 97 | rate_ctr_group_free(m_ul_gprs_ctrs); |
| 98 | /* ~gprs_rlcmac_tbf() is called automatically upon return */ |
| 99 | } |
| 100 | |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 101 | static int ul_tbf_dtor(struct gprs_rlcmac_ul_tbf *tbf) |
| 102 | { |
| 103 | tbf->~gprs_rlcmac_ul_tbf(); |
| 104 | return 0; |
| 105 | } |
| 106 | |
Pau Espin Pedrol | 54742f2 | 2021-04-26 16:48:34 +0200 | [diff] [blame] | 107 | /* Generic function to alloc a UL TBF, later configured to be assigned either over CCCH or PACCH */ |
Pau Espin Pedrol | 4d36391 | 2023-04-21 19:32:16 +0200 | [diff] [blame] | 108 | struct gprs_rlcmac_ul_tbf *ul_tbf_alloc(struct gprs_rlcmac_bts *bts, struct GprsMs *ms) |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 109 | { |
| 110 | struct gprs_rlcmac_ul_tbf *tbf; |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 111 | |
| 112 | OSMO_ASSERT(ms != NULL); |
| 113 | |
Pau Espin Pedrol | 36177c6 | 2021-02-25 17:57:37 +0100 | [diff] [blame] | 114 | LOGPMS(ms, DTBF, LOGL_DEBUG, "********** UL-TBF starts here **********\n"); |
| 115 | LOGPMS(ms, DTBF, LOGL_INFO, "Allocating UL TBF\n"); |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 116 | |
| 117 | tbf = talloc(tall_pcu_ctx, struct gprs_rlcmac_ul_tbf); |
| 118 | if (!tbf) |
| 119 | return NULL; |
| 120 | talloc_set_destructor(tbf, ul_tbf_dtor); |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 121 | new (tbf) gprs_rlcmac_ul_tbf(bts, ms); |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 122 | |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 123 | bts_do_rate_ctr_inc(tbf->bts, CTR_TBF_UL_ALLOCATED); |
Pau Espin Pedrol | 442198c | 2020-10-23 22:30:04 +0200 | [diff] [blame] | 124 | |
| 125 | return tbf; |
| 126 | } |
| 127 | |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 128 | gprs_rlcmac_ul_tbf::gprs_rlcmac_ul_tbf(struct gprs_rlcmac_bts *bts_, GprsMs *ms) : |
Pau Espin Pedrol | e9f77d3 | 2020-10-23 18:41:40 +0200 | [diff] [blame] | 129 | gprs_rlcmac_tbf(bts_, ms, GPRS_RLCMAC_UL_TBF), |
Pau Espin Pedrol | bddf1ad | 2019-09-26 14:41:18 +0200 | [diff] [blame] | 130 | m_rx_counter(0), |
Pau Espin Pedrol | 9438613 | 2022-10-28 19:50:09 +0200 | [diff] [blame] | 131 | m_contention_resolution_done(true), |
Pau Espin Pedrol | bddf1ad | 2019-09-26 14:41:18 +0200 | [diff] [blame] | 132 | m_ul_gprs_ctrs(NULL), |
| 133 | m_ul_egprs_ctrs(NULL) |
| 134 | { |
Pau Espin Pedrol | 7bd92a3 | 2021-03-24 13:14:09 +0100 | [diff] [blame] | 135 | memset(&m_usf, USF_INVALID, sizeof(m_usf)); |
Pau Espin Pedrol | ea8dbdd | 2021-07-29 18:39:16 +0200 | [diff] [blame] | 136 | |
Pau Espin Pedrol | 343c0ee | 2022-11-17 19:55:08 +0100 | [diff] [blame] | 137 | memset(&state_fsm, 0, sizeof(state_fsm)); |
Pau Espin Pedrol | cdc762a | 2022-12-12 19:58:37 +0100 | [diff] [blame] | 138 | state_fsm.ul_tbf = this; |
Pau Espin Pedrol | 343c0ee | 2022-11-17 19:55:08 +0100 | [diff] [blame] | 139 | state_fi = osmo_fsm_inst_alloc(&tbf_ul_fsm, this, &state_fsm, LOGL_INFO, NULL); |
| 140 | OSMO_ASSERT(state_fi); |
| 141 | |
Pau Espin Pedrol | ea8dbdd | 2021-07-29 18:39:16 +0200 | [diff] [blame] | 142 | memset(&ul_ack_fsm, 0, sizeof(ul_ack_fsm)); |
| 143 | ul_ack_fsm.tbf = this; |
| 144 | ul_ack_fsm.fi = osmo_fsm_inst_alloc(&tbf_ul_ack_fsm, this, &ul_ack_fsm, LOGL_INFO, NULL); |
Pau Espin Pedrol | e0e4251 | 2023-04-19 18:30:01 +0200 | [diff] [blame] | 145 | |
| 146 | m_ul_egprs_ctrs = rate_ctr_group_alloc(this, &tbf_ul_egprs_ctrg_desc, m_ctrs->idx); |
| 147 | OSMO_ASSERT(m_ul_egprs_ctrs); |
| 148 | m_ul_gprs_ctrs = rate_ctr_group_alloc(this, &tbf_ul_gprs_ctrg_desc, m_ctrs->idx); |
| 149 | OSMO_ASSERT(m_ul_gprs_ctrs); |
Pau Espin Pedrol | 759724c | 2023-04-19 18:36:40 +0200 | [diff] [blame] | 150 | |
| 151 | /* This has to be called in child constructor because enable_egprs() |
| 152 | * uses the window() virtual function which is dependent on subclass. */ |
| 153 | if (ms_mode(m_ms) != GPRS) |
| 154 | enable_egprs(); |
Pau Espin Pedrol | bddf1ad | 2019-09-26 14:41:18 +0200 | [diff] [blame] | 155 | } |
| 156 | |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 157 | /* |
| 158 | * Store received block data in LLC message(s) and forward to SGSN |
| 159 | * if complete. |
| 160 | */ |
| 161 | int gprs_rlcmac_ul_tbf::assemble_forward_llc(const gprs_rlc_data *_data) |
| 162 | { |
| 163 | const uint8_t *data = _data->block; |
| 164 | uint8_t len = _data->len; |
Jacob Erlbeck | f2ba4cb | 2016-01-07 18:59:28 +0100 | [diff] [blame] | 165 | const struct gprs_rlc_data_block_info *rdbi = &_data->block_info; |
Pau Espin Pedrol | 2ae8337 | 2020-05-18 11:35:35 +0200 | [diff] [blame] | 166 | enum CodingScheme cs = _data->cs_last; |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 167 | |
| 168 | Decoding::RlcData frames[16], *frame; |
| 169 | int i, num_frames = 0; |
| 170 | uint32_t dummy_tlli; |
| 171 | |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 172 | LOGPTBFUL(this, LOGL_DEBUG, "Assembling frames: (len=%d)\n", len); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 173 | |
| 174 | num_frames = Decoding::rlc_data_from_ul_data( |
Alexander Couzens | ce936f3 | 2016-05-24 14:45:41 +0200 | [diff] [blame] | 175 | rdbi, cs, data, &(frames[0]), ARRAY_SIZE(frames), |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 176 | &dummy_tlli); |
| 177 | |
| 178 | /* create LLC frames */ |
| 179 | for (i = 0; i < num_frames; i++) { |
| 180 | frame = frames + i; |
| 181 | |
Aravind Sirsikar | 22a9019 | 2016-09-15 17:24:49 +0530 | [diff] [blame] | 182 | if (frame->length) { |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 183 | bts_do_rate_ctr_add(bts, CTR_RLC_UL_PAYLOAD_BYTES, frame->length); |
Alexander Couzens | 7fdbf89 | 2016-05-21 19:45:23 +0200 | [diff] [blame] | 184 | |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 185 | LOGPTBFUL(this, LOGL_DEBUG, "Frame %d " |
Aravind Sirsikar | 22a9019 | 2016-09-15 17:24:49 +0530 | [diff] [blame] | 186 | "starts at offset %d, " |
| 187 | "length=%d, is_complete=%d\n", |
| 188 | i + 1, frame->offset, frame->length, |
| 189 | frame->is_complete); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 190 | |
Pau Espin Pedrol | 4f8384b | 2022-03-31 19:36:12 +0200 | [diff] [blame] | 191 | llc_append_frame(&m_llc, data + frame->offset, frame->length); |
Pau Espin Pedrol | da971ee | 2020-12-16 15:59:45 +0100 | [diff] [blame] | 192 | llc_consume(&m_llc, frame->length); |
Aravind Sirsikar | 22a9019 | 2016-09-15 17:24:49 +0530 | [diff] [blame] | 193 | } |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 194 | |
| 195 | if (frame->is_complete) { |
| 196 | /* send frame to SGSN */ |
Pau Espin Pedrol | da971ee | 2020-12-16 15:59:45 +0100 | [diff] [blame] | 197 | LOGPTBFUL(this, LOGL_DEBUG, "complete UL frame len=%d\n", llc_frame_length(&m_llc)); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 198 | snd_ul_ud(); |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 199 | bts_do_rate_ctr_add(bts, CTR_LLC_UL_BYTES, llc_frame_length(&m_llc)); |
Pau Espin Pedrol | 4f8384b | 2022-03-31 19:36:12 +0200 | [diff] [blame] | 200 | llc_reset(&m_llc); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 201 | } |
| 202 | } |
| 203 | |
| 204 | return 0; |
| 205 | } |
| 206 | |
Pau Espin Pedrol | f38a47e | 2022-10-28 19:06:45 +0200 | [diff] [blame] | 207 | /* 3GPP TS 44.060 sec 7a.2.1 Contention Resolution */ |
Pau Espin Pedrol | 4b6f0bf | 2021-05-10 18:54:52 +0200 | [diff] [blame] | 208 | void gprs_rlcmac_ul_tbf::contention_resolution_start() |
| 209 | { |
| 210 | /* 3GPP TS 44.018 sec 11.1.2 Timers on the network side: "This timer is |
| 211 | * started when a temporary block flow is allocated with an IMMEDIATE |
| 212 | * ASSIGNMENT or an IMMEDIATE PACKET ASSIGNMENT or an EC IMMEDIATE |
| 213 | * ASSIGNMENT TYPE 1 message during a packet access procedure. It is |
| 214 | * stopped when the mobile station has correctly seized the temporary |
| 215 | * block flow." |
| 216 | * In our code base, it means we want to do contention resolution |
| 217 | * timeout only for one-phase packet access, since two-phase is handled |
| 218 | * through SBA structs, which are freed by the PDCH UL Controller if the |
| 219 | * single allocated block is lost. */ |
Pau Espin Pedrol | 9438613 | 2022-10-28 19:50:09 +0200 | [diff] [blame] | 220 | m_contention_resolution_done = false; |
Pau Espin Pedrol | 4b6f0bf | 2021-05-10 18:54:52 +0200 | [diff] [blame] | 221 | T_START(this, T3141, 3141, "Contention resolution (UL-TBF, CCCH)", true); |
| 222 | } |
| 223 | void gprs_rlcmac_ul_tbf::contention_resolution_success() |
| 224 | { |
Pau Espin Pedrol | f38a47e | 2022-10-28 19:06:45 +0200 | [diff] [blame] | 225 | /* now we must set this flag, so we are allowed to assign downlink |
| 226 | * TBF on PACCH. it is only allowed when TLLI is acknowledged |
| 227 | * (3GPP TS 44.060 sec 7.1.3.1). */ |
| 228 | m_contention_resolution_done = true; |
Pau Espin Pedrol | 4b6f0bf | 2021-05-10 18:54:52 +0200 | [diff] [blame] | 229 | |
Pau Espin Pedrol | 4b6f0bf | 2021-05-10 18:54:52 +0200 | [diff] [blame] | 230 | /* 3GPP TS 44.018 3.5.2.1.4 Packet access completion: The one phase |
| 231 | packet access procedure is completed at a successful contention |
| 232 | resolution. The mobile station has entered the packet transfer mode. |
| 233 | Timer T3141 is stopped on the network side */ |
| 234 | t_stop(T3141, "Contention resolution success (UL-TBF, CCCH)"); |
| 235 | |
Pau Espin Pedrol | ba56831 | 2021-11-02 18:47:44 +0100 | [diff] [blame] | 236 | bts_do_rate_ctr_inc(bts, CTR_IMMEDIATE_ASSIGN_UL_TBF_CONTENTION_RESOLUTION_SUCCESS); |
Pau Espin Pedrol | 01dfe04 | 2022-10-31 15:56:55 +0100 | [diff] [blame] | 237 | |
| 238 | /* Check if we can create a DL TBF to start sending the enqueued |
| 239 | * data. Otherwise it will be triggered later when it is reachable |
| 240 | * again. */ |
| 241 | if (ms_need_dl_tbf(ms()) && !tbf_ul_ack_waiting_cnf_final_ack(this)) |
| 242 | ms_new_dl_tbf_assigned_on_pacch(ms(), this); |
Pau Espin Pedrol | 4b6f0bf | 2021-05-10 18:54:52 +0200 | [diff] [blame] | 243 | } |
| 244 | |
Alexander Couzens | 2fcfc29 | 2016-05-24 14:40:03 +0200 | [diff] [blame] | 245 | /*! \brief receive data from PDCH/L1 */ |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 246 | int gprs_rlcmac_ul_tbf::rcv_data_block_acknowledged( |
Jacob Erlbeck | f2ba4cb | 2016-01-07 18:59:28 +0100 | [diff] [blame] | 247 | const struct gprs_rlc_data_info *rlc, |
Jacob Erlbeck | fc1b3e6 | 2016-01-11 09:58:11 +0100 | [diff] [blame] | 248 | uint8_t *data, struct pcu_l1_meas *meas) |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 249 | { |
Pau Espin Pedrol | c33a024 | 2020-05-15 16:57:48 +0200 | [diff] [blame] | 250 | const struct gprs_rlc_data_block_info *rdbi; |
| 251 | struct gprs_rlc_data *block; |
| 252 | |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 253 | int8_t rssi = meas->have_rssi ? meas->rssi : 0; |
| 254 | |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 255 | const uint16_t ws = m_window.ws(); |
| 256 | |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 257 | LOGPTBFUL(this, LOGL_DEBUG, "UL DATA TFI=%d received (V(Q)=%d .. " |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 258 | "V(R)=%d)\n", rlc->tfi, this->m_window.v_q(), |
| 259 | this->m_window.v_r()); |
| 260 | |
| 261 | /* process RSSI */ |
| 262 | gprs_rlcmac_rssi(this, rssi); |
| 263 | |
| 264 | /* store measurement values */ |
Pau Espin Pedrol | f53815f | 2021-05-11 14:23:51 +0200 | [diff] [blame] | 265 | ms_update_l1_meas(ms(), meas); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 266 | |
Vadim Yanitskiy | cb98894 | 2020-11-08 13:27:35 +0700 | [diff] [blame] | 267 | uint32_t new_tlli = GSM_RESERVED_TMSI; |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 268 | unsigned int block_idx; |
| 269 | |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 270 | /* Increment RX-counter */ |
| 271 | this->m_rx_counter++; |
Mrinal Mishra | f86307e | 2016-11-10 18:16:30 +0530 | [diff] [blame] | 272 | update_coding_scheme_counter_ul(rlc->cs); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 273 | /* Loop over num_blocks */ |
| 274 | for (block_idx = 0; block_idx < rlc->num_data_blocks; block_idx++) { |
| 275 | int num_chunks; |
| 276 | uint8_t *rlc_data; |
Pau Espin Pedrol | c33a024 | 2020-05-15 16:57:48 +0200 | [diff] [blame] | 277 | rdbi = &rlc->block_info[block_idx]; |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 278 | |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 279 | LOGPTBFUL(this, LOGL_DEBUG, |
| 280 | "Got %s RLC data block: CV=%d, BSN=%d, SPB=%d, PI=%d, E=%d, TI=%d, bitoffs=%d\n", |
Max | 136ebcc | 2019-03-05 14:59:03 +0100 | [diff] [blame] | 281 | mcs_name(rlc->cs), |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 282 | rdbi->cv, rdbi->bsn, rdbi->spb, |
| 283 | rdbi->pi, rdbi->e, rdbi->ti, |
| 284 | rlc->data_offs_bits[block_idx]); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 285 | |
| 286 | /* Check whether the block needs to be decoded */ |
| 287 | |
| 288 | if (!m_window.is_in_window(rdbi->bsn)) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 289 | LOGPTBFUL(this, LOGL_DEBUG, "BSN %d out of window %d..%d (it's normal)\n", |
| 290 | rdbi->bsn, |
| 291 | m_window.v_q(), m_window.mod_sns(m_window.v_q() + ws - 1)); |
Pau Espin Pedrol | 5891631 | 2021-05-11 14:40:41 +0200 | [diff] [blame] | 292 | continue; |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 293 | } else if (m_window.is_received(rdbi->bsn)) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 294 | LOGPTBFUL(this, LOGL_DEBUG, |
| 295 | "BSN %d already received\n", rdbi->bsn); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 296 | continue; |
Pau Espin Pedrol | 5891631 | 2021-05-11 14:40:41 +0200 | [diff] [blame] | 297 | } |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 298 | |
| 299 | /* Store block and meta info to BSN buffer */ |
| 300 | |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 301 | LOGPTBFUL(this, LOGL_DEBUG, "BSN %d storing in window (%d..%d)\n", |
| 302 | rdbi->bsn, m_window.v_q(), |
| 303 | m_window.mod_sns(m_window.v_q() + ws - 1)); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 304 | block = m_rlc.block(rdbi->bsn); |
Aravind Sirsikar | 550a541 | 2016-06-14 18:59:18 +0530 | [diff] [blame] | 305 | OSMO_ASSERT(rdbi->data_len <= sizeof(block->block)); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 306 | rlc_data = &(block->block[0]); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 307 | |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 308 | if (rdbi->spb) { |
| 309 | egprs_rlc_ul_reseg_bsn_state assemble_status; |
| 310 | |
| 311 | assemble_status = handle_egprs_ul_spb(rlc, |
| 312 | block, data, block_idx); |
| 313 | |
| 314 | if (assemble_status != EGPRS_RESEG_DEFAULT) |
| 315 | return 0; |
| 316 | } else { |
| 317 | block->block_info = *rdbi; |
| 318 | block->cs_last = rlc->cs; |
| 319 | block->len = |
| 320 | Decoding::rlc_copy_to_aligned_buffer(rlc, |
| 321 | block_idx, data, rlc_data); |
| 322 | } |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 323 | |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 324 | LOGPTBFUL(this, LOGL_DEBUG, |
| 325 | "data_length=%d, data=%s\n", |
| 326 | block->len, osmo_hexdump(rlc_data, block->len)); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 327 | /* Get/Handle TLLI */ |
| 328 | if (rdbi->ti) { |
| 329 | num_chunks = Decoding::rlc_data_from_ul_data( |
| 330 | rdbi, rlc->cs, rlc_data, NULL, 0, &new_tlli); |
| 331 | |
| 332 | if (num_chunks < 0) { |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 333 | bts_do_rate_ctr_inc(bts, CTR_DECODE_ERRORS); |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 334 | LOGPTBFUL(this, LOGL_NOTICE, |
| 335 | "Failed to decode TLLI of %s UL DATA TFI=%d.\n", |
Max | 136ebcc | 2019-03-05 14:59:03 +0100 | [diff] [blame] | 336 | mcs_name(rlc->cs), rlc->tfi); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 337 | m_window.invalidate_bsn(rdbi->bsn); |
| 338 | continue; |
| 339 | } |
| 340 | if (!this->is_tlli_valid()) { |
Vadim Yanitskiy | cb98894 | 2020-11-08 13:27:35 +0700 | [diff] [blame] | 341 | if (new_tlli == GSM_RESERVED_TMSI) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 342 | LOGPTBFUL(this, LOGL_NOTICE, |
Vadim Yanitskiy | cb98894 | 2020-11-08 13:27:35 +0700 | [diff] [blame] | 343 | "TLLI is 0x%08x within UL DATA?!?\n", |
| 344 | new_tlli); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 345 | m_window.invalidate_bsn(rdbi->bsn); |
| 346 | continue; |
| 347 | } |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 348 | LOGPTBFUL(this, LOGL_INFO, |
| 349 | "Decoded premier TLLI=0x%08x of UL DATA TFI=%d.\n", |
Vadim Yanitskiy | 3f27fb5 | 2020-04-20 11:26:12 +0700 | [diff] [blame] | 350 | new_tlli, rlc->tfi); |
Pau Espin Pedrol | 8abe13c | 2022-10-21 18:49:48 +0200 | [diff] [blame] | 351 | ms_update_announced_tlli(ms(), new_tlli); |
Pau Espin Pedrol | f197f15 | 2022-11-17 20:18:46 +0100 | [diff] [blame] | 352 | osmo_fsm_inst_dispatch(this->state_fi, TBF_EV_FIRST_UL_DATA_RECVD, NULL); |
Vadim Yanitskiy | cb98894 | 2020-11-08 13:27:35 +0700 | [diff] [blame] | 353 | } else if (new_tlli != GSM_RESERVED_TMSI && new_tlli != tlli()) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 354 | LOGPTBFUL(this, LOGL_NOTICE, |
Pau Espin Pedrol | 305763d | 2020-11-06 20:03:24 +0100 | [diff] [blame] | 355 | "Decoded TLLI=%08x mismatch on UL DATA TFI=%d. (Ignoring due to contention resolution)\n", |
| 356 | new_tlli, rlc->tfi); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 357 | m_window.invalidate_bsn(rdbi->bsn); |
| 358 | continue; |
| 359 | } |
Pau Espin Pedrol | 5891631 | 2021-05-11 14:40:41 +0200 | [diff] [blame] | 360 | } else if (!is_tlli_valid()) { |
| 361 | LOGPTBFUL(this, LOGL_NOTICE, "Missing TLLI within UL DATA.\n"); |
| 362 | m_window.invalidate_bsn(rdbi->bsn); |
| 363 | continue; |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 364 | } |
| 365 | |
| 366 | m_window.receive_bsn(rdbi->bsn); |
| 367 | } |
| 368 | |
| 369 | /* Raise V(Q) if possible, and retrieve LLC frames from blocks. |
| 370 | * This is looped until there is a gap (non received block) or |
| 371 | * the window is empty.*/ |
| 372 | const uint16_t v_q_beg = m_window.v_q(); |
| 373 | const uint16_t count = m_window.raise_v_q(); |
| 374 | |
| 375 | /* Retrieve LLC frames from blocks that are ready */ |
| 376 | for (uint16_t i = 0; i < count; ++i) { |
Jacob Erlbeck | 93c55d0 | 2015-12-23 16:29:07 +0100 | [diff] [blame] | 377 | uint16_t index = m_window.mod_sns(v_q_beg + i); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 378 | assemble_forward_llc(m_rlc.block(index)); |
| 379 | } |
| 380 | |
Pau Espin Pedrol | c33a024 | 2020-05-15 16:57:48 +0200 | [diff] [blame] | 381 | /* Last frame in buffer: */ |
| 382 | block = m_rlc.block(m_window.mod_sns(m_window.v_r() - 1)); |
| 383 | rdbi = &block->block_info; |
| 384 | |
| 385 | /* Check if we already received all data TBF had to send: */ |
Pau Espin Pedrol | dc2aaac | 2021-05-14 12:50:46 +0200 | [diff] [blame] | 386 | if (this->state_is(TBF_ST_FLOW) /* still in flow state */ |
Pau Espin Pedrol | 9b63cd0 | 2021-05-11 14:54:40 +0200 | [diff] [blame] | 387 | && this->m_window.v_q() == this->m_window.v_r() /* if complete */ |
| 388 | && block->len) { /* if there was ever a last block received */ |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 389 | LOGPTBFUL(this, LOGL_DEBUG, |
| 390 | "No gaps in received block, last block: BSN=%d CV=%d\n", |
| 391 | rdbi->bsn, rdbi->cv); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 392 | if (rdbi->cv == 0) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 393 | LOGPTBFUL(this, LOGL_DEBUG, "Finished with UL TBF\n"); |
Pau Espin Pedrol | f197f15 | 2022-11-17 20:18:46 +0100 | [diff] [blame] | 394 | osmo_fsm_inst_dispatch(this->state_fi, TBF_EV_LAST_UL_DATA_RECVD, NULL); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 395 | /* Reset N3103 counter. */ |
Max | 847ed9f | 2018-02-20 18:16:11 +0100 | [diff] [blame] | 396 | this->n_reset(N3103); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 397 | } |
| 398 | } |
| 399 | |
| 400 | /* If TLLI is included or if we received half of the window, we send |
| 401 | * an ack/nack */ |
Pau Espin Pedrol | 9b63cd0 | 2021-05-11 14:54:40 +0200 | [diff] [blame] | 402 | maybe_schedule_uplink_acknack(rlc, block->len && rdbi->cv == 0); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 403 | |
| 404 | return 0; |
| 405 | } |
| 406 | |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 407 | void gprs_rlcmac_ul_tbf::maybe_schedule_uplink_acknack( |
Pau Espin Pedrol | c33a024 | 2020-05-15 16:57:48 +0200 | [diff] [blame] | 408 | const gprs_rlc_data_info *rlc, bool countdown_finished) |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 409 | { |
Pau Espin Pedrol | 09afd6f | 2020-05-15 16:40:18 +0200 | [diff] [blame] | 410 | bool require_ack = false; |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 411 | bool have_ti = rlc->block_info[0].ti || |
| 412 | (rlc->num_data_blocks > 1 && rlc->block_info[1].ti); |
| 413 | |
Pau Espin Pedrol | 09afd6f | 2020-05-15 16:40:18 +0200 | [diff] [blame] | 414 | if (rlc->si) { |
| 415 | require_ack = true; |
| 416 | LOGPTBFUL(this, LOGL_NOTICE, |
| 417 | "Scheduling Ack/Nack, because MS is stalled.\n"); |
| 418 | } |
| 419 | if (have_ti) { |
| 420 | require_ack = true; |
| 421 | LOGPTBFUL(this, LOGL_DEBUG, |
| 422 | "Scheduling Ack/Nack, because TLLI is included.\n"); |
| 423 | } |
Pau Espin Pedrol | c33a024 | 2020-05-15 16:57:48 +0200 | [diff] [blame] | 424 | if (countdown_finished) { |
Pau Espin Pedrol | 09afd6f | 2020-05-15 16:40:18 +0200 | [diff] [blame] | 425 | require_ack = true; |
Pau Espin Pedrol | dc2aaac | 2021-05-14 12:50:46 +0200 | [diff] [blame] | 426 | if (state_is(TBF_ST_FLOW)) |
Pau Espin Pedrol | c33a024 | 2020-05-15 16:57:48 +0200 | [diff] [blame] | 427 | LOGPTBFUL(this, LOGL_DEBUG, |
| 428 | "Scheduling Ack/Nack, because some data is missing and last block has CV==0.\n"); |
Pau Espin Pedrol | dc2aaac | 2021-05-14 12:50:46 +0200 | [diff] [blame] | 429 | else if (state_is(TBF_ST_FINISHED)) |
Pau Espin Pedrol | c33a024 | 2020-05-15 16:57:48 +0200 | [diff] [blame] | 430 | LOGPTBFUL(this, LOGL_DEBUG, |
| 431 | "Scheduling final Ack/Nack, because all data was received and last block has CV==0.\n"); |
Pau Espin Pedrol | 09afd6f | 2020-05-15 16:40:18 +0200 | [diff] [blame] | 432 | } |
| 433 | if ((m_rx_counter % SEND_ACK_AFTER_FRAMES) == 0) { |
| 434 | require_ack = true; |
| 435 | LOGPTBFUL(this, LOGL_DEBUG, |
| 436 | "Scheduling Ack/Nack, because %d frames received.\n", |
| 437 | SEND_ACK_AFTER_FRAMES); |
| 438 | } |
| 439 | |
| 440 | if (!require_ack) |
| 441 | return; |
| 442 | |
Pau Espin Pedrol | ea8dbdd | 2021-07-29 18:39:16 +0200 | [diff] [blame] | 443 | osmo_fsm_inst_dispatch(this->ul_ack_fsm.fi, TBF_UL_ACK_EV_SCHED_ACK, NULL); |
Jacob Erlbeck | b3100e1 | 2015-12-14 13:36:13 +0100 | [diff] [blame] | 444 | } |
| 445 | |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 446 | /* Send Uplink unit-data to SGSN. */ |
| 447 | int gprs_rlcmac_ul_tbf::snd_ul_ud() |
| 448 | { |
| 449 | uint8_t qos_profile[3]; |
| 450 | struct msgb *llc_pdu; |
Pau Espin Pedrol | da971ee | 2020-12-16 15:59:45 +0100 | [diff] [blame] | 451 | unsigned msg_len = NS_HDR_LEN + BSSGP_HDR_LEN + llc_frame_length(&m_llc); |
Pau Espin Pedrol | db5e339 | 2021-01-21 18:02:40 +0100 | [diff] [blame] | 452 | struct bssgp_bvc_ctx *bctx = bts->pcu->bssgp.bctx; |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 453 | |
Pau Espin Pedrol | da971ee | 2020-12-16 15:59:45 +0100 | [diff] [blame] | 454 | LOGP(DBSSGP, LOGL_INFO, "LLC [PCU -> SGSN] %s len=%d\n", tbf_name(this), llc_frame_length(&m_llc)); |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 455 | if (!bctx) { |
| 456 | LOGP(DBSSGP, LOGL_ERROR, "No bctx\n"); |
Pau Espin Pedrol | 4f8384b | 2022-03-31 19:36:12 +0200 | [diff] [blame] | 457 | llc_reset_frame_space(&m_llc); |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 458 | return -EIO; |
| 459 | } |
Pau Espin Pedrol | 488aa29 | 2019-09-25 17:48:35 +0200 | [diff] [blame] | 460 | |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 461 | llc_pdu = msgb_alloc_headroom(msg_len, msg_len,"llc_pdu"); |
Pau Espin Pedrol | da971ee | 2020-12-16 15:59:45 +0100 | [diff] [blame] | 462 | uint8_t *buf = msgb_push(llc_pdu, TL16V_GROSS_LEN(sizeof(uint8_t)*llc_frame_length(&m_llc))); |
| 463 | tl16v_put(buf, BSSGP_IE_LLC_PDU, sizeof(uint8_t)*llc_frame_length(&m_llc), m_llc.frame); |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 464 | qos_profile[0] = QOS_PROFILE >> 16; |
| 465 | qos_profile[1] = QOS_PROFILE >> 8; |
| 466 | qos_profile[2] = QOS_PROFILE; |
| 467 | bssgp_tx_ul_ud(bctx, tlli(), qos_profile, llc_pdu); |
| 468 | |
Pau Espin Pedrol | 4f8384b | 2022-03-31 19:36:12 +0200 | [diff] [blame] | 469 | llc_reset_frame_space(&m_llc); |
Daniel Willmann | ca102af | 2014-08-08 12:14:12 +0200 | [diff] [blame] | 470 | return 0; |
| 471 | } |
| 472 | |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 473 | egprs_rlc_ul_reseg_bsn_state gprs_rlcmac_ul_tbf::handle_egprs_ul_second_seg( |
| 474 | const struct gprs_rlc_data_info *rlc, struct gprs_rlc_data *block, |
| 475 | uint8_t *data, const uint8_t block_idx) |
| 476 | { |
| 477 | const gprs_rlc_data_block_info *rdbi = &rlc->block_info[block_idx]; |
| 478 | union split_block_status *spb_status = &block->spb_status; |
| 479 | uint8_t *rlc_data = &block->block[0]; |
| 480 | |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 481 | bts_do_rate_ctr_inc(bts, CTR_SPB_UL_SECOND_SEGMENT); |
sivasankari | da7250a | 2016-12-16 12:57:18 +0530 | [diff] [blame] | 482 | |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 483 | if (spb_status->block_status_ul & |
| 484 | EGPRS_RESEG_FIRST_SEG_RXD) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 485 | LOGPTBFUL(this, LOGL_DEBUG, |
| 486 | "Second seg is received first seg is already present set the status to complete\n"); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 487 | spb_status->block_status_ul = EGPRS_RESEG_DEFAULT; |
| 488 | |
| 489 | block->len += Decoding::rlc_copy_to_aligned_buffer(rlc, |
| 490 | block_idx, data, rlc_data + block->len); |
| 491 | block->block_info.data_len += rdbi->data_len; |
| 492 | } else if (spb_status->block_status_ul == EGPRS_RESEG_DEFAULT) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 493 | LOGPTBFUL(this, LOGL_DEBUG, |
| 494 | "Second seg is received first seg is not received set the status to second seg received\n"); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 495 | |
| 496 | block->len = Decoding::rlc_copy_to_aligned_buffer(rlc, |
| 497 | block_idx, data, |
| 498 | rlc_data + rlc->block_info[block_idx].data_len); |
| 499 | |
| 500 | spb_status->block_status_ul = EGPRS_RESEG_SECOND_SEG_RXD; |
| 501 | block->block_info = *rdbi; |
| 502 | } |
| 503 | return spb_status->block_status_ul; |
| 504 | } |
| 505 | |
| 506 | egprs_rlc_ul_reseg_bsn_state gprs_rlcmac_ul_tbf::handle_egprs_ul_first_seg( |
| 507 | const struct gprs_rlc_data_info *rlc, struct gprs_rlc_data *block, |
| 508 | uint8_t *data, const uint8_t block_idx) |
| 509 | { |
| 510 | const gprs_rlc_data_block_info *rdbi = &rlc->block_info[block_idx]; |
| 511 | uint8_t *rlc_data = &block->block[0]; |
| 512 | union split_block_status *spb_status = &block->spb_status; |
| 513 | |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 514 | bts_do_rate_ctr_inc(bts, CTR_SPB_UL_FIRST_SEGMENT); |
sivasankari | da7250a | 2016-12-16 12:57:18 +0530 | [diff] [blame] | 515 | |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 516 | if (spb_status->block_status_ul & EGPRS_RESEG_SECOND_SEG_RXD) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 517 | LOGPTBFUL(this, LOGL_DEBUG, |
| 518 | "First seg is received second seg is already present set the status to complete\n"); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 519 | |
| 520 | block->len += Decoding::rlc_copy_to_aligned_buffer(rlc, |
| 521 | block_idx, data, rlc_data); |
| 522 | |
| 523 | block->block_info.data_len = block->len; |
| 524 | spb_status->block_status_ul = EGPRS_RESEG_DEFAULT; |
| 525 | } else if (spb_status->block_status_ul == EGPRS_RESEG_DEFAULT) { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 526 | LOGPTBFUL(this, LOGL_DEBUG, |
| 527 | "First seg is received second seg is not received set the status to first seg received\n"); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 528 | |
| 529 | spb_status->block_status_ul = EGPRS_RESEG_FIRST_SEG_RXD; |
| 530 | block->len = Decoding::rlc_copy_to_aligned_buffer(rlc, |
| 531 | block_idx, data, rlc_data); |
| 532 | block->block_info = *rdbi; |
| 533 | } |
| 534 | return spb_status->block_status_ul; |
| 535 | } |
| 536 | |
| 537 | egprs_rlc_ul_reseg_bsn_state gprs_rlcmac_ul_tbf::handle_egprs_ul_spb( |
| 538 | const struct gprs_rlc_data_info *rlc, struct gprs_rlc_data *block, |
| 539 | uint8_t *data, const uint8_t block_idx) |
| 540 | { |
| 541 | const gprs_rlc_data_block_info *rdbi = &rlc->block_info[block_idx]; |
| 542 | |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 543 | LOGPTBFUL(this, LOGL_DEBUG, |
| 544 | "Got SPB(%d) cs(%s) data block with BSN (%d), TFI(%d).\n", |
Max | 136ebcc | 2019-03-05 14:59:03 +0100 | [diff] [blame] | 545 | rdbi->spb, mcs_name(rlc->cs), rdbi->bsn, rlc->tfi); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 546 | |
| 547 | egprs_rlc_ul_reseg_bsn_state assemble_status = EGPRS_RESEG_INVALID; |
| 548 | |
| 549 | /* Section 10.4.8b of 44.060*/ |
| 550 | if (rdbi->spb == 2) |
| 551 | assemble_status = handle_egprs_ul_first_seg(rlc, |
| 552 | block, data, block_idx); |
| 553 | else if (rdbi->spb == 3) |
| 554 | assemble_status = handle_egprs_ul_second_seg(rlc, |
| 555 | block, data, block_idx); |
| 556 | else { |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 557 | LOGPTBFUL(this, LOGL_ERROR, |
| 558 | "spb(%d) Not supported SPB for this EGPRS configuration\n", |
| 559 | rdbi->spb); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 560 | } |
| 561 | |
| 562 | /* |
| 563 | * When the block is successfully constructed out of segmented blocks |
| 564 | * upgrade the MCS to the type 2 |
| 565 | */ |
| 566 | if (assemble_status == EGPRS_RESEG_DEFAULT) { |
Pau Espin Pedrol | 2ae8337 | 2020-05-18 11:35:35 +0200 | [diff] [blame] | 567 | switch (rlc->cs) { |
Max | bea2edb | 2019-03-06 17:04:59 +0100 | [diff] [blame] | 568 | case MCS3 : |
| 569 | block->cs_last = MCS6; |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 570 | LOGPTBFUL(this, LOGL_DEBUG, "Upgrading to MCS6\n"); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 571 | break; |
Max | bea2edb | 2019-03-06 17:04:59 +0100 | [diff] [blame] | 572 | case MCS2 : |
| 573 | block->cs_last = MCS5; |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 574 | LOGPTBFUL(this, LOGL_DEBUG, "Upgrading to MCS5\n"); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 575 | break; |
Max | bea2edb | 2019-03-06 17:04:59 +0100 | [diff] [blame] | 576 | case MCS1 : |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 577 | LOGPTBFUL(this, LOGL_DEBUG, "Upgrading to MCS4\n"); |
Max | bea2edb | 2019-03-06 17:04:59 +0100 | [diff] [blame] | 578 | block->cs_last = MCS4; |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 579 | break; |
| 580 | default: |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 581 | LOGPTBFUL(this, LOGL_ERROR, |
| 582 | "cs(%s) Error in Upgrading to higher MCS\n", |
Max | 136ebcc | 2019-03-05 14:59:03 +0100 | [diff] [blame] | 583 | mcs_name(rlc->cs)); |
Aravind Sirsikar | 505a86d | 2016-07-26 18:26:21 +0530 | [diff] [blame] | 584 | break; |
| 585 | } |
| 586 | } |
| 587 | return assemble_status; |
| 588 | } |
Mrinal Mishra | f86307e | 2016-11-10 18:16:30 +0530 | [diff] [blame] | 589 | |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 590 | void gprs_rlcmac_ul_tbf::update_coding_scheme_counter_ul(enum CodingScheme cs) |
Mrinal Mishra | f86307e | 2016-11-10 18:16:30 +0530 | [diff] [blame] | 591 | { |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 592 | switch (cs) { |
| 593 | case CS1: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 594 | bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS1); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 595 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS1)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 596 | break; |
| 597 | case CS2: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 598 | bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS2); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 599 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS2)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 600 | break; |
| 601 | case CS3: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 602 | bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS3); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 603 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS3)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 604 | break; |
| 605 | case CS4: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 606 | bts_do_rate_ctr_inc(bts, CTR_GPRS_UL_CS4); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 607 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_gprs_ctrs, TBF_CTR_GPRS_UL_CS4)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 608 | break; |
| 609 | case MCS1: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 610 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS1); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 611 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS1)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 612 | break; |
| 613 | case MCS2: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 614 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS2); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 615 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS2)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 616 | break; |
| 617 | case MCS3: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 618 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS3); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 619 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS3)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 620 | break; |
| 621 | case MCS4: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 622 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS4); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 623 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS4)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 624 | break; |
| 625 | case MCS5: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 626 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS5); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 627 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS5)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 628 | break; |
| 629 | case MCS6: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 630 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS6); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 631 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS6)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 632 | break; |
| 633 | case MCS7: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 634 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS7); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 635 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS7)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 636 | break; |
| 637 | case MCS8: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 638 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS8); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 639 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS8)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 640 | break; |
| 641 | case MCS9: |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 642 | bts_do_rate_ctr_inc(bts, CTR_EGPRS_UL_MCS9); |
Pau Espin Pedrol | 9c1db17 | 2021-06-04 17:05:51 +0200 | [diff] [blame] | 643 | rate_ctr_inc(rate_ctr_group_get_ctr(m_ul_egprs_ctrs, TBF_CTR_EGPRS_UL_MCS9)); |
Max | fb59a93 | 2019-03-13 18:40:19 +0100 | [diff] [blame] | 644 | break; |
| 645 | default: |
| 646 | LOGPTBFUL(this, LOGL_ERROR, "attempting to update rate counters for unsupported (M)CS %s\n", |
| 647 | mcs_name(cs)); |
Mrinal Mishra | f86307e | 2016-11-10 18:16:30 +0530 | [diff] [blame] | 648 | } |
| 649 | } |
sivasankari | 8adfcd0 | 2017-01-16 15:41:21 +0530 | [diff] [blame] | 650 | |
Max | 9d7357e | 2017-12-14 15:02:33 +0100 | [diff] [blame] | 651 | void gprs_rlcmac_ul_tbf::set_window_size() |
sivasankari | 8adfcd0 | 2017-01-16 15:41:21 +0530 | [diff] [blame] | 652 | { |
Pau Espin Pedrol | 2182e62 | 2021-01-14 16:48:38 +0100 | [diff] [blame] | 653 | const struct gprs_rlcmac_bts *b = bts; |
Max | 34513fe | 2018-12-11 16:47:30 +0100 | [diff] [blame] | 654 | uint16_t ws = egprs_window_size(b, ul_slots()); |
Max | 0524e38 | 2018-01-19 18:22:25 +0100 | [diff] [blame] | 655 | LOGPTBFUL(this, LOGL_INFO, "setting EGPRS UL window size to %u, base(%u) slots(%u) ws_pdch(%u)\n", |
Pau Espin Pedrol | 519d071 | 2021-01-14 14:30:03 +0100 | [diff] [blame] | 656 | ws, bts->pcu->vty.ws_base, pcu_bitcount(ul_slots()), bts->pcu->vty.ws_pdch); |
sivasankari | 8adfcd0 | 2017-01-16 15:41:21 +0530 | [diff] [blame] | 657 | m_window.set_ws(ws); |
| 658 | } |
Pau Espin Pedrol | 9767e44 | 2020-10-23 21:11:41 +0200 | [diff] [blame] | 659 | |
Pau Espin Pedrol | b3f2397 | 2020-10-23 21:00:23 +0200 | [diff] [blame] | 660 | gprs_rlc_window *gprs_rlcmac_ul_tbf::window() |
Pau Espin Pedrol | 9767e44 | 2020-10-23 21:11:41 +0200 | [diff] [blame] | 661 | { |
| 662 | return &m_window; |
| 663 | } |
Pau Espin Pedrol | da971ee | 2020-12-16 15:59:45 +0100 | [diff] [blame] | 664 | |
Pau Espin Pedrol | d6c555e | 2023-04-20 20:10:53 +0200 | [diff] [blame] | 665 | void gprs_rlcmac_ul_tbf::apply_allocated_resources(const struct alloc_resources_res *res) |
| 666 | { |
| 667 | uint8_t ts; |
| 668 | |
Pau Espin Pedrol | 4d36391 | 2023-04-21 19:32:16 +0200 | [diff] [blame] | 669 | if (this->trx) |
| 670 | llist_del(&this->m_trx_list.list); |
| 671 | |
| 672 | llist_add(&this->m_trx_list.list, &res->trx->ul_tbfs); |
| 673 | |
Pau Espin Pedrol | d6c555e | 2023-04-20 20:10:53 +0200 | [diff] [blame] | 674 | this->trx = res->trx; |
| 675 | this->upgrade_to_multislot = res->upgrade_to_multislot; |
| 676 | |
| 677 | for (ts = 0; ts < ARRAY_SIZE(trx->pdch); ts++) { |
| 678 | struct gprs_rlcmac_pdch *pdch = &trx->pdch[ts]; |
| 679 | OSMO_ASSERT(!this->pdch[pdch->ts_no]); |
| 680 | if (!(res->ass_slots_mask & (1 << ts))) |
| 681 | continue; |
| 682 | LOGPTBFUL(this, LOGL_DEBUG, "Assigning TS=%u TFI=%d USF=%u\n", |
| 683 | ts, res->tfi, res->usf[ts]); |
| 684 | OSMO_ASSERT(res->usf[ts] >= 0); |
| 685 | |
| 686 | this->m_tfi = res->tfi; |
| 687 | this->m_usf[pdch->ts_no] = res->usf[ts]; |
| 688 | |
| 689 | this->pdch[pdch->ts_no] = pdch; |
| 690 | pdch->attach_tbf(this); |
| 691 | } |
Pau Espin Pedrol | 4d36391 | 2023-04-21 19:32:16 +0200 | [diff] [blame] | 692 | |
| 693 | /* assign initial control ts */ |
| 694 | tbf_assign_control_ts(this); |
| 695 | |
| 696 | /* res.ass_slots_mask == 0 -> special case for Rejected UL TBFs, |
| 697 | * see ms_new_ul_tbf_rejected_pacch() */ |
| 698 | if (res->ass_slots_mask != 0) { |
| 699 | LOGPTBF(this, LOGL_INFO, |
| 700 | "Allocated: trx = %d, ul_slots = %02x, dl_slots = %02x\n", |
| 701 | this->trx->trx_no, ul_slots(), dl_slots()); |
| 702 | |
| 703 | if (tbf_is_egprs_enabled(this)) |
| 704 | this->set_window_size(); |
| 705 | } |
| 706 | |
| 707 | tbf_update_state_fsm_name(this); |
| 708 | } |
| 709 | |
| 710 | void ul_tbf_apply_allocated_resources(struct gprs_rlcmac_ul_tbf *ul_tbf, const struct alloc_resources_res *res) |
| 711 | { |
| 712 | ul_tbf->apply_allocated_resources(res); |
Pau Espin Pedrol | d6c555e | 2023-04-20 20:10:53 +0200 | [diff] [blame] | 713 | } |
| 714 | |
Pau Espin Pedrol | 0b998b1 | 2021-03-24 14:45:43 +0100 | [diff] [blame] | 715 | void gprs_rlcmac_ul_tbf::usf_timeout() |
| 716 | { |
Pau Espin Pedrol | cfb61d9 | 2021-07-26 17:17:02 +0200 | [diff] [blame] | 717 | if (n_inc(N3101)) |
Pau Espin Pedrol | f197f15 | 2022-11-17 20:18:46 +0100 | [diff] [blame] | 718 | osmo_fsm_inst_dispatch(this->state_fi, TBF_EV_MAX_N3101, NULL); |
Pau Espin Pedrol | 0b998b1 | 2021-03-24 14:45:43 +0100 | [diff] [blame] | 719 | } |
| 720 | |
Pau Espin Pedrol | cc30b05 | 2022-10-27 15:25:55 +0200 | [diff] [blame] | 721 | struct gprs_rlcmac_ul_tbf *tbf_as_ul_tbf(struct gprs_rlcmac_tbf *tbf) |
Pau Espin Pedrol | da971ee | 2020-12-16 15:59:45 +0100 | [diff] [blame] | 722 | { |
| 723 | if (tbf && tbf->direction == GPRS_RLCMAC_UL_TBF) |
| 724 | return static_cast<gprs_rlcmac_ul_tbf *>(tbf); |
| 725 | else |
| 726 | return NULL; |
| 727 | } |
Pau Espin Pedrol | 0b998b1 | 2021-03-24 14:45:43 +0100 | [diff] [blame] | 728 | |
Pau Espin Pedrol | 1e1275f | 2022-11-17 20:57:34 +0100 | [diff] [blame] | 729 | const struct gprs_rlcmac_ul_tbf *tbf_as_ul_tbf_const(const struct gprs_rlcmac_tbf *tbf) |
| 730 | { |
| 731 | if (tbf && tbf->direction == GPRS_RLCMAC_UL_TBF) |
| 732 | return static_cast<const gprs_rlcmac_ul_tbf *>(tbf); |
| 733 | else |
| 734 | return NULL; |
| 735 | } |
| 736 | |
Pau Espin Pedrol | 0b998b1 | 2021-03-24 14:45:43 +0100 | [diff] [blame] | 737 | void tbf_usf_timeout(struct gprs_rlcmac_ul_tbf *tbf) |
| 738 | { |
| 739 | tbf->usf_timeout(); |
| 740 | } |
Pau Espin Pedrol | 49a2f40 | 2021-07-27 17:33:07 +0200 | [diff] [blame] | 741 | |
| 742 | |
| 743 | bool ul_tbf_contention_resolution_done(const struct gprs_rlcmac_ul_tbf *tbf) |
| 744 | { |
| 745 | return tbf->m_contention_resolution_done; |
| 746 | } |
Pau Espin Pedrol | ea8dbdd | 2021-07-29 18:39:16 +0200 | [diff] [blame] | 747 | |
| 748 | struct osmo_fsm_inst *tbf_ul_ack_fi(const struct gprs_rlcmac_ul_tbf *tbf) |
| 749 | { |
| 750 | return tbf->ul_ack_fsm.fi; |
| 751 | } |
| 752 | |
Pau Espin Pedrol | 9438613 | 2022-10-28 19:50:09 +0200 | [diff] [blame] | 753 | void ul_tbf_contention_resolution_start(struct gprs_rlcmac_ul_tbf *tbf) |
| 754 | { |
| 755 | tbf->contention_resolution_start(); |
| 756 | } |
| 757 | |
Pau Espin Pedrol | ea8dbdd | 2021-07-29 18:39:16 +0200 | [diff] [blame] | 758 | void ul_tbf_contention_resolution_success(struct gprs_rlcmac_ul_tbf *tbf) |
| 759 | { |
| 760 | return tbf->contention_resolution_success(); |
| 761 | } |