blob: a2cc52c2890c7cc0b9219b395487725c4e7440a4 [file] [log] [blame]
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001/*
2 * Copyright (C) 2013 by Holger Hans Peter Freyther
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version 2
7 * of the License, or (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
17 */
18
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +010019#include "bts.h"
20#include "gprs_debug.h"
Max1187a772018-01-26 13:31:42 +010021#include <rlc.h>
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +010022
Max1187a772018-01-26 13:31:42 +010023#include <stdbool.h>
24#include <string.h>
25#include <sys/types.h>
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010026
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +010027extern "C" {
28#include <osmocom/core/utils.h>
Max1187a772018-01-26 13:31:42 +010029#include <osmocom/core/bitvec.h>
30#include <osmocom/core/logging.h>
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +020031
32#include "coding_scheme.h"
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +010033}
34
35
Pau Espin Pedrol5bb87b82020-05-18 11:02:39 +020036uint8_t *prepare(struct gprs_rlc_data *rlc, size_t block_data_len)
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +010037{
38 /* todo.. only set it once if it turns out to be a bottleneck */
Pau Espin Pedrol5bb87b82020-05-18 11:02:39 +020039 memset(rlc->block, 0x0, sizeof(rlc->block));
40 memset(rlc->block, 0x2b, block_data_len);
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +010041
Aravind Sirsikar7a05b032016-03-23 18:29:45 +053042 /* Initial value of puncturing scheme */
Pau Espin Pedrol5bb87b82020-05-18 11:02:39 +020043 rlc->next_ps = EGPRS_PS_1;
Aravind Sirsikar7a05b032016-03-23 18:29:45 +053044
Pau Espin Pedrol5bb87b82020-05-18 11:02:39 +020045 return rlc->block;
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +010046}
Holger Hans Peter Freyther321f3c32013-11-23 16:06:54 +010047
48void gprs_rlc_v_b::reset()
49{
50 for (size_t i = 0; i < ARRAY_SIZE(m_v_b); ++i)
51 mark_invalid(i);
52}
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +010053
Daniel Willmann7e994e32014-08-07 15:49:21 +020054void gprs_rlc_dl_window::reset()
55{
56 m_v_s = 0;
57 m_v_a = 0;
58 m_v_b.reset();
59}
60
Maxead08aa2017-12-13 18:25:36 +010061int gprs_rlc_dl_window::resend_needed() const
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +010062{
Jacob Erlbeck93c55d02015-12-23 16:29:07 +010063 for (uint16_t bsn = v_a(); bsn != v_s(); bsn = mod_sns(bsn + 1)) {
Daniel Willmann146514e2013-12-28 18:24:42 +010064 if (m_v_b.is_nacked(bsn) || m_v_b.is_resend(bsn))
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +010065 return bsn;
66 }
67
68 return -1;
69}
Holger Hans Peter Freyther8b16ae32013-11-24 00:38:54 +010070
Daniel Willmann146514e2013-12-28 18:24:42 +010071int gprs_rlc_dl_window::mark_for_resend()
Holger Hans Peter Freyther8b16ae32013-11-24 00:38:54 +010072{
73 int resend = 0;
74
Jacob Erlbeck93c55d02015-12-23 16:29:07 +010075 for (uint16_t bsn = v_a(); bsn != v_s(); bsn = mod_sns(bsn + 1)) {
Daniel Willmann146514e2013-12-28 18:24:42 +010076 if (m_v_b.is_unacked(bsn)) {
Holger Hans Peter Freyther8b16ae32013-11-24 00:38:54 +010077 /* mark to be re-send */
Daniel Willmann146514e2013-12-28 18:24:42 +010078 m_v_b.mark_resend(bsn);
Holger Hans Peter Freyther8b16ae32013-11-24 00:38:54 +010079 resend += 1;
80 }
81 }
82
83 return resend;
84}
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +010085
sivasankari8adfcd02017-01-16 15:41:21 +053086/* Update the receive block bitmap */
87uint16_t gprs_rlc_ul_window::update_egprs_rbb(uint8_t *rbb)
88{
Alexander Couzens0d482c52019-06-16 16:24:36 +020089 uint16_t i;
sivasankari8adfcd02017-01-16 15:41:21 +053090 uint16_t bsn;
91 uint16_t bitmask = 0x80;
92 int8_t pos = 0;
93 int8_t bit_pos = 0;
94 for (i = 0, bsn = (v_q()+1); ((bsn < (v_r())) && (i < ws())); i++,
95 bsn = this->mod_sns(bsn + 1)) {
96 if (m_v_n.is_received(bsn)) {
97 rbb[pos] = rbb[pos] | bitmask;
98 } else {
99 rbb[pos] = rbb[pos] & (~bitmask);
100 }
101 bitmask = bitmask >> 1;
102 bit_pos++;
103 bit_pos = bit_pos % 8;
104 if (bit_pos == 0) {
105 pos++;
106 bitmask = 0x80;
107 }
108 }
109 return i;
110}
111
Daniel Willmann146514e2013-12-28 18:24:42 +0100112int gprs_rlc_dl_window::count_unacked()
Holger Hans Peter Freyther9c5539d2013-11-24 17:34:17 +0100113{
114 uint16_t unacked = 0;
115 uint16_t bsn;
116
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100117 for (bsn = v_a(); bsn != v_s(); bsn = mod_sns(bsn + 1)) {
Daniel Willmann146514e2013-12-28 18:24:42 +0100118 if (!m_v_b.is_acked(bsn))
Holger Hans Peter Freyther9c5539d2013-11-24 17:34:17 +0100119 unacked += 1;
120 }
121
122 return unacked;
123}
124
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100125static uint16_t bitnum_to_bsn(int bitnum, uint16_t ssn)
Daniel Willmanncc5a4cb2013-12-11 20:04:29 +0100126{
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100127 return (ssn - 1 - bitnum);
Daniel Willmanncc5a4cb2013-12-11 20:04:29 +0100128}
129
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100130void gprs_rlc_dl_window::update(struct gprs_rlcmac_bts *bts, const struct bitvec *rbb,
Jacob Erlbeckeb08f862016-02-05 17:07:12 +0100131 uint16_t first_bsn, uint16_t *lost,
132 uint16_t *received)
133{
aravind sirsikarfb41afa2016-11-02 15:48:00 +0530134 unsigned dist = distance();
135 unsigned num_blocks = rbb->cur_bit > dist
136 ? dist : rbb->cur_bit;
Jacob Erlbeckeb08f862016-02-05 17:07:12 +0100137 unsigned bsn;
138
139 /* first_bsn is in range V(A)..V(S) */
140
141 for (unsigned int bitpos = 0; bitpos < num_blocks; bitpos++) {
142 bool is_ack;
143 bsn = mod_sns(first_bsn + bitpos);
144 if (bsn == mod_sns(v_a() - 1))
145 break;
146
147 is_ack = bitvec_get_bit_pos(rbb, bitpos) == 1;
148
149 if (is_ack) {
150 LOGP(DRLCMACDL, LOGL_DEBUG, "- got ack for BSN=%d\n", bsn);
151 if (!m_v_b.is_acked(bsn))
152 *received += 1;
153 m_v_b.mark_acked(bsn);
154 } else {
155 LOGP(DRLCMACDL, LOGL_DEBUG, "- got NACK for BSN=%d\n", bsn);
156 m_v_b.mark_nacked(bsn);
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100157 bts_do_rate_ctr_inc(bts, CTR_RLC_NACKED);
Jacob Erlbeckeb08f862016-02-05 17:07:12 +0100158 *lost += 1;
159 }
160 }
161}
162
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100163void gprs_rlc_dl_window::update(struct gprs_rlcmac_bts *bts, char *show_rbb, uint16_t ssn,
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100164 uint16_t *lost, uint16_t *received)
165{
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100166 /* SSN - 1 is in range V(A)..V(S)-1 */
Daniel Willmann146514e2013-12-28 18:24:42 +0100167 for (int bitpos = 0; bitpos < ws(); bitpos++) {
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100168 uint16_t bsn = mod_sns(bitnum_to_bsn(bitpos, ssn));
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100169
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100170 if (bsn == mod_sns(v_a() - 1))
Daniel Willmanncc5a4cb2013-12-11 20:04:29 +0100171 break;
172
Daniel Willmann146514e2013-12-28 18:24:42 +0100173 if (show_rbb[ws() - 1 - bitpos] == 'R') {
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100174 LOGP(DRLCMACDL, LOGL_DEBUG, "- got ack for BSN=%d\n", bsn);
Daniel Willmann146514e2013-12-28 18:24:42 +0100175 if (!m_v_b.is_acked(bsn))
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100176 *received += 1;
Daniel Willmann146514e2013-12-28 18:24:42 +0100177 m_v_b.mark_acked(bsn);
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100178 } else {
179 LOGP(DRLCMACDL, LOGL_DEBUG, "- got NACK for BSN=%d\n", bsn);
Daniel Willmann146514e2013-12-28 18:24:42 +0100180 m_v_b.mark_nacked(bsn);
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100181 bts_do_rate_ctr_inc(bts, CTR_RLC_NACKED);
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100182 *lost += 1;
183 }
184 }
185}
Holger Hans Peter Freythere358ff82013-11-24 17:13:10 +0100186
Daniel Willmann146514e2013-12-28 18:24:42 +0100187int gprs_rlc_dl_window::move_window()
Holger Hans Peter Freythere358ff82013-11-24 17:13:10 +0100188{
189 int i;
190 uint16_t bsn;
191 int moved = 0;
192
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100193 for (i = 0, bsn = v_a(); bsn != v_s(); i++, bsn = mod_sns(bsn + 1)) {
Daniel Willmann146514e2013-12-28 18:24:42 +0100194 if (m_v_b.is_acked(bsn)) {
195 m_v_b.mark_invalid(bsn);
Holger Hans Peter Freythere358ff82013-11-24 17:13:10 +0100196 moved += 1;
197 } else
198 break;
199 }
200
201 return moved;
202}
Holger Hans Peter Freytherbc155702013-11-24 17:20:35 +0100203
Daniel Willmann3ce011f2014-01-15 12:45:56 +0100204void gprs_rlc_dl_window::show_state(char *show_v_b)
Holger Hans Peter Freytherbc155702013-11-24 17:20:35 +0100205{
206 int i;
207 uint16_t bsn;
208
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100209 for (i = 0, bsn = v_a(); bsn != v_s(); i++, bsn = mod_sns(bsn + 1)) {
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100210 uint16_t index = bsn & mod_sns_half();
Daniel Willmannd54d9f52013-12-28 21:16:13 +0100211 switch(m_v_b.get_state(index)) {
212 case GPRS_RLC_DL_BSN_INVALID:
213 show_v_b[i] = 'I';
214 break;
215 case GPRS_RLC_DL_BSN_ACKED:
216 show_v_b[i] = 'A';
217 break;
218 case GPRS_RLC_DL_BSN_RESEND:
219 show_v_b[i] = 'X';
220 break;
221 case GPRS_RLC_DL_BSN_NACKED:
222 show_v_b[i] = 'N';
223 break;
Daniel Willmann3ce011f2014-01-15 12:45:56 +0100224 default:
225 show_v_b[i] = '?';
Daniel Willmannd54d9f52013-12-28 21:16:13 +0100226 }
Holger Hans Peter Freytherbc155702013-11-24 17:20:35 +0100227 }
228 show_v_b[i] = '\0';
229}
Holger Hans Peter Freythere9b1ebb2013-11-24 22:00:43 +0100230
231void gprs_rlc_v_n::reset()
232{
Daniel Willmannd54d9f52013-12-28 21:16:13 +0100233 for (size_t i = 0; i < ARRAY_SIZE(m_v_n); ++i)
234 m_v_n[i] = GPRS_RLC_UL_BSN_INVALID;
Holger Hans Peter Freythere9b1ebb2013-11-24 22:00:43 +0100235}
Holger Hans Peter Freythercbb00eb2013-11-25 23:26:06 +0100236
Jacob Erlbeckdb883802016-01-19 14:07:33 +0100237void gprs_rlc_window::set_sns(uint16_t sns)
Jacob Erlbeck8f8197f2015-12-28 13:51:44 +0100238{
239 OSMO_ASSERT(sns >= RLC_GPRS_SNS);
240 OSMO_ASSERT(sns <= RLC_MAX_SNS);
241 /* check for 2^n */
242 OSMO_ASSERT((sns & (-sns)) == sns);
243 m_sns = sns;
244}
245
Jacob Erlbeckdb883802016-01-19 14:07:33 +0100246void gprs_rlc_window::set_ws(uint16_t ws)
Jacob Erlbeck8f8197f2015-12-28 13:51:44 +0100247{
sivasankari8adfcd02017-01-16 15:41:21 +0530248 LOGP(DRLCMAC, LOGL_INFO, "ws(%d)\n",
249 ws);
Jacob Erlbeck8f8197f2015-12-28 13:51:44 +0100250 OSMO_ASSERT(ws >= RLC_GPRS_SNS/2);
251 OSMO_ASSERT(ws <= RLC_MAX_SNS/2);
252 m_ws = ws;
253}
254
Daniel Willmann8a31f9e2013-11-27 17:08:35 +0100255/* Update the receive block bitmap */
Daniel Willmann7c3751b2013-12-28 13:59:24 +0100256void gprs_rlc_ul_window::update_rbb(char *rbb)
Daniel Willmann8a31f9e2013-11-27 17:08:35 +0100257{
258 int i;
259 for (i=0; i < ws(); i++) {
Aravind Sirsikar7c7a86c2016-08-30 13:08:28 +0530260 if (m_v_n.is_received((ssn()-1-i) & mod_sns()))
Daniel Willmann8a31f9e2013-11-27 17:08:35 +0100261 rbb[ws()-1-i] = 'R';
262 else
263 rbb[ws()-1-i] = 'I';
264 }
265}
266
Holger Hans Peter Freythercbb00eb2013-11-25 23:26:06 +0100267/* Raise V(R) to highest received sequence number not received. */
Daniel Willmann7c3751b2013-12-28 13:59:24 +0100268void gprs_rlc_ul_window::raise_v_r(const uint16_t bsn)
Holger Hans Peter Freythercbb00eb2013-11-25 23:26:06 +0100269{
270 uint16_t offset_v_r;
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100271 offset_v_r = mod_sns(bsn + 1 - v_r());
Holger Hans Peter Freythercbb00eb2013-11-25 23:26:06 +0100272 /* Positive offset, so raise. */
273 if (offset_v_r < (sns() >> 1)) {
274 while (offset_v_r--) {
275 if (offset_v_r) /* all except the received block */
Daniel Willmann7c3751b2013-12-28 13:59:24 +0100276 m_v_n.mark_missing(v_r());
Daniel Willmannf4a1ec62013-12-28 13:57:31 +0100277 raise_v_r_to(1);
Holger Hans Peter Freythercbb00eb2013-11-25 23:26:06 +0100278 }
279 LOGP(DRLCMACUL, LOGL_DEBUG, "- Raising V(R) to %d\n", v_r());
280 }
281}
Holger Hans Peter Freyther7f3e6622013-11-25 23:51:19 +0100282
283/*
284 * Raise V(Q) if possible. This is looped until there is a gap
285 * (non received block) or the window is empty.
286 */
Daniel Willmann7c3751b2013-12-28 13:59:24 +0100287uint16_t gprs_rlc_ul_window::raise_v_q()
Holger Hans Peter Freyther7f3e6622013-11-25 23:51:19 +0100288{
289 uint16_t count = 0;
290
291 while (v_q() != v_r()) {
Daniel Willmann7c3751b2013-12-28 13:59:24 +0100292 if (!m_v_n.is_received(v_q()))
Holger Hans Peter Freyther7f3e6622013-11-25 23:51:19 +0100293 break;
294 LOGP(DRLCMACUL, LOGL_DEBUG, "- Taking block %d out, raising "
Jacob Erlbeck93c55d02015-12-23 16:29:07 +0100295 "V(Q) to %d\n", v_q(), mod_sns(v_q() + 1));
Holger Hans Peter Freyther7f3e6622013-11-25 23:51:19 +0100296 raise_v_q(1);
297 count += 1;
298 }
299
300 return count;
301}
Daniel Willmann55844792013-12-28 14:41:00 +0100302
Jacob Erlbeckd87e1d62015-12-14 11:43:04 +0100303void gprs_rlc_ul_window::receive_bsn(const uint16_t bsn)
Daniel Willmann55844792013-12-28 14:41:00 +0100304{
305 m_v_n.mark_received(bsn);
306 raise_v_r(bsn);
Jacob Erlbeck784a0bd2015-12-14 11:54:29 +0100307}
Daniel Willmann55844792013-12-28 14:41:00 +0100308
Jacob Erlbeck784a0bd2015-12-14 11:54:29 +0100309bool gprs_rlc_ul_window::invalidate_bsn(const uint16_t bsn)
310{
311 bool was_valid = m_v_n.is_received(bsn);
312 m_v_n.mark_missing(bsn);
313
314 return was_valid;
Daniel Willmann55844792013-12-28 14:41:00 +0100315}
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100316
317static void gprs_rlc_data_header_init(struct gprs_rlc_data_info *rlc,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200318 enum CodingScheme cs, bool with_padding, unsigned int header_bits,
Aravind Sirsikar50b09702016-08-22 17:21:10 +0530319 const unsigned int spb)
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100320{
321 unsigned int i;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200322 unsigned int padding_bits = with_padding ? mcs_opt_padding_bits(cs) : 0;
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100323
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100324 rlc->cs = cs;
Pau Espin Pedrol7a9c1662018-05-16 15:22:20 +0200325 rlc->r = 0;
326 rlc->si = 0;
327 rlc->tfi = 0;
328 rlc->cps = 0;
329 rlc->rsb = 0;
330 rlc->usf = 0;
331 rlc->es_p = 0;
332 rlc->rrbp = 0;
333 rlc->pr = 0;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200334 rlc->num_data_blocks = num_data_blocks(mcs_header_type(cs));
Pau Espin Pedrol7a9c1662018-05-16 15:22:20 +0200335 rlc->with_padding = with_padding;
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100336
337 OSMO_ASSERT(rlc->num_data_blocks <= ARRAY_SIZE(rlc->block_info));
338
339 for (i = 0; i < rlc->num_data_blocks; i++) {
Jacob Erlbeckb55f3132016-02-03 18:28:04 +0100340 gprs_rlc_data_block_info_init(&rlc->block_info[i], cs,
Aravind Sirsikar50b09702016-08-22 17:21:10 +0530341 with_padding, spb);
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100342
343 rlc->data_offs_bits[i] =
Jacob Erlbeckb55f3132016-02-03 18:28:04 +0100344 header_bits + padding_bits +
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200345 (i+1) * num_data_block_header_bits(mcs_header_type(cs)) +
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100346 i * 8 * rlc->block_info[0].data_len;
347 }
348}
349
350void gprs_rlc_data_info_init_dl(struct gprs_rlc_data_info *rlc,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200351 enum CodingScheme cs, bool with_padding, const unsigned int spb)
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100352{
Pau Espin Pedrolf1159c52020-11-04 17:53:07 +0100353 OSMO_ASSERT(mcs_is_valid(cs));
Jacob Erlbeckb55f3132016-02-03 18:28:04 +0100354 return gprs_rlc_data_header_init(rlc, cs, with_padding,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200355 num_data_header_bits_DL(mcs_header_type(cs)), spb);
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100356}
357
358void gprs_rlc_data_info_init_ul(struct gprs_rlc_data_info *rlc,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200359 enum CodingScheme cs, bool with_padding)
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100360{
Pau Espin Pedrolf1159c52020-11-04 17:53:07 +0100361 OSMO_ASSERT(mcs_is_valid(cs));
Aravind Sirsikar50b09702016-08-22 17:21:10 +0530362 /*
363 * last parameter is sent as 0 since common function used
364 * for both DL and UL
365 */
Jacob Erlbeckb55f3132016-02-03 18:28:04 +0100366 return gprs_rlc_data_header_init(rlc, cs, with_padding,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200367 num_data_header_bits_UL(mcs_header_type(cs)), 0);
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100368}
369
370void gprs_rlc_data_block_info_init(struct gprs_rlc_data_block_info *rdbi,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200371 enum CodingScheme cs, bool with_padding, const unsigned int spb)
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100372{
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200373 unsigned int data_len = mcs_max_data_block_bytes(cs);
Jacob Erlbeckb55f3132016-02-03 18:28:04 +0100374 if (with_padding)
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200375 data_len -= mcs_opt_padding_bits(cs) / 8;
Jacob Erlbeckb55f3132016-02-03 18:28:04 +0100376
377 rdbi->data_len = data_len;
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100378 rdbi->bsn = 0;
379 rdbi->ti = 0;
380 rdbi->e = 1;
381 rdbi->cv = 15;
382 rdbi->pi = 0;
Aravind Sirsikar50b09702016-08-22 17:21:10 +0530383 rdbi->spb = spb;
Jacob Erlbeck6e9f9c22016-01-11 11:15:45 +0100384}
Jacob Erlbeck70955c72016-01-13 13:09:09 +0100385
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200386unsigned int gprs_rlc_mcs_cps(enum CodingScheme cs,
Aravind Sirsikara859a212016-03-23 18:29:46 +0530387 enum egprs_puncturing_values punct,
Maxb3a17d62017-12-21 12:11:33 +0100388 enum egprs_puncturing_values punct2, bool with_padding)
Jacob Erlbeck70955c72016-01-13 13:09:09 +0100389{
Neels Hofmeyrb6091902017-02-08 16:49:20 +0100390 /* validate that punct and punct2 are as expected */
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200391 switch (cs) {
Maxbea2edb2019-03-06 17:04:59 +0100392 case MCS9:
393 case MCS8:
394 case MCS7:
Neels Hofmeyrb6091902017-02-08 16:49:20 +0100395 if (punct2 == EGPRS_PS_INVALID) {
396 LOGP(DRLCMACDL, LOGL_ERROR,
397 "Invalid punct2 value for coding scheme %d: %d\n",
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200398 cs, punct2);
Neels Hofmeyrb6091902017-02-08 16:49:20 +0100399 return -1;
400 }
401 /* fall through */
Maxbea2edb2019-03-06 17:04:59 +0100402 case MCS6:
403 case MCS5:
404 case MCS4:
405 case MCS3:
406 case MCS2:
407 case MCS1:
Neels Hofmeyrb6091902017-02-08 16:49:20 +0100408 if (punct == EGPRS_PS_INVALID) {
409 LOGP(DRLCMACDL, LOGL_ERROR,
410 "Invalid punct value for coding scheme %d: %d\n",
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200411 cs, punct);
Neels Hofmeyrb6091902017-02-08 16:49:20 +0100412 return -1;
413 }
414 break;
415 default:
416 return -1;
417 }
418
419 /* See 3GPP TS 44.060 10.4.8a.3.1, 10.4.8a.2.1, 10.4.8a.1.1 */
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200420 switch (cs) {
Maxbea2edb2019-03-06 17:04:59 +0100421 case MCS1: return 0b1011 +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530422 punct % EGPRS_MAX_PS_NUM_2;
Maxbea2edb2019-03-06 17:04:59 +0100423 case MCS2: return 0b1001 +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530424 punct % EGPRS_MAX_PS_NUM_2;
Maxbea2edb2019-03-06 17:04:59 +0100425 case MCS3: return (with_padding ? 0b0110 : 0b0011) +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530426 punct % EGPRS_MAX_PS_NUM_3;
Maxbea2edb2019-03-06 17:04:59 +0100427 case MCS4: return 0b0000 +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530428 punct % EGPRS_MAX_PS_NUM_3;
Maxbea2edb2019-03-06 17:04:59 +0100429 case MCS5: return 0b100 +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530430 punct % EGPRS_MAX_PS_NUM_2;
Maxbea2edb2019-03-06 17:04:59 +0100431 case MCS6: return (with_padding ? 0b010 : 0b000) +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530432 punct % EGPRS_MAX_PS_NUM_2;
Maxbea2edb2019-03-06 17:04:59 +0100433 case MCS7: return 0b10100 +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530434 3 * (punct % EGPRS_MAX_PS_NUM_3) +
435 punct2 % EGPRS_MAX_PS_NUM_3;
Maxbea2edb2019-03-06 17:04:59 +0100436 case MCS8: return 0b01011 +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530437 3 * (punct % EGPRS_MAX_PS_NUM_3) +
438 punct2 % EGPRS_MAX_PS_NUM_3;
Maxbea2edb2019-03-06 17:04:59 +0100439 case MCS9: return 0b00000 +
Aravind Sirsikara859a212016-03-23 18:29:46 +0530440 4 * (punct % EGPRS_MAX_PS_NUM_3) +
441 punct2 % EGPRS_MAX_PS_NUM_3;
Jacob Erlbeck70955c72016-01-13 13:09:09 +0100442 default: ;
443 }
444
445 return -1;
446}
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100447
448void gprs_rlc_mcs_cps_decode(unsigned int cps,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200449 enum CodingScheme cs, int *punct, int *punct2, int *with_padding)
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100450{
451 *punct2 = -1;
452 *with_padding = 0;
453
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200454 switch (cs) {
Maxbea2edb2019-03-06 17:04:59 +0100455 case MCS1:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100456 cps -= 0b1011; *punct = cps % 2; break;
Maxbea2edb2019-03-06 17:04:59 +0100457 case MCS2:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100458 cps -= 0b1001; *punct = cps % 2; break;
Maxbea2edb2019-03-06 17:04:59 +0100459 case MCS3:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100460 cps -= 0b0011; *punct = cps % 3; *with_padding = cps >= 3; break;
Maxbea2edb2019-03-06 17:04:59 +0100461 case MCS4:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100462 cps -= 0b0000; *punct = cps % 3; break;
Maxbea2edb2019-03-06 17:04:59 +0100463 case MCS5:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100464 cps -= 0b100; *punct = cps % 2; break;
Maxbea2edb2019-03-06 17:04:59 +0100465 case MCS6:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100466 cps -= 0b000; *punct = cps % 2; *with_padding = cps >= 2; break;
Maxbea2edb2019-03-06 17:04:59 +0100467 case MCS7:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100468 cps -= 0b10100; *punct = cps / 3; *punct2 = cps % 3; break;
Maxbea2edb2019-03-06 17:04:59 +0100469 case MCS8:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100470 cps -= 0b01011; *punct = cps / 3; *punct2 = cps % 3; break;
Maxbea2edb2019-03-06 17:04:59 +0100471 case MCS9:
Jacob Erlbeckfbd82e42016-02-03 18:31:19 +0100472 cps -= 0b00000; *punct = cps / 4; *punct2 = cps % 3; break;
473 default: ;
474 }
475}
Aravind Sirsikar79522822016-03-23 18:29:47 +0530476
477/*
478 * Finds the PS value for retransmission with MCS change,
479 * retransmission with no MCS change, fresh transmission cases.
480 * The return value shall be used for current transmission only
481 * 44.060 9.3.2.1 defines the PS selection for MCS change case
482 * cs_current is the output of MCS selection algorithm for retx
483 * cs is coding scheme of previous transmission of RLC data block
484 */
485enum egprs_puncturing_values gprs_get_punct_scheme(
486 enum egprs_puncturing_values punct,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200487 const enum CodingScheme &cs,
488 const enum CodingScheme &cs_current,
Aravind Sirsikar50b09702016-08-22 17:21:10 +0530489 const enum egprs_rlcmac_dl_spb spb)
Aravind Sirsikar79522822016-03-23 18:29:47 +0530490{
Aravind Sirsikar50b09702016-08-22 17:21:10 +0530491
492 /*
493 * 10.4.8b of TS 44.060
494 * If it is second segment of the block
495 * dont change the puncturing scheme
496 */
497 if (spb == EGPRS_RLCMAC_DL_SEC_SEG)
498 return punct;
499
Aravind Sirsikar79522822016-03-23 18:29:47 +0530500 /* TS 44.060 9.3.2.1.1 */
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200501 if ((cs == MCS9) &&
502 (cs_current == MCS6)) {
Aravind Sirsikar79522822016-03-23 18:29:47 +0530503 if ((punct == EGPRS_PS_1) || (punct == EGPRS_PS_3))
504 return EGPRS_PS_1;
505 else if (punct == EGPRS_PS_2)
506 return EGPRS_PS_2;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200507 } else if ((cs == MCS6) &&
508 (cs_current == MCS9)) {
Aravind Sirsikar79522822016-03-23 18:29:47 +0530509 if (punct == EGPRS_PS_1)
510 return EGPRS_PS_3;
511 else if (punct == EGPRS_PS_2)
512 return EGPRS_PS_2;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200513 } else if ((cs == MCS7) &&
514 (cs_current == MCS5))
Aravind Sirsikar79522822016-03-23 18:29:47 +0530515 return EGPRS_PS_1;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200516 else if ((cs == MCS5) &&
517 (cs_current == MCS7))
Aravind Sirsikar79522822016-03-23 18:29:47 +0530518 return EGPRS_PS_2;
519 else if (cs != cs_current)
520 return EGPRS_PS_1;
521 /* TS 44.060 9.3.2.1.1 ends here */
522 /*
523 * Below else will handle fresh transmission, retransmission with no
524 * MCS change case
525 */
526 else
527 return punct;
528 return EGPRS_PS_INVALID;
529}
530
531/*
532 * This function calculates puncturing scheme for retransmission of a RLC
533 * block with same MCS. The computed value shall be used for next transmission
534 * of the same RLC block
535 * TS 44.060 10.4.8a.3.1, 10.4.8a.2.1, 10.4.8a.1.1
536 */
537void gprs_update_punct_scheme(enum egprs_puncturing_values *punct,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200538 const enum CodingScheme &cs)
Aravind Sirsikar79522822016-03-23 18:29:47 +0530539{
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200540 switch (cs) {
Maxbea2edb2019-03-06 17:04:59 +0100541 case MCS1 :
542 case MCS2 :
543 case MCS5 :
544 case MCS6 :
Aravind Sirsikar79522822016-03-23 18:29:47 +0530545 *punct = ((enum egprs_puncturing_values)((*punct + 1) %
546 EGPRS_MAX_PS_NUM_2));
547 break;
Maxbea2edb2019-03-06 17:04:59 +0100548 case MCS3 :
549 case MCS4 :
550 case MCS7 :
551 case MCS8 :
552 case MCS9 :
Aravind Sirsikar79522822016-03-23 18:29:47 +0530553 *punct = ((enum egprs_puncturing_values)((*punct + 1) %
554 EGPRS_MAX_PS_NUM_3));
555 break;
556 default:
557 break;
558 }
559}