blob: 3410291e748dd203111cdd736d45a22174aa1f0f [file] [log] [blame]
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +02001/* decoding
2 *
3 * Copyright (C) 2012 Ivan Klyuchnikov
4 * Copyright (C) 2012 Andreas Eversberg <jolly@eversberg.eu>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20#include <decoding.h>
21#include <rlc.h>
22#include <gprs_debug.h>
Pravin Kumarvel0a4a6c12016-10-17 11:00:57 +053023#include <egprs_rlc_compression.h>
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +020024
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010025extern "C" {
26#include <osmocom/core/utils.h>
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +010027#include <osmocom/core/bitcomp.h>
Tom Tsoudf698092016-07-11 17:05:19 -070028#include <osmocom/gprs/protocol/gsm_04_60.h>
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010029}
30
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +020031#include <arpa/inet.h>
32
33#include <errno.h>
34#include <string.h>
35
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010036#define LENGTH_TO_END 255
Alexander Couzensb82bd922016-05-30 17:30:10 +020037/*!
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010038 * \returns num extensions fields (num frames == offset) on success,
39 * -errno otherwise.
40 */
41static int parse_extensions_egprs(const uint8_t *data, unsigned int data_len,
42 unsigned int *offs,
43 bool is_last_block,
44 Decoding::RlcData *chunks, unsigned int chunks_size)
45{
46 const struct rlc_li_field_egprs *li;
47 uint8_t e;
48 unsigned int num_chunks = 0;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010049
50 e = 0;
51 while (!e) {
52 if (*offs > data_len) {
53 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA LI extended, "
54 "but no more data\n");
55 return -EINVAL;
56 }
57
58 /* get new E */
59 li = (struct rlc_li_field_egprs *)&data[*offs];
60 e = li->e;
61 *offs += 1;
62
63 if (!chunks)
64 continue;
65
66 if (num_chunks == chunks_size) {
67 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA LI extended, "
68 "but no more chunks possible\n");
69 return -ENOSPC;
70 }
Aravind Sirsikar22a90192016-09-15 17:24:49 +053071 if (li->li == 0 && num_chunks == 0) {
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010072 /* TS 44.060, table 10.4.14a.1, row 2a */
Aravind Sirsikar22a90192016-09-15 17:24:49 +053073 /* TS 44.060, table 10.4.14a.1, row 4 */
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010074 chunks[num_chunks].length = 0;
75 chunks[num_chunks].is_complete = true;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010076 } else if (li->li == 127 && li->e == 1) {
77 /* TS 44.060, table 10.4.14a.1, row 3 & 5 */
78 /* only filling bytes left */
Mrinal Mishra0e636442016-11-28 19:46:50 +053079 LOGP(DRLCMACUL, LOGL_DEBUG, "UL DATA LI contains "
80 "only filling bytes with extention octet: LI=%d, E=%d, count=%d\n",
81 li->li, li->e, num_chunks);
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010082 break;
83 } else if (li->li > 0) {
84 /* TS 44.060, table 10.4.14a.1, row 1 & 2b */
85 chunks[num_chunks].length = li->li;
86 chunks[num_chunks].is_complete = true;
87 } else {
88 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA LI contains "
89 "invalid extension octet: LI=%d, E=%d, count=%d\n",
90 li->li, li->e, num_chunks);
91 return -EINVAL;
92 }
93
Mrinal Mishra0e636442016-11-28 19:46:50 +053094 LOGP(DRLCMACUL, LOGL_DEBUG, "UL DATA LI contains "
95 "extention octet: LI=%d, E=%d, count=%d\n",
96 li->li, li->e, num_chunks);
Jacob Erlbeck4abc6862015-12-08 15:14:05 +010097 num_chunks += 1;
98
99 if (e == 1) {
100 /* There is space after the last chunk, add a final one */
101 if (num_chunks == chunks_size) {
102 LOGP(DRLCMACUL, LOGL_NOTICE,
103 "UL DATA LI possibly extended, "
104 "but no more chunks possible\n");
105 return -ENOSPC;
106 }
107
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100108 chunks[num_chunks].length = LENGTH_TO_END;
109 chunks[num_chunks].is_complete = is_last_block;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100110 num_chunks += 1;
111 }
112 }
113
114 return num_chunks;
115}
116
117static int parse_extensions_gprs(const uint8_t *data, unsigned int data_len,
118 unsigned int *offs,
119 bool is_last_block,
120 Decoding::RlcData *chunks, unsigned int chunks_size)
121{
122 const struct rlc_li_field *li;
123 uint8_t m, e;
124 unsigned int num_chunks = 0;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100125
126 e = 0;
127 while (!e) {
128 if (*offs > data_len) {
129 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA LI extended, "
130 "but no more data\n");
131 return -EINVAL;
132 }
133
134 /* get new E */
135 li = (const struct rlc_li_field *)&data[*offs];
136 e = li->e;
137 m = li->m;
138 *offs += 1;
139
140 if (li->li == 0) {
141 /* TS 44.060, 10.4.14, par 6 */
142 e = 1;
143 m = 0;
144 }
145
146 /* TS 44.060, table 10.4.13.1 */
147 if (m == 0 && e == 0) {
148 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA "
149 "ignored, because M='0' and E='0'.\n");
150 return 0;
151 }
152
153 if (!chunks)
154 continue;
155
156 if (num_chunks == chunks_size) {
157 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA LI extended, "
158 "but no more chunks possible\n");
159 return -ENOSPC;
160 }
161
162 if (li->li == 0)
163 /* e is 1 here */
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100164 chunks[num_chunks].length = LENGTH_TO_END;
165 else
166 chunks[num_chunks].length = li->li;
167
168 chunks[num_chunks].is_complete = li->li || is_last_block;
169
Mrinal Mishra0e636442016-11-28 19:46:50 +0530170 LOGP(DRLCMACUL, LOGL_DEBUG, "UL DATA LI contains "
171 "extention octet: LI=%d, M=%d, E=%d, count=%d\n",
172 li->li, li->m, li->e, num_chunks);
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100173 num_chunks += 1;
174
175 if (e == 1 && m == 1) {
176 if (num_chunks == chunks_size) {
177 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA LI extended, "
178 "but no more chunks possible\n");
179 return -ENOSPC;
180 }
181 /* TS 44.060, 10.4.13.1, row 4 */
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100182 chunks[num_chunks].length = LENGTH_TO_END;
183 chunks[num_chunks].is_complete = is_last_block;
184 num_chunks += 1;
185 }
186 }
187
188 return num_chunks;
189}
190
191int Decoding::rlc_data_from_ul_data(
Jacob Erlbeckf2ba4cb2016-01-07 18:59:28 +0100192 const struct gprs_rlc_data_block_info *rdbi, GprsCodingScheme cs,
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100193 const uint8_t *data, RlcData *chunks, unsigned int chunks_size,
194 uint32_t *tlli)
195{
196 uint8_t e;
197 unsigned int data_len = rdbi->data_len;
Jacob Erlbeckead5e472016-01-08 10:14:50 +0100198 int num_chunks = 0, i;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100199 unsigned int offs = 0;
200 bool is_last_block = (rdbi->cv == 0);
201
202 if (!chunks)
203 chunks_size = 0;
204
205 e = rdbi->e;
206 if (e) {
207 if (chunks_size > 0) {
Alexander Couzensb82bd922016-05-30 17:30:10 +0200208 /* Block without LI means it only contains data of one LLC PDU */
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100209 chunks[num_chunks].offset = offs;
210 chunks[num_chunks].length = LENGTH_TO_END;
211 chunks[num_chunks].is_complete = is_last_block;
212 num_chunks += 1;
213 } else if (chunks) {
214 LOGP(DRLCMACUL, LOGL_NOTICE, "No extension, "
215 "but no more chunks possible\n");
216 return -ENOSPC;
217 }
218 } else if (cs.isEgprs()) {
219 /* if E is not set (LI follows), EGPRS */
220 num_chunks = parse_extensions_egprs(data, data_len, &offs,
221 is_last_block,
222 chunks, chunks_size);
223 } else {
224 /* if E is not set (LI follows), GPRS */
225 num_chunks = parse_extensions_gprs(data, data_len, &offs,
226 is_last_block,
227 chunks, chunks_size);
228 }
229
Jacob Erlbeckead5e472016-01-08 10:14:50 +0100230 if (num_chunks < 0)
231 return num_chunks;
232
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100233 /* TLLI */
234 if (rdbi->ti) {
235 uint32_t tlli_enc;
236 if (offs + 4 > data_len) {
237 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA TLLI out of block "
238 "border\n");
239 return -EINVAL;
240 }
241
242 memcpy(&tlli_enc, data + offs, sizeof(tlli_enc));
243 if (cs.isGprs())
244 /* The TLLI is encoded in big endian for GPRS (see
245 * TS 44.060, figure 10.2.2.1, note) */
246 *tlli = be32toh(tlli_enc);
247 else
248 /* The TLLI is encoded in little endian for EGPRS (see
249 * TS 44.060, figure 10.3a.2.1, note 2) */
250 *tlli = le32toh(tlli_enc);
251
252 offs += sizeof(tlli_enc);
253 } else {
254 *tlli = 0;
255 }
256
257 /* PFI */
258 if (rdbi->pi) {
259 LOGP(DRLCMACUL, LOGL_ERROR, "ERROR: PFI not supported, "
260 "please disable in SYSTEM INFORMATION\n");
261 return -ENOTSUP;
262
263 /* TODO: Skip all extensions with E=0 (see TS 44.060, 10.4.11 */
264 }
265
Jacob Erlbeckead5e472016-01-08 10:14:50 +0100266 if (chunks_size == 0)
267 return num_chunks;
268
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100269 /* LLC */
270 for (i = 0; i < num_chunks; i++) {
271 chunks[i].offset = offs;
272 if (chunks[i].length == LENGTH_TO_END) {
273 if (offs == data_len) {
274 /* There is no place for an additional chunk,
275 * so drop it (this may happen with EGPRS since
276 * there is no M flag. */
277 num_chunks -= 1;
Alexander Couzensd302e4f2016-05-30 17:31:09 +0200278 break;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100279 }
280 chunks[i].length = data_len - offs;
281 }
282 offs += chunks[i].length;
283 if (offs > data_len) {
284 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA out of block "
285 "border, chunk idx: %d, size: %d\n",
286 i, chunks[i].length);
287 return -EINVAL;
288 }
289 }
290
291 return num_chunks;
292}
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200293
Holger Hans Peter Freytherfcbc7022013-10-26 17:38:37 +0200294uint8_t Decoding::get_ms_class_by_capability(MS_Radio_Access_capability_t *cap)
295{
296 int i;
297
298 for (i = 0; i < cap->Count_MS_RA_capability_value; i++) {
299 if (!cap->MS_RA_capability_value[i].u.Content.Exist_Multislot_capability)
300 continue;
301 if (!cap->MS_RA_capability_value[i].u.Content.Multislot_capability.Exist_GPRS_multislot_class)
302 continue;
303 return cap->MS_RA_capability_value[i].u.Content.Multislot_capability.GPRS_multislot_class;
304 }
305
306 return 0;
307}
308
Jacob Erlbeckc3c58042015-09-28 17:55:32 +0200309uint8_t Decoding::get_egprs_ms_class_by_capability(MS_Radio_Access_capability_t *cap)
310{
311 int i;
312
313 for (i = 0; i < cap->Count_MS_RA_capability_value; i++) {
314 if (!cap->MS_RA_capability_value[i].u.Content.Exist_Multislot_capability)
315 continue;
316 if (!cap->MS_RA_capability_value[i].u.Content.Multislot_capability.Exist_EGPRS_multislot_class)
317 continue;
318 return cap->MS_RA_capability_value[i].u.Content.Multislot_capability.EGPRS_multislot_class;
319 }
320
321 return 0;
322}
323
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100324/**
325 * show_rbb needs to be an array with 65 elements
Daniel Willmann5e94cd42013-12-11 20:11:16 +0100326 * The index of the array is the bit position in the rbb
327 * (show_rbb[63] relates to BSN ssn-1)
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100328 */
329void Decoding::extract_rbb(const uint8_t *rbb, char *show_rbb)
330{
Daniel Willmann5e94cd42013-12-11 20:11:16 +0100331 for (int i = 0; i < 64; i++) {
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100332 uint8_t bit;
333
Daniel Willmann5e94cd42013-12-11 20:11:16 +0100334 bit = !!(rbb[i/8] & (1<<(7-i%8)));
Daniel Willmann6f7cb2c2013-12-11 14:25:20 +0100335 show_rbb[i] = bit ? 'R' : 'I';
Holger Hans Peter Freytherdf6b4f52013-11-24 17:05:48 +0100336 }
337
338 show_rbb[64] = '\0';
339}
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100340
Jacob Erlbeckf2f24b02016-02-05 13:16:24 +0100341void Decoding::extract_rbb(const struct bitvec *rbb, char *show_rbb)
342{
343 unsigned int i;
344 for (i = 0; i < rbb->cur_bit; i++) {
345 uint8_t bit;
346 bit = bitvec_get_bit_pos(rbb, i);
347 show_rbb[i] = bit == 1 ? 'R' : 'I';
348 }
349
350 show_rbb[i] = '\0';
351}
352
Jacob Erlbeckf2ba4cb2016-01-07 18:59:28 +0100353int Decoding::rlc_parse_ul_data_header(struct gprs_rlc_data_info *rlc,
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100354 const uint8_t *data, GprsCodingScheme cs)
355{
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100356 unsigned int cur_bit = 0;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100357 switch(cs.headerTypeData()) {
Max51754b62019-03-13 17:14:13 +0100358 case HEADER_GPRS_DATA :
Bhargava Abhyankare44383b2016-03-22 18:42:30 +0530359 cur_bit = rlc_parse_ul_data_header_gprs(rlc, data, cs);
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100360 break;
Max51754b62019-03-13 17:14:13 +0100361 case HEADER_EGPRS_DATA_TYPE_3 :
Bhargava Abhyankare44383b2016-03-22 18:42:30 +0530362 cur_bit = rlc_parse_ul_data_header_egprs_type_3(rlc, data, cs);
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100363 break;
Max51754b62019-03-13 17:14:13 +0100364 case HEADER_EGPRS_DATA_TYPE_2 :
Aravind Sirsikar550a5412016-06-14 18:59:18 +0530365 cur_bit = rlc_parse_ul_data_header_egprs_type_2(rlc, data, cs);
366 break;
Max51754b62019-03-13 17:14:13 +0100367 case HEADER_EGPRS_DATA_TYPE_1 :
Aravind Sirsikar99ab0a82016-06-15 17:46:41 +0530368 cur_bit = rlc_parse_ul_data_header_egprs_type_1(rlc, data, cs);
369 break;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100370 default:
371 LOGP(DRLCMACDL, LOGL_ERROR,
372 "Decoding of uplink %s data blocks not yet supported.\n",
373 cs.name());
374 return -ENOTSUP;
375 };
376
377 return cur_bit;
378}
379
Bhargava Abhyankare44383b2016-03-22 18:42:30 +0530380int Decoding::rlc_parse_ul_data_header_egprs_type_3(
381 struct gprs_rlc_data_info *rlc,
382 const uint8_t *data,
383 const GprsCodingScheme &cs)
384{
385 int punct, punct2, with_padding, cps;
386 unsigned int e_ti_header, offs, cur_bit = 0;
387 const struct gprs_rlc_ul_header_egprs_3 *egprs3;
388
389 egprs3 = static_cast < struct gprs_rlc_ul_header_egprs_3 * >
390 ((void *)data);
391
Tom Tsoudf698092016-07-11 17:05:19 -0700392 cps = (egprs3->cps_hi << 0) | (egprs3->cps_lo << 2);
Bhargava Abhyankare44383b2016-03-22 18:42:30 +0530393 gprs_rlc_mcs_cps_decode(cps, cs, &punct, &punct2, &with_padding);
394 gprs_rlc_data_info_init_ul(rlc, cs, with_padding);
395
396 rlc->r = egprs3->r;
397 rlc->si = egprs3->si;
Tom Tsoudf698092016-07-11 17:05:19 -0700398 rlc->tfi = (egprs3->tfi_hi << 0) | (egprs3->tfi_lo << 2);
Bhargava Abhyankare44383b2016-03-22 18:42:30 +0530399 rlc->cps = cps;
400 rlc->rsb = egprs3->rsb;
401
402 rlc->num_data_blocks = 1;
403 rlc->block_info[0].cv = egprs3->cv;
404 rlc->block_info[0].pi = egprs3->pi;
405 rlc->block_info[0].spb = egprs3->spb;
406 rlc->block_info[0].bsn =
Tom Tsoudf698092016-07-11 17:05:19 -0700407 (egprs3->bsn1_hi << 0) | (egprs3->bsn1_lo << 5);
Bhargava Abhyankare44383b2016-03-22 18:42:30 +0530408
409 cur_bit += rlc->data_offs_bits[0] - 2;
410 offs = rlc->data_offs_bits[0] / 8;
411 OSMO_ASSERT(rlc->data_offs_bits[0] % 8 == 1);
412 e_ti_header = (data[offs-1] + (data[offs] << 8)) >> 7;
413 rlc->block_info[0].e = !!(e_ti_header & 0x01);
414 rlc->block_info[0].ti = !!(e_ti_header & 0x02);
415 cur_bit += 2;
416 /* skip data area */
417 cur_bit += cs.maxDataBlockBytes() * 8;
418
419 return cur_bit;
420}
421
Aravind Sirsikar550a5412016-06-14 18:59:18 +0530422int Decoding::rlc_parse_ul_data_header_egprs_type_2(
423 struct gprs_rlc_data_info *rlc,
424 const uint8_t *data,
425 const GprsCodingScheme &cs)
426{
427 const struct gprs_rlc_ul_header_egprs_2 *egprs2;
428 unsigned int e_ti_header, offs, cur_bit = 0;
429 int punct, punct2, with_padding, cps;
430
431 egprs2 = static_cast < struct gprs_rlc_ul_header_egprs_2 * >
432 ((void *)data);
433
Tom Tsoudf698092016-07-11 17:05:19 -0700434 cps = (egprs2->cps_hi << 0) | (egprs2->cps_lo << 2);
Aravind Sirsikar550a5412016-06-14 18:59:18 +0530435 gprs_rlc_mcs_cps_decode(cps, cs, &punct, &punct2, &with_padding);
436 gprs_rlc_data_info_init_ul(rlc, cs, with_padding);
437
438 rlc->r = egprs2->r;
439 rlc->si = egprs2->si;
Tom Tsoudf698092016-07-11 17:05:19 -0700440 rlc->tfi = (egprs2->tfi_hi << 0) | (egprs2->tfi_lo << 2);
Aravind Sirsikar550a5412016-06-14 18:59:18 +0530441 rlc->cps = cps;
442 rlc->rsb = egprs2->rsb;
443
444 rlc->num_data_blocks = 1;
445 rlc->block_info[0].cv = egprs2->cv;
446 rlc->block_info[0].pi = egprs2->pi;
447 rlc->block_info[0].bsn =
Tom Tsoudf698092016-07-11 17:05:19 -0700448 (egprs2->bsn1_hi << 0) | (egprs2->bsn1_lo << 5);
Aravind Sirsikar550a5412016-06-14 18:59:18 +0530449
450 cur_bit += rlc->data_offs_bits[0] - 2;
451
452 offs = rlc->data_offs_bits[0] / 8;
453 OSMO_ASSERT(rlc->data_offs_bits[0] % 8 == 7);
454
455 e_ti_header = (data[offs] & 0x60) >> 5;
456 rlc->block_info[0].e = !!(e_ti_header & 0x01);
457 rlc->block_info[0].ti = !!(e_ti_header & 0x02);
458 cur_bit += 2;
459
460 /* skip data area */
461 cur_bit += cs.maxDataBlockBytes() * 8;
462
463 return cur_bit;
464}
465
Aravind Sirsikar99ab0a82016-06-15 17:46:41 +0530466int Decoding::rlc_parse_ul_data_header_egprs_type_1(
467 struct gprs_rlc_data_info *rlc,
468 const uint8_t *data, const GprsCodingScheme &cs)
469{
470 struct gprs_rlc_ul_header_egprs_1 *egprs1;
471 unsigned int e_ti_header, cur_bit = 0, offs;
472 int punct, punct2, with_padding;
473
474 egprs1 = static_cast < struct gprs_rlc_ul_header_egprs_1 * >
475 ((void *)data);
476 gprs_rlc_mcs_cps_decode(egprs1->cps, cs, &punct, &punct2,
477 &with_padding);
478 gprs_rlc_data_info_init_ul(rlc, cs, with_padding);
479
480 rlc->r = egprs1->r;
481 rlc->si = egprs1->si;
Tom Tsoudf698092016-07-11 17:05:19 -0700482 rlc->tfi = (egprs1->tfi_hi << 0) | (egprs1->tfi_lo << 2);
Aravind Sirsikar99ab0a82016-06-15 17:46:41 +0530483 rlc->cps = egprs1->cps;
484 rlc->rsb = egprs1->rsb;
485 rlc->num_data_blocks = 2;
486 rlc->block_info[0].cv = egprs1->cv;
487 rlc->block_info[0].pi = egprs1->pi;
488 rlc->block_info[0].bsn =
Tom Tsoudf698092016-07-11 17:05:19 -0700489 (egprs1->bsn1_hi << 0) | (egprs1->bsn1_lo << 5);
Aravind Sirsikar99ab0a82016-06-15 17:46:41 +0530490
491 cur_bit += rlc->data_offs_bits[0] - 2;
492 offs = rlc->data_offs_bits[0] / 8;
493 OSMO_ASSERT(rlc->data_offs_bits[0] % 8 == 0);
494
495 e_ti_header = data[offs - 1] >> 6;
496 rlc->block_info[0].e = (e_ti_header & 0x01);
497 rlc->block_info[0].ti = !!(e_ti_header & 0x02);
498 cur_bit += 2;
499
500 rlc->block_info[1].cv = egprs1->cv;
501 rlc->block_info[1].pi = egprs1->pi;
502 rlc->block_info[1].bsn = rlc->block_info[0].bsn +
Tom Tsoudf698092016-07-11 17:05:19 -0700503 ((egprs1->bsn2_hi << 0) | (egprs1->bsn2_lo << 2));
Aravind Sirsikar99ab0a82016-06-15 17:46:41 +0530504 rlc->block_info[1].bsn = rlc->block_info[1].bsn & (RLC_EGPRS_SNS - 1);
505
506 if ((rlc->block_info[1].bsn != rlc->block_info[0].bsn) &&
507 (rlc->block_info[0].cv == 0))
508 rlc->block_info[0].cv = 1;
509
510 cur_bit = rlc->data_offs_bits[1] - 2;
511
512 offs = rlc->data_offs_bits[1] / 8;
513 OSMO_ASSERT(rlc->data_offs_bits[1] % 8 == 2);
514
515 e_ti_header = (data[offs] & (0x03));
516 rlc->block_info[1].e = (e_ti_header & 0x01);
517 rlc->block_info[1].ti = !!(e_ti_header & 0x02);
518 cur_bit += 2;
519 /* skip data area */
520 cur_bit += cs.maxDataBlockBytes() * 8;
521
522 return cur_bit;
523}
524
Bhargava Abhyankare44383b2016-03-22 18:42:30 +0530525int Decoding::rlc_parse_ul_data_header_gprs(struct gprs_rlc_data_info *rlc,
526 const uint8_t *data, const GprsCodingScheme &cs)
527{
528 const struct rlc_ul_header *gprs;
529 unsigned int cur_bit = 0;
530
531 gprs = static_cast < struct rlc_ul_header * >
532 ((void *)data);
533
534 gprs_rlc_data_info_init_ul(rlc, cs, false);
535
536 rlc->r = gprs->r;
537 rlc->si = gprs->si;
538 rlc->tfi = gprs->tfi;
539 rlc->cps = 0;
540 rlc->rsb = 0;
541 rlc->num_data_blocks = 1;
542 rlc->block_info[0].cv = gprs->cv;
543 rlc->block_info[0].pi = gprs->pi;
544 rlc->block_info[0].bsn = gprs->bsn;
545 rlc->block_info[0].e = gprs->e;
546 rlc->block_info[0].ti = gprs->ti;
547 rlc->block_info[0].spb = 0;
548 cur_bit += rlc->data_offs_bits[0];
549 /* skip data area */
550 cur_bit += cs.maxDataBlockBytes() * 8;
551
552 return cur_bit;
553}
554
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100555/**
556 * \brief Copy LSB bitstream RLC data block to byte aligned buffer.
557 *
558 * Note that the bitstream is encoded in LSB first order, so the two octets
559 * 654321xx xxxxxx87 contain the octet 87654321 starting at bit position 3
560 * (LSB has bit position 1). This is a different order than the one used by
561 * CSN.1.
562 *
563 * \param data_block_idx The block index, 0..1 for header type 1, 0 otherwise
564 * \param src A pointer to the start of the RLC block (incl. the header)
565 * \param buffer A data area of a least the size of the RLC block
566 * \returns the number of bytes copied
567 */
568unsigned int Decoding::rlc_copy_to_aligned_buffer(
Jacob Erlbeckf2ba4cb2016-01-07 18:59:28 +0100569 const struct gprs_rlc_data_info *rlc,
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100570 unsigned int data_block_idx,
571 const uint8_t *src, uint8_t *buffer)
572{
573 unsigned int hdr_bytes;
574 unsigned int extra_bits;
575 unsigned int i;
576
577 uint8_t c, last_c;
578 uint8_t *dst;
Jacob Erlbeckf2ba4cb2016-01-07 18:59:28 +0100579 const struct gprs_rlc_data_block_info *rdbi;
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100580
581 OSMO_ASSERT(data_block_idx < rlc->num_data_blocks);
582 rdbi = &rlc->block_info[data_block_idx];
583
584 hdr_bytes = rlc->data_offs_bits[data_block_idx] >> 3;
585 extra_bits = (rlc->data_offs_bits[data_block_idx] & 7);
586
587 if (extra_bits == 0) {
588 /* It is aligned already */
589 memmove(buffer, src + hdr_bytes, rdbi->data_len);
590 return rdbi->data_len;
591 }
592
593 dst = buffer;
594 src = src + hdr_bytes;
595 last_c = *(src++);
596
597 for (i = 0; i < rdbi->data_len; i++) {
598 c = src[i];
599 *(dst++) = (last_c >> extra_bits) | (c << (8 - extra_bits));
600 last_c = c;
601 }
602
603 return rdbi->data_len;
604}
605
606/**
607 * \brief Get a pointer to byte aligned RLC data.
608 *
609 * Since the RLC data may not be byte aligned to the RLC block data such that a
610 * single RLC data byte is spread over two RLC block bytes, this function
611 * eventually uses the provided buffer as data storage.
612 *
613 * \param src A pointer to the start of the RLC block (incl. the header)
614 * \param buffer A data area of a least the size of the RLC block
615 * \returns A pointer to the RLC data start within src if it is aligned, and
616 * buffer otherwise.
617 */
618const uint8_t *Decoding::rlc_get_data_aligned(
Jacob Erlbeckf2ba4cb2016-01-07 18:59:28 +0100619 const struct gprs_rlc_data_info *rlc,
Jacob Erlbeck4abc6862015-12-08 15:14:05 +0100620 unsigned int data_block_idx,
621 const uint8_t *src, uint8_t *buffer)
622{
623 unsigned int hdr_bytes;
624 unsigned int extra_bits;
625
626 OSMO_ASSERT(data_block_idx < ARRAY_SIZE(rlc->data_offs_bits));
627
628 hdr_bytes = rlc->data_offs_bits[data_block_idx] >> 3;
629 extra_bits = (rlc->data_offs_bits[data_block_idx] & 7);
630
631 if (extra_bits == 0)
632 /* It is aligned already, return a pointer that refers to the
633 * original data. */
634 return src + hdr_bytes;
635
636 Decoding::rlc_copy_to_aligned_buffer(rlc, data_block_idx, src, buffer);
637 return buffer;
638}
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100639
640static int handle_final_ack(bitvec *bits, int *bsn_begin, int *bsn_end,
641 gprs_rlc_dl_window *window)
642{
643 int num_blocks, i;
644
645 num_blocks = window->mod_sns(window->v_s() - window->v_a());
646 for (i = 0; i < num_blocks; i++)
647 bitvec_set_bit(bits, ONE);
648
649 *bsn_begin = window->v_a();
650 *bsn_end = window->mod_sns(*bsn_begin + num_blocks);
651 return num_blocks;
652}
653
654int Decoding::decode_egprs_acknack_bits(const EGPRS_AckNack_Desc_t *desc,
655 bitvec *bits, int *bsn_begin, int *bsn_end, gprs_rlc_dl_window *window)
656{
657 int urbb_len = desc->URBB_LENGTH;
658 int crbb_len = 0;
659 int num_blocks = 0;
660 struct bitvec urbb;
661 int i;
662 bool have_bitmap;
663 int implicitly_acked_blocks;
664 int ssn = desc->STARTING_SEQUENCE_NUMBER;
Jacob Erlbeck2bef4db2016-01-20 14:33:11 +0100665 int rc;
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100666
667 if (desc->FINAL_ACK_INDICATION)
668 return handle_final_ack(bits, bsn_begin, bsn_end, window);
669
670 if (desc->Exist_CRBB)
671 crbb_len = desc->CRBB_LENGTH;
672
673 have_bitmap = (urbb_len + crbb_len) > 0;
674
675 /*
676 * bow & bitmap present:
677 * V(A)-> [ 11111...11111 0 SSN-> BBBBB...BBBBB ] (SSN+Nbits) .... V(S)
678 * bow & not bitmap present:
679 * V(A)-> [ 11111...11111 ] . SSN .... V(S)
680 * not bow & bitmap present:
681 * V(A)-> ... [ 0 SSN-> BBBBB...BBBBB ](SSN+N) .... V(S)
682 * not bow & not bitmap present:
683 * V(A)-> ... [] . SSN .... V(S)
684 */
685
686 if (desc->BEGINNING_OF_WINDOW) {
687 implicitly_acked_blocks = window->mod_sns(ssn - 1 - window->v_a());
688
689 for (i = 0; i < implicitly_acked_blocks; i++)
690 bitvec_set_bit(bits, ONE);
691
692 num_blocks += implicitly_acked_blocks;
693 }
694
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100695 if (!have_bitmap)
696 goto aborted;
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100697
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100698 /* next bit refers to V(Q) and thus is always zero (and not
699 * transmitted) */
700 bitvec_set_bit(bits, ZERO);
701 num_blocks += 1;
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100702
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100703 if (crbb_len > 0) {
704 int old_len = bits->cur_bit;
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100705
Pravin Kumarvel0a4a6c12016-10-17 11:00:57 +0530706 LOGP(DRLCMACDL, LOGL_DEBUG, "Compress bitmap exists, "
707 "CRBB LEN = %d and Starting color code = %d",
708 desc->CRBB_LENGTH, desc->CRBB_STARTING_COLOR_CODE);
709 rc = egprs_compress::decompress_crbb(desc->CRBB_LENGTH,
710 desc->CRBB_STARTING_COLOR_CODE, desc->CRBB, bits);
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100711 if (rc < 0) {
712 LOGP(DRLCMACUL, LOGL_NOTICE,
Pravin Kumarvel0a4a6c12016-10-17 11:00:57 +0530713 "Failed to decode CRBB: length %d, data '%s'\n",
714 desc->CRBB_LENGTH, osmo_hexdump(
715 desc->CRBB, (desc->CRBB_LENGTH + 7)/8));
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100716 /* We don't know the SSN offset for the URBB,
717 * return what we have so far and assume the
718 * bitmap has stopped here */
719 goto aborted;
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100720 }
721
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100722 LOGP(DRLCMACDL, LOGL_DEBUG,
723 "CRBB len: %d, decoded len: %d, cc: %d, crbb: '%s'\n",
724 desc->CRBB_LENGTH, bits->cur_bit - old_len,
725 desc->CRBB_STARTING_COLOR_CODE,
726 osmo_hexdump(
727 desc->CRBB, (desc->CRBB_LENGTH + 7)/8)
728 );
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100729
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100730 num_blocks += (bits->cur_bit - old_len);
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100731 }
732
Jacob Erlbeck3fdcb2b2016-01-18 16:51:59 +0100733 urbb.cur_bit = 0;
734 urbb.data = (uint8_t *)desc->URBB;
735 urbb.data_len = sizeof(desc->URBB);
736
737 for (i = urbb_len; i > 0; i--) {
738 /*
739 * Set bit at the appropriate position (see 3GPP TS
740 * 44.060 12.3.1)
741 */
742 int is_ack = bitvec_get_bit_pos(&urbb, i-1);
743 bitvec_set_bit(bits, is_ack == 1 ? ONE : ZERO);
744 }
745 num_blocks += urbb_len;
746
747aborted:
Jacob Erlbeckae9c5752016-01-13 13:55:44 +0100748 *bsn_begin = window->v_a();
749 *bsn_end = window->mod_sns(*bsn_begin + num_blocks);
750
751 return num_blocks;
752}
Jacob Erlbeck192bf332016-02-05 13:10:29 +0100753
754int Decoding::decode_gprs_acknack_bits(const Ack_Nack_Description_t *desc,
755 bitvec *bits, int *bsn_begin, int *bsn_end, gprs_rlc_dl_window *window)
756{
757 int urbb_len = RLC_GPRS_WS;
758 int num_blocks;
759 struct bitvec urbb;
760
761 if (desc->FINAL_ACK_INDICATION)
762 return handle_final_ack(bits, bsn_begin, bsn_end, window);
763
764 *bsn_begin = window->v_a();
765 *bsn_end = desc->STARTING_SEQUENCE_NUMBER;
766
767 num_blocks = window->mod_sns(*bsn_end - *bsn_begin);
768
769 if (num_blocks < 0 || num_blocks > urbb_len) {
770 *bsn_end = *bsn_begin;
771 LOGP(DRLCMACUL, LOGL_NOTICE,
772 "Invalid GPRS Ack/Nack window %d:%d (length %d)\n",
773 *bsn_begin, *bsn_end, num_blocks);
774 return -EINVAL;
775 }
776
777 urbb.cur_bit = 0;
778 urbb.data = (uint8_t *)desc->RECEIVED_BLOCK_BITMAP;
779 urbb.data_len = sizeof(desc->RECEIVED_BLOCK_BITMAP);
780
781 /*
782 * TS 44.060, 12.3:
783 * BSN = (SSN - bit_number) modulo 128, for bit_number = 1 to 64.
784 * The BSN values represented range from (SSN - 1) mod 128 to (SSN - 64) mod 128.
785 *
786 * We are only interested in the range from V(A) to SSN-1 which is
787 * num_blocks large. The RBB is laid out as
788 * [SSN-1] [SSN-2] ... [V(A)] ... [SSN-64]
789 * so we want to start with [V(A)] and go backwards until we reach
790 * [SSN-1] to get the needed BSNs in an increasing order. Note that
791 * the bit numbers are counted from the end of the buffer.
792 */
793 for (int i = num_blocks; i > 0; i--) {
794 int is_ack = bitvec_get_bit_pos(&urbb, urbb_len - i);
795 bitvec_set_bit(bits, is_ack == 1 ? ONE : ZERO);
796 }
797
798 return num_blocks;
799}