blob: c1b0a001075bad3e94ef9bc7d19d330250d60253 [file] [log] [blame]
Neels Hofmeyr17518fe2017-06-20 04:35:06 +02001/*
Harald Weltee08da972017-11-13 01:00:26 +09002 * (C) 2016 by sysmocom - s.f.m.c. GmbH, Author: Philipp Maier
Philipp Maier22401432017-03-24 17:59:26 +01003 * All Rights Reserved
4 *
Harald Weltee08da972017-11-13 01:00:26 +09005 * SPDX-License-Identifier: GPL-2.0+
Philipp Maier22401432017-03-24 17:59:26 +01006 *
7 * This program is free software; you can redistribute it and/or modify
Harald Weltee08da972017-11-13 01:00:26 +09008 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
Philipp Maier22401432017-03-24 17:59:26 +010010 * (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
Harald Weltee08da972017-11-13 01:00:26 +090015 * GNU General Public License for more details.
Philipp Maier22401432017-03-24 17:59:26 +010016 *
Harald Weltee08da972017-11-13 01:00:26 +090017 * You should have received a copy of the GNU General Public License
Philipp Maier22401432017-03-24 17:59:26 +010018 * along with this program. If not, see <http://www.gnu.org/licenses/>.
19 *
20 */
21
Harald Welte20725b92017-05-15 12:50:04 +020022#include "config.h"
23
Philipp Maier22401432017-03-24 17:59:26 +010024#include <osmocom/core/utils.h>
25#include <osmocom/core/msgb.h>
Harald Welte95871da2017-05-15 12:11:36 +020026#include <osmocom/core/byteswap.h>
Philipp Maier22401432017-03-24 17:59:26 +010027#include <string.h>
Philipp Maier22401432017-03-24 17:59:26 +010028#include <errno.h>
29#include <osmocom/gsm/protocol/gsm_08_08.h>
Stefan Sperling11a4d9d2018-02-15 18:28:04 +010030#include <osmocom/gsm/gsm48.h>
Max5ec0cf52019-01-15 16:37:09 +010031#include <osmocom/gsm/gsm0808.h>
Stefan Sperling11a4d9d2018-02-15 18:28:04 +010032#include <osmocom/gsm/gsm0808_utils.h>
Philipp Maier22401432017-03-24 17:59:26 +010033
34#define IP_V4_ADDR_LEN 4
35#define IP_V6_ADDR_LEN 16
36#define IP_PORT_LEN 2
37
Philipp Maiere0c65302017-03-28 17:05:40 +020038#define CHANNEL_TYPE_ELEMENT_MAXLEN 11
39#define CHANNEL_TYPE_ELEMENT_MINLEN 3
Philipp Maier14e76b92017-03-28 18:36:52 +020040#define ENCRYPT_INFO_ELEMENT_MINLEN 1
Philipp Maier6f725d62017-03-24 18:03:17 +010041
Harald Welte20725b92017-05-15 12:50:04 +020042#ifdef HAVE_SYS_SOCKET_H
43
44#include <sys/socket.h>
45#include <netinet/in.h>
Harald Welte96e2a002017-06-12 21:44:18 +020046
47/*! \addtogroup gsm0808
48 * @{
Harald Welte37b61652017-10-16 18:46:03 +020049 * \file gsm0808_utils.c
Harald Welte96e2a002017-06-12 21:44:18 +020050 */
51
Philipp Maier4f4905f2018-11-30 13:36:12 +010052/*! Encode TS 08.08 AoIP Cause IE
53 * \param[out] msg Message Buffer to which to append IE
54 * \param[in] cause Cause code to be used in IE
55 * \returns number of bytes added to \a msg */
56uint8_t gsm0808_enc_cause(struct msgb *msg, uint16_t cause)
57{
58 /* See also 3GPP TS 48.008 3.2.2.5 Cause */
59 uint8_t *old_tail;
60 bool extended;
61
62 old_tail = msg->tail;
63
64 extended = gsm0808_cause_ext(cause >> 8);
65
66 msgb_put_u8(msg, GSM0808_IE_CAUSE);
67 if (extended) {
68 msgb_put_u8(msg, 2);
69 msgb_put_u16(msg, cause);
70 } else {
71 msgb_put_u8(msg, 1);
72 msgb_put_u8(msg, (uint8_t) (cause & 0xFF));
73 }
74
75 return (uint8_t) (msg->tail - old_tail);
76}
77
Neels Hofmeyr87e45502017-06-20 00:17:59 +020078/*! Encode TS 08.08 AoIP transport address IE
Harald Welte96e2a002017-06-12 21:44:18 +020079 * \param[out] msg Message Buffer to which to append IE
80 * \param[in] ss Socket Address to be used in IE
81 * \returns number of bytes added to \a msg */
Philipp Maier22401432017-03-24 17:59:26 +010082uint8_t gsm0808_enc_aoip_trasp_addr(struct msgb *msg,
83 const struct sockaddr_storage *ss)
84{
85 /* See also 3GPP TS 48.008 3.2.2.102 AoIP Transport Layer Address */
86 struct sockaddr_in *sin;
87 struct sockaddr_in6 *sin6;
88 uint16_t port = 0;
89 uint8_t *ptr;
90 uint8_t *old_tail;
91 uint8_t *tlv_len;
92
93 OSMO_ASSERT(msg);
94 OSMO_ASSERT(ss);
95 OSMO_ASSERT(ss->ss_family == AF_INET || ss->ss_family == AF_INET6);
96
97 msgb_put_u8(msg, GSM0808_IE_AOIP_TRASP_ADDR);
98 tlv_len = msgb_put(msg,1);
99 old_tail = msg->tail;
100
101 switch (ss->ss_family) {
102 case AF_INET:
103 sin = (struct sockaddr_in *)ss;
Harald Welte95871da2017-05-15 12:11:36 +0200104 port = osmo_ntohs(sin->sin_port);
Philipp Maier22401432017-03-24 17:59:26 +0100105 ptr = msgb_put(msg, IP_V4_ADDR_LEN);
106 memcpy(ptr, &sin->sin_addr.s_addr, IP_V4_ADDR_LEN);
107 break;
108 case AF_INET6:
109 sin6 = (struct sockaddr_in6 *)ss;
Harald Welte95871da2017-05-15 12:11:36 +0200110 port = osmo_ntohs(sin6->sin6_port);
Philipp Maier22401432017-03-24 17:59:26 +0100111 ptr = msgb_put(msg, IP_V6_ADDR_LEN);
112 memcpy(ptr, sin6->sin6_addr.s6_addr, IP_V6_ADDR_LEN);
113 break;
114 }
115
116 msgb_put_u16(msg, port);
117
118 *tlv_len = (uint8_t) (msg->tail - old_tail);
119 return *tlv_len + 2;
120}
121
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200122/*! Decode TS 08.08 AoIP transport address IE
Harald Welte96e2a002017-06-12 21:44:18 +0200123 * \param[out] ss Caller-provided memory where decoded socket addr is stored
124 * \param[in] elem pointer to IE value
125 * \param[in] len length of \a elem in bytes
126 * \returns number of bytes parsed */
Philipp Maier22401432017-03-24 17:59:26 +0100127int gsm0808_dec_aoip_trasp_addr(struct sockaddr_storage *ss,
128 const uint8_t *elem, uint8_t len)
129{
130 /* See also 3GPP TS 48.008 3.2.2.102 AoIP Transport Layer Address */
131 struct sockaddr_in sin;
132 struct sockaddr_in6 sin6;
133 const uint8_t *old_elem = elem;
134
135 OSMO_ASSERT(ss);
136 if (!elem)
137 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +0200138 if (len == 0)
Philipp Maier22401432017-03-24 17:59:26 +0100139 return -EINVAL;
140
141 memset(ss, 0, sizeof(*ss));
142
143 switch (len) {
144 case IP_V4_ADDR_LEN + IP_PORT_LEN:
145 memset(&sin, 0, sizeof(sin));
146 sin.sin_family = AF_INET;
147
148 memcpy(&sin.sin_addr.s_addr, elem, IP_V4_ADDR_LEN);
149 elem += IP_V4_ADDR_LEN;
150 sin.sin_port = osmo_load16le(elem);
151 elem += IP_PORT_LEN;
152
153 memcpy(ss, &sin, sizeof(sin));
154 break;
155 case IP_V6_ADDR_LEN + IP_PORT_LEN:
156 memset(&sin6, 0, sizeof(sin6));
157 sin6.sin6_family = AF_INET6;
158
159 memcpy(sin6.sin6_addr.s6_addr, elem, IP_V6_ADDR_LEN);
160 elem += IP_V6_ADDR_LEN;
161 sin6.sin6_port = osmo_load16le(elem);
162 elem += IP_PORT_LEN;
163
164 memcpy(ss, &sin6, sizeof(sin6));
165 break;
166 default:
167 /* Malformed element! */
168 return -EINVAL;
169 break;
170 }
171
172 return (int)(elem - old_elem);
173}
Philipp Maier6f725d62017-03-24 18:03:17 +0100174
Pau Espin Pedrol18506c82019-04-16 15:47:59 +0200175/*! Decode TS 08.08 (Osmocom Extension) Osmux CID
176 * TV with len(V) == 1, and V is the CID to be used.
177 * \param[out] cid Caller-provided variable where CID is stored
178 * \param[in] elem pointer to IE value
179 * \param[in] len length of \a elem in bytes
180 * \returns number of bytes parsed */
181int gsm0808_dec_osmux_cid(uint8_t *cid, const uint8_t *elem, uint8_t len)
182{
183 OSMO_ASSERT(cid);
184 if (!elem)
185 return -EINVAL;
186 if (len != 1)
187 return -EINVAL;
188
189 *cid = *elem;
190
191 return 1;
192}
193
Harald Welte20725b92017-05-15 12:50:04 +0200194#endif /* HAVE_SYS_SOCKET_H */
195
Harald Welteef7be492019-05-03 21:01:13 +0200196/* Decode 5-byte LAI list element data (see TS 08.08 3.2.2.27) into MCC/MNC/LAC. */
197static void decode_lai(const uint8_t *data, struct osmo_location_area_id *decoded)
198{
199 struct gsm48_loc_area_id lai;
200
201 /* Copy data to stack to prevent unaligned access in gsm48_decode_lai2(). */
202 memcpy(&lai, data, sizeof(lai)); /* don't byte swap yet */
203
204 gsm48_decode_lai2(&lai, decoded);
205}
206
Philipp Maier6f725d62017-03-24 18:03:17 +0100207/* Helper function for gsm0808_enc_speech_codec()
208 * and gsm0808_enc_speech_codec_list() */
209static uint8_t enc_speech_codec(struct msgb *msg,
210 const struct gsm0808_speech_codec *sc)
211{
212 /* See also 3GPP TS 48.008 3.2.2.103 Speech Codec List */
213 uint8_t header = 0;
214 uint8_t *old_tail;
Harald Welte459a1802018-06-28 09:24:17 +0200215 bool type_extended = false;
Philipp Maierbb839662017-06-01 17:11:19 +0200216
217 /* Note: Extended codec types are codec types that require 8 instead
218 * of 4 bit to fully specify the selected codec. In the following,
219 * we check if we work with an extended type or not. We also check
220 * if the codec type is valid at all. */
221 switch(sc->type) {
222 case GSM0808_SCT_FR1:
223 case GSM0808_SCT_FR2:
224 case GSM0808_SCT_FR3:
225 case GSM0808_SCT_FR4:
226 case GSM0808_SCT_FR5:
227 case GSM0808_SCT_HR1:
228 case GSM0808_SCT_HR3:
229 case GSM0808_SCT_HR4:
230 case GSM0808_SCT_HR6:
231 type_extended = false;
232 break;
233 case GSM0808_SCT_CSD:
234 type_extended = true;
235 break;
236 default:
237 /* Invalid codec type specified */
238 OSMO_ASSERT(false);
239 break;
240 }
Philipp Maier6f725d62017-03-24 18:03:17 +0100241
242 old_tail = msg->tail;
243
244 if (sc->fi)
245 header |= (1 << 7);
246 if (sc->pi)
247 header |= (1 << 6);
248 if (sc->pt)
249 header |= (1 << 5);
250 if (sc->tf)
251 header |= (1 << 4);
Philipp Maierbb839662017-06-01 17:11:19 +0200252
253 if (type_extended) {
Philipp Maier6f725d62017-03-24 18:03:17 +0100254 header |= 0x0f;
255 msgb_put_u8(msg, header);
Philipp Maierbb839662017-06-01 17:11:19 +0200256 msgb_put_u8(msg, sc->type);
Philipp Maier6f725d62017-03-24 18:03:17 +0100257 } else {
258 OSMO_ASSERT(sc->type < 0x0f);
259 header |= sc->type;
260 msgb_put_u8(msg, header);
Philipp Maier6f725d62017-03-24 18:03:17 +0100261 }
262
Philipp Maierbb839662017-06-01 17:11:19 +0200263 /* Note: Whether a configuration is present or not depends on the
264 * selected codec type. If present, it can either consist of one
265 * or two octets, depending on the codec type */
266 switch (sc->type) {
267 case GSM0808_SCT_FR3:
268 case GSM0808_SCT_HR3:
269 case GSM0808_SCT_HR6:
Philipp Maier7e27b142018-03-22 17:26:46 +0100270 msgb_put_u16(msg, osmo_ntohs(sc->cfg));
Philipp Maierbb839662017-06-01 17:11:19 +0200271 break;
272 case GSM0808_SCT_FR4:
273 case GSM0808_SCT_FR5:
274 case GSM0808_SCT_HR4:
275 case GSM0808_SCT_CSD:
Alexander Couzens4e284b62019-06-23 01:53:43 +0200276 OSMO_ASSERT((sc->cfg & 0xff00) == 0);
Philipp Maierbb839662017-06-01 17:11:19 +0200277 msgb_put_u8(msg, (uint8_t) sc->cfg & 0xff);
278 break;
279 default:
280 OSMO_ASSERT(sc->cfg == 0);
281 break;
282 }
Philipp Maier6f725d62017-03-24 18:03:17 +0100283
284 return (uint8_t) (msg->tail - old_tail);
285}
286
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200287/*! Encode TS 08.08 Speech Codec IE
Harald Welte96e2a002017-06-12 21:44:18 +0200288 * \param[out] msg Message Buffer to which IE will be appended
289 * \param[in] sc Speech Codec to be encoded into IE
290 * \returns number of bytes appended to \a msg */
Philipp Maier6f725d62017-03-24 18:03:17 +0100291uint8_t gsm0808_enc_speech_codec(struct msgb *msg,
292 const struct gsm0808_speech_codec *sc)
293{
Philipp Maier452a6bb2017-06-23 00:29:34 +0200294 /*! See also 3GPP TS 48.008 3.2.2.103 Speech Codec List */
Philipp Maier6f725d62017-03-24 18:03:17 +0100295 uint8_t *old_tail;
296 uint8_t *tlv_len;
297
298 OSMO_ASSERT(msg);
299 OSMO_ASSERT(sc);
300
301 msgb_put_u8(msg, GSM0808_IE_SPEECH_CODEC);
302 tlv_len = msgb_put(msg, 1);
303 old_tail = msg->tail;
304
305 enc_speech_codec(msg, sc);
306
307 *tlv_len = (uint8_t) (msg->tail - old_tail);
308 return *tlv_len + 2;
309}
310
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200311/*! Decode TS 08.08 Speech Codec IE
Harald Welte96e2a002017-06-12 21:44:18 +0200312 * \param[out] sc Caller-allocated memory for Speech Codec
313 * \param[in] elem IE value to be decoded
314 * \param[in] len Length of \a elem in bytes
315 * \returns number of bytes parsed; negative on error */
Philipp Maier6f725d62017-03-24 18:03:17 +0100316int gsm0808_dec_speech_codec(struct gsm0808_speech_codec *sc,
317 const uint8_t *elem, uint8_t len)
318{
319 /* See also 3GPP TS 48.008 3.2.2.103 Speech Codec List */
320 uint8_t header;
321 const uint8_t *old_elem = elem;
322
323 OSMO_ASSERT(sc);
324 if (!elem)
325 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +0200326 if (len == 0)
Philipp Maier6f725d62017-03-24 18:03:17 +0100327 return -EINVAL;
328
329 memset(sc, 0, sizeof(*sc));
330
331 header = *elem;
332
Philipp Maier85a6af22017-04-28 10:55:05 +0200333 /* An extended codec type needs at least two fields,
334 * bail if the input data length is not sufficient. */
Philipp Maier6f725d62017-03-24 18:03:17 +0100335 if ((header & 0x0F) == 0x0F && len < 2)
336 return -EINVAL;
Philipp Maier6f725d62017-03-24 18:03:17 +0100337
338 elem++;
339 len--;
340
341 if (header & (1 << 7))
342 sc->fi = true;
343 if (header & (1 << 6))
344 sc->pi = true;
345 if (header & (1 << 5))
346 sc->pt = true;
347 if (header & (1 << 4))
348 sc->tf = true;
349
350 if ((header & 0x0F) != 0x0F) {
351 sc->type = (header & 0x0F);
Philipp Maierbb839662017-06-01 17:11:19 +0200352 } else {
353 sc->type = *elem;
354 elem++;
355 len--;
Philipp Maier6f725d62017-03-24 18:03:17 +0100356 }
357
Philipp Maierbb839662017-06-01 17:11:19 +0200358 /* Note: Whether a configuration is present or not depends on the
359 * selected codec type. If present, it can either consist of one or
360 * two octets depending on the codec type */
361 switch (sc->type) {
362 case GSM0808_SCT_FR1:
363 case GSM0808_SCT_FR2:
364 case GSM0808_SCT_HR1:
365 break;
366 case GSM0808_SCT_HR4:
367 case GSM0808_SCT_CSD:
368 case GSM0808_SCT_FR4:
369 case GSM0808_SCT_FR5:
370 if (len < 1)
371 return -EINVAL;
372 sc->cfg = *elem;
373 elem++;
374 break;
375 case GSM0808_SCT_FR3:
376 case GSM0808_SCT_HR3:
377 case GSM0808_SCT_HR6:
378 if (len < 2)
379 return -EINVAL;
Philipp Maier7e27b142018-03-22 17:26:46 +0100380 sc->cfg = osmo_load16le(elem);
Philipp Maierbb839662017-06-01 17:11:19 +0200381 elem += 2;
382 break;
383 default:
384 /* Invalid codec type => malformed speech codec element! */
385 return -EINVAL;
386 break;
387 }
Philipp Maier6f725d62017-03-24 18:03:17 +0100388
389 return (int)(elem - old_elem);
390}
391
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200392/*! Encode TS 08.08 Speech Codec list
Harald Welte96e2a002017-06-12 21:44:18 +0200393 * \param[out] msg Message Buffer to which IE is to be appended
394 * \param[in] scl Speech Codec List to be encoded into IE
395 * \returns number of bytes added to \a msg */
Philipp Maier6f725d62017-03-24 18:03:17 +0100396uint8_t gsm0808_enc_speech_codec_list(struct msgb *msg,
397 const struct gsm0808_speech_codec_list *scl)
398{
Philipp Maier452a6bb2017-06-23 00:29:34 +0200399 /*! See also 3GPP TS 48.008 3.2.2.103 Speech Codec List */
Philipp Maier6f725d62017-03-24 18:03:17 +0100400 uint8_t *old_tail;
401 uint8_t *tlv_len;
402 unsigned int i;
403 uint8_t rc;
404 unsigned int bytes_used = 0;
405
406 OSMO_ASSERT(msg);
407 OSMO_ASSERT(scl);
408
Philipp Maier6f725d62017-03-24 18:03:17 +0100409 msgb_put_u8(msg, GSM0808_IE_SPEECH_CODEC_LIST);
410 tlv_len = msgb_put(msg, 1);
411 old_tail = msg->tail;
412
413 for (i = 0; i < scl->len; i++) {
414 rc = enc_speech_codec(msg, &scl->codec[i]);
415 OSMO_ASSERT(rc >= 1);
416 bytes_used += rc;
417 OSMO_ASSERT(bytes_used <= 255);
418 }
419
420 *tlv_len = (uint8_t) (msg->tail - old_tail);
421 return *tlv_len + 2;
422}
423
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200424/*! Decode TS 08.08 Speech Codec list IE
Harald Welte96e2a002017-06-12 21:44:18 +0200425 * \param[out] scl Caller-provided memory to store codec list
426 * \param[in] elem IE value to be decoded
427 * \param[in] len Length of \a elem in bytes
428 * \returns number of bytes parsed; negative on error */
Philipp Maier6f725d62017-03-24 18:03:17 +0100429int gsm0808_dec_speech_codec_list(struct gsm0808_speech_codec_list *scl,
430 const uint8_t *elem, uint8_t len)
431{
Philipp Maier452a6bb2017-06-23 00:29:34 +0200432 /*! See also 3GPP TS 48.008 3.2.2.103 Speech Codec List */
Philipp Maier6f725d62017-03-24 18:03:17 +0100433 const uint8_t *old_elem = elem;
434 unsigned int i;
435 int rc;
436 uint8_t decoded = 0;
437
438 OSMO_ASSERT(scl);
439 if (!elem)
440 return -EINVAL;
Philipp Maier6f725d62017-03-24 18:03:17 +0100441
442 memset(scl, 0, sizeof(*scl));
443
444 for (i = 0; i < ARRAY_SIZE(scl->codec); i++) {
445 if (len <= 0)
446 break;
447
448 rc = gsm0808_dec_speech_codec(&scl->codec[i], elem, len);
449 if (rc < 1)
450 return -EINVAL;
451
452 elem+=rc;
453 len -= rc;
454 decoded++;
455 }
456
457 scl->len = decoded;
458
Philipp Maier6f725d62017-03-24 18:03:17 +0100459 return (int)(elem - old_elem);
460}
Philipp Maiere0c65302017-03-28 17:05:40 +0200461
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200462/*! Encode TS 08.08 Channel Type IE
Harald Welte96e2a002017-06-12 21:44:18 +0200463 * \param[out] msg Message Buffer to which IE is to be appended
464 * \param[in] ct Channel Type to be encoded
465 * \returns number of bytes added to \a msg */
Philipp Maiere0c65302017-03-28 17:05:40 +0200466uint8_t gsm0808_enc_channel_type(struct msgb *msg,
467 const struct gsm0808_channel_type *ct)
468{
Philipp Maier452a6bb2017-06-23 00:29:34 +0200469 /*! See also 3GPP TS 48.008 3.2.2.11 Channel Type */
Philipp Maiere0c65302017-03-28 17:05:40 +0200470 unsigned int i;
471 uint8_t byte;
472 uint8_t *old_tail;
473 uint8_t *tlv_len;
474
475 OSMO_ASSERT(msg);
476 OSMO_ASSERT(ct);
477 OSMO_ASSERT(ct->perm_spch_len <= CHANNEL_TYPE_ELEMENT_MAXLEN - 2);
478
479 /* FIXME: Implement encoding support for Data
480 * and Speech + CTM Text Telephony */
481 if ((ct->ch_indctr & 0x0f) != GSM0808_CHAN_SPEECH
482 && (ct->ch_indctr & 0x0f) != GSM0808_CHAN_SIGN)
483 OSMO_ASSERT(false);
484
485 msgb_put_u8(msg, GSM0808_IE_CHANNEL_TYPE);
486 tlv_len = msgb_put(msg, 1);
487 old_tail = msg->tail;
488
489 msgb_put_u8(msg, ct->ch_indctr & 0x0f);
490 msgb_put_u8(msg, ct->ch_rate_type);
491
492 for (i = 0; i < ct->perm_spch_len; i++) {
493 byte = ct->perm_spch[i];
494
495 if (i < ct->perm_spch_len - 1)
496 byte |= 0x80;
497 msgb_put_u8(msg, byte);
498 }
499
500 *tlv_len = (uint8_t) (msg->tail - old_tail);
501 return *tlv_len + 2;
502}
503
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200504/*! Decode TS 08.08 Channel Type IE
Harald Welte96e2a002017-06-12 21:44:18 +0200505 * \param[out] ct Caller-provided memory to store channel type
506 * \param[in] elem IE Value to be decoded
507 * \param[in] len Length of \a elem in bytes
508 * \returns number of bytes parsed; negative on error */
Philipp Maiere0c65302017-03-28 17:05:40 +0200509int gsm0808_dec_channel_type(struct gsm0808_channel_type *ct,
510 const uint8_t *elem, uint8_t len)
511{
Philipp Maier452a6bb2017-06-23 00:29:34 +0200512 /*! See also 3GPP TS 48.008 3.2.2.11 Channel Type */
Philipp Maiere0c65302017-03-28 17:05:40 +0200513 unsigned int i;
514 uint8_t byte;
515 const uint8_t *old_elem = elem;
516
517 OSMO_ASSERT(ct);
518 if (!elem)
519 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +0200520 if (len < 3 || len > 11)
Philipp Maiere0c65302017-03-28 17:05:40 +0200521 return -EINVAL;
522
523 memset(ct, 0, sizeof(*ct));
524
525 ct->ch_indctr = (*elem) & 0x0f;
526 elem++;
527 ct->ch_rate_type = (*elem) & 0x0f;
528 elem++;
529
530 for (i = 0; i < ARRAY_SIZE(ct->perm_spch); i++) {
531 byte = *elem;
532 elem++;
533 ct->perm_spch[i] = byte & 0x7f;
534 if ((byte & 0x80) == 0x00)
535 break;
536 }
537 ct->perm_spch_len = i + 1;
538
539 return (int)(elem - old_elem);
540}
Philipp Maier14e76b92017-03-28 18:36:52 +0200541
Max969fb2e2018-12-10 11:01:10 +0100542/*! Create BSSMAP Global Call Reference, 3GPP TS 48.008 §3.2.2.115.
543 * \param[out] msg Message Buffer for appending IE
544 * \param[in] g Global Call Reference, 3GPP TS 29.205 Table B 2.1.9.1
545 * \returns number of bytes added to \a msg or 0 on error */
Max47022152018-12-19 18:51:00 +0100546static uint8_t gsm0808_enc_gcr(struct msgb *msg, const struct osmo_gcr_parsed *g)
Max969fb2e2018-12-10 11:01:10 +0100547{
548 uint8_t enc, *len = msgb_tl_put(msg, GSM0808_IE_GLOBAL_CALL_REF);
549
550 enc = osmo_enc_gcr(msg, g);
551 if (!enc)
552 return 0;
553
554 *len = enc;
555 return enc + 2; /* type (1 byte) + length (1 byte) */
556}
557
558/*! Decode BSSMAP Global Call Reference, 3GPP TS 29.205 Table B 2.1.9.1.
559 * \param[out] gcr Caller-provided memory to store Global Call Reference
Max036012b2018-12-19 17:48:56 +0100560 * \param[in] tp IE values to be decoded
Max969fb2e2018-12-10 11:01:10 +0100561 * \returns number of bytes parsed; negative on error */
Max47022152018-12-19 18:51:00 +0100562static int gsm0808_dec_gcr(struct osmo_gcr_parsed *gcr, const struct tlv_parsed *tp)
Max969fb2e2018-12-10 11:01:10 +0100563{
564 int ret;
565 const uint8_t *buf = TLVP_VAL_MINLEN(tp, GSM0808_IE_GLOBAL_CALL_REF, OSMO_GCR_MIN_LEN);
566 if (!buf)
567 return -EINVAL;
568
569 ret = osmo_dec_gcr(gcr, buf, TLVP_LEN(tp, GSM0808_IE_GLOBAL_CALL_REF));
570 if (ret < 0)
571 return -ENOENT;
572
573 return 2 + ret;
574}
575
Max47022152018-12-19 18:51:00 +0100576/*! Add LCLS parameters to a given msgb, 3GPP TS 48.008 §3.2.2.115 - 3.2.2.120.
577 * \param[out] msg Message Buffer for appending IE
578 * \param[in] lcls LCLS-related data
579 * \returns number of bytes added to \a msg or 0 on error */
580uint8_t gsm0808_enc_lcls(struct msgb *msg, const struct osmo_lcls *lcls)
581{
582 uint8_t enc = 0;
583
584 /* LCLS: §3.2.2.115 Global Call Reference */
Max3b901252019-01-15 14:15:11 +0100585 if (lcls->gcr_available)
586 enc = gsm0808_enc_gcr(msg, &lcls->gcr);
Max47022152018-12-19 18:51:00 +0100587
588 /* LCLS: §3.2.2.116 Configuration */
589 if (lcls->config != GSM0808_LCLS_CFG_NA) {
590 msgb_tv_put(msg, GSM0808_IE_LCLS_CONFIG, lcls->config);
591 enc += 2;
592 }
593
594 /* LCLS: §3.2.2.117 Connection Status Control */
595 if (lcls->control != GSM0808_LCLS_CSC_NA) {
596 msgb_tv_put(msg, GSM0808_IE_LCLS_CONN_STATUS_CTRL, lcls->control);
597 enc += 2;
598 }
599
600 /* LCLS: §3.2.2.118 Correlation-Not-Needed */
601 if (!lcls->corr_needed) {
602 msgb_v_put(msg, GSM0808_IE_LCLS_CORR_NOT_NEEDED);
603 enc++;
604 }
605
606 return enc;
607}
608
609/*! Decode LCLS parameters to a given msgb, 3GPP TS 48.008 §3.2.2.115 - 3.2.2.120.
610 * \param[out] lcls Caller-provided memory to store LCLS-related data
611 * \param[in] tp IE values to be decoded
612 * \returns GCR size or negative on error */
613int gsm0808_dec_lcls(struct osmo_lcls *lcls, const struct tlv_parsed *tp)
614{
Max3b901252019-01-15 14:15:11 +0100615 int ret = gsm0808_dec_gcr(&lcls->gcr, tp);
Max47022152018-12-19 18:51:00 +0100616
Max3b901252019-01-15 14:15:11 +0100617 lcls->gcr_available = (ret < 0) ? false : true;
Max47022152018-12-19 18:51:00 +0100618 lcls->config = tlvp_val8(tp, GSM0808_IE_LCLS_CONFIG, GSM0808_LCLS_CFG_NA);
619 lcls->control = tlvp_val8(tp, GSM0808_IE_LCLS_CONN_STATUS_CTRL, GSM0808_LCLS_CSC_NA);
620 lcls->corr_needed = TLVP_PRESENT(tp, GSM0808_IE_LCLS_CORR_NOT_NEEDED) ? false : true;
621
622 return ret;
623}
624
Harald Welte171ef822019-03-28 10:49:05 +0100625static __thread char dbuf[256];
Max5ec0cf52019-01-15 16:37:09 +0100626
627/*! Dump LCLS parameters (GCR excluded) into string for printing.
Harald Welte4a62eda2019-03-18 18:27:00 +0100628 * \param[out] buf caller-allocated output string buffer
629 * \param[in] buf_len size of buf in bytes
Max5ec0cf52019-01-15 16:37:09 +0100630 * \param[in] lcls pointer to the struct to print.
631 * \returns string representation of LCLS or NULL on error. */
Harald Welte4a62eda2019-03-18 18:27:00 +0100632char *osmo_lcls_dump_buf(char *buf, size_t buf_len, const struct osmo_lcls *lcls)
Max5ec0cf52019-01-15 16:37:09 +0100633{
Harald Welte4a62eda2019-03-18 18:27:00 +0100634 struct osmo_strbuf s = { .buf = buf, .len = buf_len };
Max5ec0cf52019-01-15 16:37:09 +0100635
636 if (!lcls)
637 return NULL;
638
639 OSMO_STRBUF_PRINTF(s, "LCLS Config: %s, Control: %s, Correlation-Needed: %u",
640 gsm0808_lcls_config_name(lcls->config),
641 gsm0808_lcls_control_name(lcls->control),
642 lcls->corr_needed);
643
644 return dbuf;
645}
646
Harald Welte4a62eda2019-03-18 18:27:00 +0100647/*! Dump LCLS parameters (GCR excluded) into static string buffer for printing.
648 * \param[in] lcls pointer to the struct to print.
649 * \returns string representation of LCLS in static buffer or NULL on error. */
650char *osmo_lcls_dump(const struct osmo_lcls *lcls)
651{
652 return osmo_lcls_dump_buf(dbuf, sizeof(dbuf), lcls);
653}
654
Harald Welte179f3572019-03-18 18:38:47 +0100655char *osmo_lcls_dump_c(void *ctx, const struct osmo_lcls *lcls)
656{
657 char *buf = talloc_size(ctx, 256);
658 if (!buf)
659 return NULL;
660 return osmo_lcls_dump_buf(buf, 256, lcls);
661}
662
Max5ec0cf52019-01-15 16:37:09 +0100663/*! Dump GCR struct into string for printing.
Harald Welte4a62eda2019-03-18 18:27:00 +0100664 * \param[out] buf caller-allocated output string buffer
665 * \param[in] buf_len size of buf in bytes
Max5ec0cf52019-01-15 16:37:09 +0100666 * \param[in] lcls pointer to the struct to print.
667 * \returns string representation of GCR or NULL on error. */
Harald Welte4a62eda2019-03-18 18:27:00 +0100668char *osmo_gcr_dump_buf(char *buf, size_t buf_len, const struct osmo_lcls *lcls)
Max5ec0cf52019-01-15 16:37:09 +0100669{
Harald Welte4a62eda2019-03-18 18:27:00 +0100670 struct osmo_strbuf s = { .buf = buf, .len = buf_len };
Max5ec0cf52019-01-15 16:37:09 +0100671
672 if (!lcls)
673 return NULL;
674
675 if (lcls->gcr_available) {
676 OSMO_STRBUF_PRINTF(s, "GCR NetID 0x%s, ", osmo_hexdump_nospc(lcls->gcr.net, lcls->gcr.net_len));
677 /* osmo_hexdump() uses static buffers so we can't call it twice withing the same parameter list */
678 OSMO_STRBUF_PRINTF(s, "Node 0x%x, CallRefID 0x%s", lcls->gcr.node, osmo_hexdump_nospc(lcls->gcr.cr, 5));
679 }
680
681 return dbuf;
682}
683
Harald Welte4a62eda2019-03-18 18:27:00 +0100684/*! Dump GCR struct into static string buffer for printing.
685 * \param[in] lcls pointer to the struct to print.
686 * \returns string representation of GCR in static buffer or NULL on error. */
687char *osmo_gcr_dump(const struct osmo_lcls *lcls)
688{
689 return osmo_gcr_dump_buf(dbuf, sizeof(dbuf), lcls);
690}
691
692
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200693/*! Encode TS 08.08 Encryption Information IE
Harald Welte96e2a002017-06-12 21:44:18 +0200694 * \param[out] msg Message Buffer to which IE is to be appended
695 * \param[in] ei Encryption Information to be encoded
696 * \returns number of bytes appended to \a msg */
Philipp Maier14e76b92017-03-28 18:36:52 +0200697uint8_t gsm0808_enc_encrypt_info(struct msgb *msg,
698 const struct gsm0808_encrypt_info *ei)
699{
700 unsigned int i;
701 uint8_t perm_algo = 0;
702 uint8_t *ptr;
703 uint8_t *old_tail;
704 uint8_t *tlv_len;
705
706 OSMO_ASSERT(msg);
707 OSMO_ASSERT(ei);
708 OSMO_ASSERT(ei->key_len <= ARRAY_SIZE(ei->key));
709 OSMO_ASSERT(ei->perm_algo_len <= ENCRY_INFO_PERM_ALGO_MAXLEN);
710
711 msgb_put_u8(msg, GSM0808_IE_ENCRYPTION_INFORMATION);
712 tlv_len = msgb_put(msg, 1);
713 old_tail = msg->tail;
714
715 for (i = 0; i < ei->perm_algo_len; i++) {
716 /* Note: gsm_08_08.h defines the permitted algorithms
717 * as an enum which ranges from 0x01 to 0x08 */
718 OSMO_ASSERT(ei->perm_algo[i] != 0);
719 OSMO_ASSERT(ei->perm_algo[i] <= ENCRY_INFO_PERM_ALGO_MAXLEN);
720 perm_algo |= (1 << (ei->perm_algo[i] - 1));
721 }
722
723 msgb_put_u8(msg, perm_algo);
724 ptr = msgb_put(msg, ei->key_len);
725 memcpy(ptr, ei->key, ei->key_len);
726
727 *tlv_len = (uint8_t) (msg->tail - old_tail);
728 return *tlv_len + 2;
729}
730
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200731/*! Decode TS 08.08 Encryption Information IE
Harald Welte96e2a002017-06-12 21:44:18 +0200732 * \param[out] ei Caller-provided memory to store encryption information
733 * \param[in] elem IE value to be decoded
734 * \param[in] len Length of \a elem in bytes
735 * \returns number of bytes parsed; negative on error */
Philipp Maier14e76b92017-03-28 18:36:52 +0200736int gsm0808_dec_encrypt_info(struct gsm0808_encrypt_info *ei,
737 const uint8_t *elem, uint8_t len)
738{
739 uint8_t perm_algo;
740 unsigned int i;
741 unsigned int perm_algo_len = 0;
742 const uint8_t *old_elem = elem;
743
744 OSMO_ASSERT(ei);
745 if (!elem)
746 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +0200747 if (len == 0)
Philipp Maier14e76b92017-03-28 18:36:52 +0200748 return -EINVAL;
749
750 memset(ei, 0, sizeof(*ei));
751
752 perm_algo = *elem;
753 elem++;
754
755 for (i = 0; i < ENCRY_INFO_PERM_ALGO_MAXLEN; i++) {
756 if (perm_algo & (1 << i)) {
757 ei->perm_algo[perm_algo_len] = i + 1;
758 perm_algo_len++;
759 }
760 }
761 ei->perm_algo_len = perm_algo_len;
762
763 ei->key_len = len - 1;
764 memcpy(ei->key, elem, ei->key_len);
765 elem+=ei->key_len;
766
767 return (int)(elem - old_elem);
768}
Philipp Maier783047e2017-03-29 11:35:50 +0200769
Harald Weltef2210032019-08-31 21:25:05 +0200770/* Return the size of the value part of a cell identifier of given type */
771int gsm0808_cell_id_size(enum CELL_IDENT discr)
772{
773 switch (discr) {
774 case CELL_IDENT_WHOLE_GLOBAL:
775 return 7;
776 case CELL_IDENT_LAC_AND_CI:
777 return 4;
778 case CELL_IDENT_CI:
779 return 2;
780 case CELL_IDENT_LAI_AND_LAC:
781 return 5;
782 case CELL_IDENT_LAC:
783 return 2;
784 case CELL_IDENT_BSS:
785 case CELL_IDENT_NO_CELL:
786 return 0;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100787 case CELL_IDENT_WHOLE_GLOBAL_PS:
788 return 8;
Harald Weltef2210032019-08-31 21:25:05 +0200789 default:
790 return -EINVAL;
791 }
792}
Harald Welteef7be492019-05-03 21:01:13 +0200793/*! Decode a single GSM 08.08 Cell ID list element payload
794 * \param[out] out caller-provided output union
795 * \param[in] discr Cell ID discriminator describing type to be decoded
796 * \param[in] buf User-provided input buffer containing binary Cell ID list element
797 * \param[in] len Length of buf
798 * \returns 0 on success; negative on error */
799int gsm0808_decode_cell_id_u(union gsm0808_cell_id_u *out, enum CELL_IDENT discr, const uint8_t *buf, unsigned int len)
800{
801 switch (discr) {
802 case CELL_IDENT_WHOLE_GLOBAL:
803 if (len < 7)
804 return -EINVAL;
805 decode_lai(buf, &out->global.lai);
806 out->global.cell_identity = osmo_load16be(buf + sizeof(struct gsm48_loc_area_id));
807 break;
808 case CELL_IDENT_LAC_AND_CI:
809 if (len < 4)
810 return -EINVAL;
811 out->lac_and_ci.lac = osmo_load16be(buf);
812 out->lac_and_ci.ci = osmo_load16be(buf + sizeof(uint16_t));
813 break;
814 case CELL_IDENT_CI:
815 if (len < 2)
816 return -EINVAL;
817 out->ci = osmo_load16be(buf);
818 break;
819 case CELL_IDENT_LAI_AND_LAC:
820 if (len < 5)
821 return -EINVAL;
822 decode_lai(buf, &out->lai_and_lac);
823 break;
824 case CELL_IDENT_LAC:
825 if (len < 2)
826 return -EINVAL;
827 out->lac = osmo_load16be(buf);
828 break;
829 case CELL_IDENT_BSS:
830 case CELL_IDENT_NO_CELL:
831 /* Does not have any list items */
832 break;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100833 case CELL_IDENT_WHOLE_GLOBAL_PS:
834 if (len < 8)
835 return -EINVAL;
836 decode_lai(buf, (struct osmo_location_area_id *)&out->global_ps.rai); /* rai contains lai + non-decoded rac */
837 out->global_ps.rai.rac = *(buf + sizeof(struct gsm48_loc_area_id));
838 out->global_ps.cell_identity = osmo_load16be(buf + sizeof(struct gsm48_loc_area_id) + 1);
839 break;
Harald Welteef7be492019-05-03 21:01:13 +0200840 default:
841 /* Remaining cell identification types are not implemented. */
842 return -EINVAL;
843 }
844 return 0;
845}
846
Harald Weltee87693c2019-05-03 20:06:50 +0200847void gsm0808_msgb_put_cell_id_u(struct msgb *msg, enum CELL_IDENT id_discr, const union gsm0808_cell_id_u *u)
848{
849 switch (id_discr) {
850 case CELL_IDENT_WHOLE_GLOBAL: {
851 const struct osmo_cell_global_id *id = &u->global;
852 struct gsm48_loc_area_id lai;
853 gsm48_generate_lai2(&lai, &id->lai);
854 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
855 msgb_put_u16(msg, id->cell_identity);
856 break;
857 }
858 case CELL_IDENT_LAC_AND_CI: {
859 const struct osmo_lac_and_ci_id *id = &u->lac_and_ci;
860 msgb_put_u16(msg, id->lac);
861 msgb_put_u16(msg, id->ci);
862 break;
863 }
864 case CELL_IDENT_CI:
865 msgb_put_u16(msg, u->ci);
866 break;
867 case CELL_IDENT_LAI_AND_LAC: {
868 const struct osmo_location_area_id *id = &u->lai_and_lac;
869 struct gsm48_loc_area_id lai;
870 gsm48_generate_lai2(&lai, id);
871 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
872 break;
873 }
874 case CELL_IDENT_LAC:
875 msgb_put_u16(msg, u->lac);
876 break;
877 case CELL_IDENT_BSS:
878 case CELL_IDENT_NO_CELL:
879 /* Does not have any list items */
880 break;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100881 case CELL_IDENT_WHOLE_GLOBAL_PS: {
882 const struct osmo_cell_global_id_ps *id = &u->global_ps;
883 struct gsm48_loc_area_id lai;
884 gsm48_generate_lai2(&lai, &id->rai.lac);
885 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
886 memcpy(msgb_put(msg, 1), &id->rai.rac, 1);
887 msgb_put_u16(msg, id->cell_identity);
888 break;
889 }
Harald Weltee87693c2019-05-03 20:06:50 +0200890 default:
891 /* Support for other identifier list types is not implemented. */
892 OSMO_ASSERT(false);
893 }
894}
895
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200896/*! Encode TS 08.08 Cell Identifier List IE
Harald Welte96e2a002017-06-12 21:44:18 +0200897 * \param[out] msg Message Buffer to which IE is to be appended
898 * \param[in] cil Cell ID List to be encoded
899 * \returns number of bytes appended to \a msg */
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100900uint8_t gsm0808_enc_cell_id_list2(struct msgb *msg,
901 const struct gsm0808_cell_id_list2 *cil)
902{
903 uint8_t *old_tail;
904 uint8_t *tlv_len;
905 unsigned int i;
906
907 OSMO_ASSERT(msg);
908 OSMO_ASSERT(cil);
909
910 msgb_put_u8(msg, GSM0808_IE_CELL_IDENTIFIER_LIST);
911 tlv_len = msgb_put(msg, 1);
912 old_tail = msg->tail;
913
914 msgb_put_u8(msg, cil->id_discr & 0x0f);
915
Alexander Couzens4e284b62019-06-23 01:53:43 +0200916 OSMO_ASSERT(cil->id_list_len <= GSM0808_CELL_ID_LIST2_MAXLEN);
Harald Weltee87693c2019-05-03 20:06:50 +0200917 for (i = 0; i < cil->id_list_len; i++)
918 gsm0808_msgb_put_cell_id_u(msg, cil->id_discr, &cil->id_list[i]);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100919
920 *tlv_len = (uint8_t) (msg->tail - old_tail);
921 return *tlv_len + 2;
922}
923
924/*! DEPRECATED: Use gsm0808_enc_cell_id_list2 instead.
925 *
926 * Encode TS 08.08 Cell Identifier List IE
927 * \param[out] msg Message Buffer to which IE is to be appended
928 * \param[in] cil Cell ID List to be encoded
929 * \returns number of bytes appended to \a msg */
Philipp Maier783047e2017-03-29 11:35:50 +0200930uint8_t gsm0808_enc_cell_id_list(struct msgb *msg,
931 const struct gsm0808_cell_id_list *cil)
932{
933 uint8_t *old_tail;
934 uint8_t *tlv_len;
935 unsigned int i;
936
937 OSMO_ASSERT(msg);
938 OSMO_ASSERT(cil);
939
940 msgb_put_u8(msg, GSM0808_IE_CELL_IDENTIFIER_LIST);
941 tlv_len = msgb_put(msg, 1);
942 old_tail = msg->tail;
943
944 msgb_put_u8(msg, cil->id_discr & 0x0f);
945
946 switch (cil->id_discr) {
947 case CELL_IDENT_LAC:
Alexander Couzens4e284b62019-06-23 01:53:43 +0200948 OSMO_ASSERT(cil->id_list_len <= CELL_ID_LIST_LAC_MAXLEN);
Philipp Maier783047e2017-03-29 11:35:50 +0200949 for (i=0;i<cil->id_list_len;i++) {
950 msgb_put_u16(msg, cil->id_list_lac[i]);
951 }
952 break;
953 case CELL_IDENT_BSS:
954 /* Does not have any list items */
955 break;
956 default:
957 /* FIXME: Implement support for all identifier list elements */
958 OSMO_ASSERT(false);
959 }
960
961 *tlv_len = (uint8_t) (msg->tail - old_tail);
962 return *tlv_len + 2;
963}
964
Stefan Sperlinge1a86742018-03-15 18:05:02 +0100965static int parse_cell_id_global_list(struct gsm0808_cell_id_list2 *cil, const uint8_t *data, size_t remain,
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100966 size_t *consumed)
967{
968 struct osmo_cell_global_id *id;
969 uint16_t *ci_be;
970 size_t lai_offset;
971 int i = 0;
972 const size_t elemlen = sizeof(struct gsm48_loc_area_id) + sizeof(*ci_be);
973
974 *consumed = 0;
975 while (remain >= elemlen) {
976 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
977 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +0100978 id = &cil->id_list[i].global;
Stefan Sperling2873bf12018-03-14 18:38:41 +0100979 lai_offset = i * elemlen;
Stefan Sperling23381452018-03-15 19:38:15 +0100980 decode_lai(&data[lai_offset], &id->lai);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100981 ci_be = (uint16_t *)(&data[lai_offset + sizeof(struct gsm48_loc_area_id)]);
982 id->cell_identity = osmo_load16be(ci_be);
983 *consumed += elemlen;
984 remain -= elemlen;
985 i++;
986 }
987
988 return i;
989}
990
Stefan Sperlinge1a86742018-03-15 18:05:02 +0100991static int parse_cell_id_lac_and_ci_list(struct gsm0808_cell_id_list2 *cil, const uint8_t *data, size_t remain,
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100992 size_t *consumed)
993{
994 uint16_t *lacp_be, *ci_be;
995 struct osmo_lac_and_ci_id *id;
Stefan Sperlinged4327c2018-03-16 11:02:59 +0100996 int i = 0, j = 0;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100997 const size_t elemlen = sizeof(*lacp_be) + sizeof(*ci_be);
998
999 *consumed = 0;
1000
1001 if (remain < elemlen)
1002 return -EINVAL;
1003
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001004 lacp_be = (uint16_t *)(&data[j]);
1005 ci_be = (uint16_t *)(&data[j + elemlen/2]);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001006 while (remain >= elemlen) {
1007 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1008 return -ENOSPC;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001009 id = &cil->id_list[i++].lac_and_ci;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001010 id->lac = osmo_load16be(lacp_be);
1011 id->ci = osmo_load16be(ci_be);
1012 *consumed += elemlen;
1013 remain -= elemlen;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001014 j += elemlen;
1015 lacp_be = (uint16_t *)(&data[j]);
1016 ci_be = (uint16_t *)(&data[j + elemlen/2]);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001017 }
1018
1019 return i;
1020}
1021
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001022static int parse_cell_id_ci_list(struct gsm0808_cell_id_list2 *cil, const uint8_t *data, size_t remain,
1023 size_t *consumed)
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001024{
1025 const uint16_t *ci_be = (const uint16_t *)data;
1026 int i = 0;
1027 const size_t elemlen = sizeof(*ci_be);
1028
1029 *consumed = 0;
1030 while (remain >= elemlen) {
1031 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1032 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001033 cil->id_list[i++].ci = osmo_load16be(ci_be++);
Stefan Sperling9c62fc62018-03-16 10:23:34 +01001034 *consumed += elemlen;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001035 remain -= elemlen;
1036 }
1037 return i;
1038}
1039
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001040static int parse_cell_id_lai_and_lac(struct gsm0808_cell_id_list2 *cil, const uint8_t *data, size_t remain,
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001041 size_t *consumed)
1042{
1043 struct osmo_location_area_id *id;
1044 int i = 0;
1045 const size_t elemlen = sizeof(struct gsm48_loc_area_id);
1046
1047 *consumed = 0;
1048 while (remain >= elemlen) {
1049 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1050 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001051 id = &cil->id_list[i].lai_and_lac;
Stefan Sperling23381452018-03-15 19:38:15 +01001052 decode_lai(&data[i * elemlen], id);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001053 *consumed += elemlen;
1054 remain -= elemlen;
1055 i++;
1056 }
1057
1058 return i;
1059}
1060
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001061static int parse_cell_id_lac_list(struct gsm0808_cell_id_list2 *cil, const uint8_t *data, size_t remain, size_t *consumed)
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001062{
1063 const uint16_t *lac_be = (const uint16_t *)data;
1064 int i = 0;
1065 const size_t elemlen = sizeof(*lac_be);
1066
1067 *consumed = 0;
1068 while (remain >= elemlen) {
1069 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1070 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001071 cil->id_list[i++].lac = osmo_load16be(lac_be++);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001072 *consumed += elemlen;
1073 remain -= elemlen;
1074 }
1075 return i;
1076}
1077
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001078/*! Decode Cell Identifier List IE
Harald Welte96e2a002017-06-12 21:44:18 +02001079 * \param[out] cil Caller-provided memory to store Cell ID list
1080 * \param[in] elem IE value to be decoded
1081 * \param[in] len Length of \a elem in bytes
1082 * \returns number of bytes parsed; negative on error */
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001083int gsm0808_dec_cell_id_list2(struct gsm0808_cell_id_list2 *cil,
1084 const uint8_t *elem, uint8_t len)
1085{
1086 uint8_t id_discr;
1087 size_t bytes_elem = 0;
1088 int list_len = 0;
1089
1090 OSMO_ASSERT(cil);
1091 if (!elem)
1092 return -EINVAL;
1093 if (len == 0)
1094 return -EINVAL;
1095
1096 memset(cil, 0, sizeof(*cil));
1097
1098 id_discr = *elem & 0x0f;
1099 elem++;
1100 len--;
1101
1102 switch (id_discr) {
1103 case CELL_IDENT_WHOLE_GLOBAL:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001104 list_len = parse_cell_id_global_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001105 break;
1106 case CELL_IDENT_LAC_AND_CI:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001107 list_len = parse_cell_id_lac_and_ci_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001108 break;
1109 case CELL_IDENT_CI:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001110 list_len = parse_cell_id_ci_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001111 break;
1112 case CELL_IDENT_LAI_AND_LAC:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001113 list_len = parse_cell_id_lai_and_lac(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001114 break;
1115 case CELL_IDENT_LAC:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001116 list_len = parse_cell_id_lac_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001117 break;
1118 case CELL_IDENT_BSS:
1119 case CELL_IDENT_NO_CELL:
1120 /* Does not have any list items */
1121 break;
1122 default:
1123 /* Remaining cell identification types are not implemented. */
1124 return -EINVAL;
1125 }
1126
1127 if (list_len < 0) /* parsing error */
1128 return list_len;
1129
1130 cil->id_discr = id_discr;
1131 cil->id_list_len = list_len;
1132
1133 /* One byte for the cell ID discriminator + any remaining bytes in
1134 * the IE which were consumed by the parser functions above. */
1135 return 1 + (int)bytes_elem;
1136}
1137
1138/*! DEPRECATED: Use gsm0808_dec_cell_id_list2 instead.
1139 *
1140 * Decode Cell Identifier List IE
1141 * \param[out] cil Caller-provided memory to store Cell ID list
1142 * \param[in] elem IE value to be decoded
1143 * \param[in] len Length of \a elem in bytes
1144 * \returns number of bytes parsed; negative on error */
Philipp Maier783047e2017-03-29 11:35:50 +02001145int gsm0808_dec_cell_id_list(struct gsm0808_cell_id_list *cil,
1146 const uint8_t *elem, uint8_t len)
1147{
1148 uint8_t id_discr;
1149 const uint8_t *old_elem = elem;
1150 unsigned int item_count = 0;
1151
1152 OSMO_ASSERT(cil);
1153 if (!elem)
1154 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +02001155 if (len == 0)
Philipp Maier783047e2017-03-29 11:35:50 +02001156 return -EINVAL;
1157
1158 memset(cil, 0, sizeof(*cil));
1159
1160 id_discr = *elem & 0x0f;
1161 elem++;
1162 len--;
1163
1164 cil->id_discr = id_discr;
1165
1166 switch (id_discr) {
1167 case CELL_IDENT_LAC:
1168 while (len >= 2) {
1169 cil->id_list_lac[item_count] = osmo_load16be(elem);
1170 elem += 2;
1171 item_count++;
1172 len -= 2;
1173 }
1174 case CELL_IDENT_BSS:
1175 /* Does not have any list items */
1176 break;
1177 default:
1178 /* FIXME: Implement support for all identifier list elements */
1179 return -EINVAL;
1180 }
1181
1182 cil->id_list_len = item_count;
1183 return (int)(elem - old_elem);
1184}
Harald Welte96e2a002017-06-12 21:44:18 +02001185
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001186static bool same_cell_id_list_entries(const struct gsm0808_cell_id_list2 *a, int ai,
1187 const struct gsm0808_cell_id_list2 *b, int bi)
1188{
1189 struct gsm0808_cell_id_list2 tmp = {
1190 .id_discr = a->id_discr,
1191 .id_list_len = 1,
1192 };
1193 uint8_t buf_a[32 + sizeof(struct msgb)];
1194 uint8_t buf_b[32 + sizeof(struct msgb)];
1195 struct msgb *msg_a = (void*)buf_a;
1196 struct msgb *msg_b = (void*)buf_b;
1197
1198 msg_a->data_len = 32;
1199 msg_b->data_len = 32;
1200 msgb_reset(msg_a);
1201 msgb_reset(msg_b);
1202
1203 if (a->id_discr != b->id_discr)
1204 return false;
1205 if (ai >= a->id_list_len
1206 || bi >= b->id_list_len)
1207 return false;
1208
1209 tmp.id_list[0] = a->id_list[ai];
1210 gsm0808_enc_cell_id_list2(msg_a, &tmp);
1211
1212 tmp.id_list[0] = b->id_list[bi];
1213 gsm0808_enc_cell_id_list2(msg_b, &tmp);
1214
1215 if (msg_a->len != msg_b->len)
1216 return false;
1217 if (memcmp(msg_a->data, msg_b->data, msg_a->len))
1218 return false;
1219
1220 return true;
1221}
1222
1223/*! Append entries from one Cell Identifier List to another.
1224 * The cell identifier types must be identical between the two lists.
1225 * \param dst[out] Append entries to this list.
1226 * \param src[in] Append these entries to \a dst.
1227 * \returns the nr of items added, or negative on error: -EINVAL if the id_discr mismatch
1228 * between the lists, -ENOSPC if the destination list does not have enough space. If an error is
1229 * returned, \a dst may have already been changed (particularly on -ENOSPC). Note that a return value
1230 * of zero may occur when the src->id_list_len is zero, or when all entries from \a src already exist
1231 * in \a dst, and does not indicate error per se. */
1232int gsm0808_cell_id_list_add(struct gsm0808_cell_id_list2 *dst, const struct gsm0808_cell_id_list2 *src)
1233{
1234 int i, j;
1235 int added = 0;
1236
1237 if (dst->id_list_len == 0
1238 && dst->id_discr != CELL_IDENT_BSS)
1239 dst->id_discr = src->id_discr;
1240 else if (dst->id_discr != src->id_discr)
1241 return -EINVAL;
1242
1243 for (i = 0; i < src->id_list_len; i++) {
1244 /* don't add duplicate entries */
1245 bool skip = false;
1246 for (j = 0; j < dst->id_list_len; j++) {
1247 if (same_cell_id_list_entries(dst, j, src, i)) {
1248 skip = true;
1249 break;
1250 }
1251 }
1252 if (skip)
1253 continue;
1254
1255 if (dst->id_list_len >= ARRAY_SIZE(dst->id_list))
1256 return -ENOSPC;
1257
1258 dst->id_list[dst->id_list_len++] = src->id_list[i];
1259 added ++;
1260 }
1261
1262 return added;
1263}
1264
Neels Hofmeyr38e58412018-05-25 16:56:35 +02001265/*! Convert a single Cell Identifier to a Cell Identifier List with one entry.
1266 * \param dst[out] Overwrite this list.
1267 * \param src[in] Set \a dst to contain exactly this item.
1268 */
1269void gsm0808_cell_id_to_list(struct gsm0808_cell_id_list2 *dst, const struct gsm0808_cell_id *src)
1270{
1271 if (!dst)
1272 return;
1273 if (!src) {
1274 *dst = (struct gsm0808_cell_id_list2){
1275 .id_discr = CELL_IDENT_NO_CELL,
1276 };
1277 return;
1278 }
1279
1280 *dst = (struct gsm0808_cell_id_list2){
1281 .id_discr = src->id_discr,
1282 .id_list = { src->id },
1283 .id_list_len = 1,
1284 };
1285
1286 switch (src->id_discr) {
1287 case CELL_IDENT_NO_CELL:
1288 case CELL_IDENT_BSS:
1289 dst->id_list_len = 0;
1290 break;
1291 default:
1292 break;
1293 }
1294}
1295
Neels Hofmeyr250e7f72018-04-13 03:30:14 +02001296/*! Encode Cell Identifier IE (3GPP TS 48.008 3.2.2.17).
1297 * \param[out] msg Message Buffer to which IE is to be appended
1298 * \param[in] ci Cell ID to be encoded
1299 * \returns number of bytes appended to \a msg */
1300uint8_t gsm0808_enc_cell_id(struct msgb *msg, const struct gsm0808_cell_id *ci)
1301{
1302 uint8_t rc;
1303 uint8_t *ie_tag;
1304 struct gsm0808_cell_id_list2 cil = {
1305 .id_discr = ci->id_discr,
1306 .id_list = { ci->id },
1307 .id_list_len = 1,
1308 };
1309
1310 OSMO_ASSERT(msg);
1311 OSMO_ASSERT(ci);
1312
1313 ie_tag = msg->tail;
1314 rc = gsm0808_enc_cell_id_list2(msg, &cil);
1315
1316 if (rc <= 0)
1317 return rc;
1318
1319 *ie_tag = GSM0808_IE_CELL_IDENTIFIER;
1320 return rc;
1321}
1322
1323/*! Decode Cell Identifier IE (3GPP TS 48.008 3.2.2.17).
1324 * \param[out] ci Caller-provided memory to store Cell ID.
1325 * \param[in] elem IE value to be decoded.
1326 * \param[in] len Length of \a elem in bytes.
1327 * \returns number of bytes parsed; negative on error */
1328int gsm0808_dec_cell_id(struct gsm0808_cell_id *ci, const uint8_t *elem, uint8_t len)
1329{
1330 struct gsm0808_cell_id_list2 cil;
1331 int rc;
1332 rc = gsm0808_dec_cell_id_list2(&cil, elem, len);
1333 if (rc < 0)
1334 return rc;
1335 if (cil.id_discr == CELL_IDENT_BSS || cil.id_discr == CELL_IDENT_NO_CELL) {
1336 if (cil.id_list_len != 0)
1337 return -EINVAL;
1338 } else {
1339 if (cil.id_list_len != 1)
1340 return -EINVAL;
1341 }
1342 ci->id_discr = cil.id_discr;
1343 ci->id = cil.id_list[0];
1344 return rc;
1345}
1346
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001347/*! Convert the representation of the permitted speech codec identifier
Philipp Maier3149b0d2017-06-02 13:22:34 +02001348 * that is used in struct gsm0808_channel_type to the speech codec
1349 * representation we use in struct gsm0808_speech_codec.
1350 * \param[in] perm_spch to be converted (see also gsm0808_permitted_speech)
1351 * \returns GSM speech codec type; negative on error */
1352int gsm0808_chan_type_to_speech_codec(uint8_t perm_spch)
1353{
1354 /*! The speech codec type, which is used in the channel type field to
1355 * signal the permitted speech versions (codecs) has a different
1356 * encoding than the type field in the speech codec type element
1357 * (See also 3GPP TS 48.008, 3.2.2.11 and 3.2.2.103) */
1358
1359 switch (perm_spch) {
1360 case GSM0808_PERM_FR1:
1361 return GSM0808_SCT_FR1;
1362 case GSM0808_PERM_FR2:
1363 return GSM0808_SCT_FR2;
1364 case GSM0808_PERM_FR3:
1365 return GSM0808_SCT_FR3;
1366 case GSM0808_PERM_FR4:
1367 return GSM0808_SCT_FR4;
1368 case GSM0808_PERM_FR5:
1369 return GSM0808_SCT_FR5;
1370 case GSM0808_PERM_HR1:
1371 return GSM0808_SCT_HR1;
1372 case GSM0808_PERM_HR3:
1373 return GSM0808_SCT_HR3;
1374 case GSM0808_PERM_HR4:
1375 return GSM0808_SCT_HR4;
1376 case GSM0808_PERM_HR6:
1377 return GSM0808_SCT_HR6;
1378 }
1379
1380 /* Invalid input */
1381 return -EINVAL;
1382}
1383
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001384/*! Extrapolate a speech codec field from a given permitted speech
Philipp Maier884ba0f2017-06-02 13:49:16 +02001385 * parameter (channel type).
1386 * \param[out] sc Caller provided memory to store the resulting speech codec
1387 * \param[in] perm_spch value that is used to derive the speech codec info
1388 * (see also: enum gsm0808_speech_codec_type in gsm0808_utils.h)
1389 * \returns zero when successful; negative on error */
1390int gsm0808_speech_codec_from_chan_type(struct gsm0808_speech_codec *sc,
1391 uint8_t perm_spch)
1392{
1393 int rc;
1394
1395 memset(sc, 0, sizeof(*sc));
1396
1397 /* Determine codec type */
1398 rc = gsm0808_chan_type_to_speech_codec(perm_spch);
1399 if (rc < 0)
1400 return -EINVAL;
1401 sc->type = (uint8_t) rc;
1402
1403 /* Depending on the speech codec type, pick a default codec
1404 * configuration that exactly matches the configuration on the
1405 * air interface. */
1406 switch (sc->type) {
1407 case GSM0808_SCT_FR3:
1408 sc->cfg = GSM0808_SC_CFG_DEFAULT_FR_AMR;
1409 break;
1410 case GSM0808_SCT_FR4:
1411 sc->cfg = GSM0808_SC_CFG_DEFAULT_OFR_AMR_WB;
1412 break;
1413 case GSM0808_SCT_FR5:
1414 sc->cfg = GSM0808_SC_CFG_DEFAULT_FR_AMR_WB;
1415 break;
1416 case GSM0808_SCT_HR3:
1417 sc->cfg = GSM0808_SC_CFG_DEFAULT_HR_AMR;
1418 break;
1419 case GSM0808_SCT_HR4:
1420 sc->cfg = GSM0808_SC_CFG_DEFAULT_OHR_AMR_WB;
1421 break;
1422 case GSM0808_SCT_HR6:
1423 sc->cfg = GSM0808_SC_CFG_DEFAULT_OHR_AMR;
1424 break;
1425 default:
1426 /* Note: Not all codec types specify a default setting,
1427 * in this case, we just set the field to zero. */
1428 sc->cfg = 0;
1429 }
1430
1431 /* Tag all codecs as "Full IP"
1432 * (see als 3GPP TS 48.008 3.2.2.103) */
1433 sc->fi = true;
1434
1435 return 0;
1436}
1437
Philipp Maier5f2eb152018-09-19 13:40:21 +02001438/*! Determine a set of AMR speech codec configuration bits (S0-S15) from a
1439 * given GSM 04.08 AMR configuration struct.
1440 * \param[in] cfg AMR configuration in GSM 04.08 format.
1441 * \param[in] hint if the resulting configuration shall be used with a FR or HR TCH.
1442 * \returns configuration bits (S0-S15) */
Philipp Maier369015c2018-09-21 09:07:20 +02001443uint16_t gsm0808_sc_cfg_from_gsm48_mr_cfg(const struct gsm48_multi_rate_conf *cfg,
Philipp Maier5f2eb152018-09-19 13:40:21 +02001444 bool fr)
1445{
1446 uint16_t s15_s0 = 0;
1447
1448 /* Check each rate bit in the AMR multirate configuration and pick the
1449 * matching default configuration as specified in 3GPP TS 28.062,
1450 * Table 7.11.3.1.3-2. */
1451 if (cfg->m4_75)
1452 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_4_75;
1453 if (cfg->m5_15)
1454 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_5_15;
1455 if (cfg->m5_90)
1456 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_5_90;
1457 if (cfg->m6_70)
1458 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_6_70;
1459 if (cfg->m7_40)
1460 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_7_40;
1461 if (cfg->m7_95)
1462 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_7_95;
1463 if (cfg->m10_2)
1464 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_10_2;
1465 if (cfg->m12_2)
1466 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_12_2;
1467
1468 /* Note: 3GPP TS 48.008, chapter 3GPP TS 48.008 states that for AMR
1469 * some of the configuration bits must be coded as zeros. The applied
1470 * bitmask matches the default codec settings. See also the definition
1471 * of enum gsm0808_speech_codec_defaults in gsm_08_08.h and
1472 * 3GPP TS 28.062, Table 7.11.3.1.3-2. */
1473 if (fr)
1474 s15_s0 &= GSM0808_SC_CFG_DEFAULT_FR_AMR;
1475 else
1476 s15_s0 &= GSM0808_SC_CFG_DEFAULT_HR_AMR;
1477
Philipp Maier94d79fd2019-03-01 10:40:48 +01001478 /* The mode that is encoded by S1 (Config-NB-Code = 1), takes a special
1479 * role as it does not stand for a single rate, but for up to four rates
1480 * at once (12.2, 7.4, 5.9, 4.75). We must check if the supplied cfg
1481 * covers this mode. If not, we need to make sure that the related
1482 * bit is removed. (See also 3GPP TS 28.062, Table 7.11.3.1.3-2) */
1483 if (!(cfg->m12_2 && cfg->m7_40 && cfg->m5_90 && cfg->m4_75) && fr)
1484 s15_s0 &= ~GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20;
1485 else if (!(cfg->m7_40 && cfg->m5_90 && cfg->m4_75))
1486 s15_s0 &= ~GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20;
1487
Philipp Maier5f2eb152018-09-19 13:40:21 +02001488 return s15_s0;
1489}
1490
Philipp Maier8515d032018-09-25 15:57:49 +02001491/*! Determine a GSM 04.08 AMR configuration struct from a set of speech codec
1492 * configuration bits (S0-S15)
1493 * \param[out] cfg AMR configuration in GSM 04.08 format.
Philipp Maier3713af82019-02-27 16:48:25 +01001494 * \param[in] s15_s0 configuration bits (S15-S0, non-ambiguous).
1495 * \returns zero when successful; negative on error */
1496int gsm48_mr_cfg_from_gsm0808_sc_cfg(struct gsm48_multi_rate_conf *cfg,
1497 uint16_t s15_s0)
Philipp Maier8515d032018-09-25 15:57:49 +02001498{
Philipp Maier3713af82019-02-27 16:48:25 +01001499 unsigned int count = 0;
1500
1501 /* Note: See also: 3GPP TS 28.062
1502 * Table 7.11.3.1.3-2: Preferred Configurations for the Adaptive
1503 * Multi-Rate Codec Types */
1504
1505 /* Note: The resulting multirate-configuration must not contain an
1506 * active set of more than four codec rates. The active set also
1507 * must contain at least one rate. */
1508
Philipp Maier8515d032018-09-25 15:57:49 +02001509 memset(cfg, 0, sizeof(*cfg));
Philipp Maier3713af82019-02-27 16:48:25 +01001510 cfg->ver = 1;
1511 cfg->icmi = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001512
1513 /* Strip option bits */
1514 s15_s0 &= 0x00ff;
1515
Philipp Maier3713af82019-02-27 16:48:25 +01001516 /* Rate 5,15k can never be selected (see table) */
1517 cfg->m5_15 = 0;
Philipp Maier8515d032018-09-25 15:57:49 +02001518
Philipp Maier3713af82019-02-27 16:48:25 +01001519 if (s15_s0 & GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20 & 0xff) {
1520 /* Table Table 7.11.3.1.3-2 lists one mode that selects 4
1521 * rates at once (Config-NB-Code = 1). The rates selected
1522 * are known to be compatible between GERAN and UTRAN, since
1523 * an active set must not contain more than four rates at
1524 * a time, we ignore all other settings as they are either
1525 * redundaned or excess settings (invalid) */
Philipp Maier8515d032018-09-25 15:57:49 +02001526 cfg->m4_75 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001527 cfg->m5_90 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001528 cfg->m7_40 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001529 cfg->m12_2 = 1;
Philipp Maier3713af82019-02-27 16:48:25 +01001530 count += 4;
1531 }
Philipp Maier8515d032018-09-25 15:57:49 +02001532
Philipp Maier3713af82019-02-27 16:48:25 +01001533 /* Check the bits in s15_s0 and set the flags for the
1534 * respective rates. */
1535 if (s15_s0 & GSM0808_SC_CFG_AMR_4_75 && !cfg->m4_75) {
1536 if (count >= 4)
1537 return -EINVAL;
1538 cfg->m4_75 = 1;
1539 count++;
1540 }
1541 if (s15_s0 & GSM0808_SC_CFG_AMR_5_90 && !cfg->m5_90) {
1542 if (count >= 4)
1543 return -EINVAL;
1544 cfg->m5_90 = 1;
1545 count++;
1546 }
1547 if (s15_s0 & GSM0808_SC_CFG_AMR_6_70) {
1548 if (count >= 4)
1549 return -EINVAL;
1550 cfg->m6_70 = 1;
1551 count++;
1552 }
1553 if (s15_s0 & GSM0808_SC_CFG_AMR_7_40 && !cfg->m7_40) {
1554 if (count >= 4)
1555 return -EINVAL;
1556 cfg->m7_40 = 1;
1557 count++;
1558 }
1559 if (s15_s0 & GSM0808_SC_CFG_AMR_7_95) {
1560 if (count >= 4)
1561 return -EINVAL;
1562 cfg->m7_95 = 1;
1563 count++;
1564 }
1565 if (s15_s0 & GSM0808_SC_CFG_AMR_10_2) {
1566 if (count >= 4)
1567 return -EINVAL;
1568 cfg->m10_2 = 1;
1569 count++;
1570 }
1571 if (s15_s0 & GSM0808_SC_CFG_AMR_12_2 && !cfg->m12_2) {
1572 if (count >= 4)
1573 return -EINVAL;
1574 cfg->m12_2 = 1;
1575 count++;
1576 }
1577
1578 if (count == 0)
1579 return -EINVAL;
1580
1581 return 0;
Philipp Maier8515d032018-09-25 15:57:49 +02001582}
1583
Alexander Chemeris2ac8f912020-05-13 22:38:08 +03001584int gsm0808_get_cipher_reject_cause(const struct tlv_parsed *tp)
1585{
1586 return gsm0808_get_cause(tp);
1587}
1588
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001589/*! Print a human readable name of the cell identifier to the char buffer.
1590 * This is useful both for struct gsm0808_cell_id and struct gsm0808_cell_id_list2.
1591 * See also gsm0808_cell_id_name() and gsm0808_cell_id_list_name().
1592 * \param[out] buf Destination buffer to write string representation to.
1593 * \param[in] buflen Amount of memory available in \a buf.
1594 * \param[in] id_discr Cell Identifier type.
1595 * \param[in] u Cell Identifer value.
1596 * \returns Like snprintf(): the amount of characters (excluding terminating nul) written,
1597 * or that would have been written if the buffer were large enough.
1598 */
1599int gsm0808_cell_id_u_name(char *buf, size_t buflen,
1600 enum CELL_IDENT id_discr, const union gsm0808_cell_id_u *u)
1601{
1602 switch (id_discr) {
1603 case CELL_IDENT_LAC:
1604 return snprintf(buf, buflen, "%u", u->lac);
1605 case CELL_IDENT_CI:
1606 return snprintf(buf, buflen, "%u", u->ci);
1607 case CELL_IDENT_LAC_AND_CI:
1608 return snprintf(buf, buflen, "%u-%u", u->lac_and_ci.lac, u->lac_and_ci.ci);
1609 case CELL_IDENT_LAI_AND_LAC:
1610 return snprintf(buf, buflen, "%s", osmo_lai_name(&u->lai_and_lac));
1611 case CELL_IDENT_WHOLE_GLOBAL:
1612 return snprintf(buf, buflen, "%s", osmo_cgi_name(&u->global));
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001613 case CELL_IDENT_WHOLE_GLOBAL_PS:
1614 return snprintf(buf, buflen, "%s", osmo_cgi_ps_name(&u->global_ps));
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001615 default:
1616 /* For CELL_IDENT_BSS and CELL_IDENT_NO_CELL, just print the discriminator.
1617 * Same for kinds we have no string representation of yet. */
1618 return snprintf(buf, buflen, "%s", gsm0808_cell_id_discr_name(id_discr));
1619 }
1620}
1621
Neels Hofmeyrd01ef752018-09-21 15:57:26 +02001622/* Store individual Cell Identifier information in a CGI, without clearing the remaining ones.
1623 * This is useful to supplement one CGI with information from more than one Cell Identifier,
1624 * which in turn is useful to match Cell Identifiers of differing kinds to each other.
1625 * Before first invocation, clear the *dst struct externally, this function does only write those members
1626 * that are present in parameter u.
1627 */
1628static void cell_id_to_cgi(struct osmo_cell_global_id *dst,
1629 enum CELL_IDENT discr, const union gsm0808_cell_id_u *u)
1630{
1631 switch (discr) {
1632 case CELL_IDENT_WHOLE_GLOBAL:
1633 *dst = u->global;
1634 return;
1635
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001636 case CELL_IDENT_WHOLE_GLOBAL_PS:
1637 dst->lai = u->global_ps.rai.lac;
1638 dst->cell_identity = u->global_ps.cell_identity;
1639 return;
1640
Neels Hofmeyrd01ef752018-09-21 15:57:26 +02001641 case CELL_IDENT_LAC_AND_CI:
1642 dst->lai.lac = u->lac_and_ci.lac;
1643 dst->cell_identity = u->lac_and_ci.ci;
1644 return;
1645
1646 case CELL_IDENT_CI:
1647 dst->cell_identity = u->ci;
1648 return;
1649
1650 case CELL_IDENT_LAI_AND_LAC:
1651 dst->lai = u->lai_and_lac;
1652 return;
1653
1654 case CELL_IDENT_LAC:
1655 dst->lai.lac = u->lac;
1656 return;
1657
1658 case CELL_IDENT_NO_CELL:
1659 case CELL_IDENT_BSS:
1660 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1661 case CELL_IDENT_UTRAN_RNC:
1662 case CELL_IDENT_UTRAN_LAC_RNC:
1663 /* No values to set. */
1664 return;
1665 }
1666}
1667
1668/*! Return true if the common information between the two Cell Identifiers match.
1669 * For example, if a LAC+CI is compared to LAC, return true if the LAC are the same.
1670 * Note that CELL_IDENT_NO_CELL will always return false.
1671 * Also CELL_IDENT_BSS will always return false, since this function cannot possibly
1672 * know the bounds of the BSS, so the caller must handle CELL_IDENT_BSS specially.
1673 * \param[in] discr1 Cell Identifier type.
1674 * \param[in] u1 Cell Identifier value.
1675 * \param[in] discr2 Other Cell Identifier type.
1676 * \param[in] u2 Other Cell Identifier value.
1677 * \param[in] exact_match If true, return true only if the CELL_IDENT types and all values are identical.
1678 * \returns True if the common fields of the above match.
1679 */
1680static bool gsm0808_cell_id_u_match(enum CELL_IDENT discr1, const union gsm0808_cell_id_u *u1,
1681 enum CELL_IDENT discr2, const union gsm0808_cell_id_u *u2,
1682 bool exact_match)
1683{
1684 struct osmo_cell_global_id a = {};
1685 struct osmo_cell_global_id b = {};
1686
1687 if (exact_match && discr1 != discr2)
1688 return false;
1689
1690 /* First handle the odd wildcard like CELL_IDENT kinds. We can't really match any of these. */
1691 switch (discr1) {
1692 case CELL_IDENT_NO_CELL:
1693 case CELL_IDENT_BSS:
1694 return discr1 == discr2;
1695 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1696 case CELL_IDENT_UTRAN_RNC:
1697 case CELL_IDENT_UTRAN_LAC_RNC:
1698 return false;
1699 default:
1700 break;
1701 }
1702 switch (discr2) {
1703 case CELL_IDENT_NO_CELL:
1704 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1705 case CELL_IDENT_UTRAN_RNC:
1706 case CELL_IDENT_UTRAN_LAC_RNC:
1707 case CELL_IDENT_BSS:
1708 return false;
1709 default:
1710 break;
1711 }
1712
1713 /* Enrich both sides to full CGI, then compare those. First set the *other* ID's values in case
1714 * they assign more items. For example:
1715 * u1 = LAC:42
1716 * u2 = LAC+CI:23+5
1717 * 1) a <- LAC+CI:23+5
1718 * 2) a <- LAC:42 so that a = LAC+CI:42+5
1719 * Now we can compare those two and find a mismatch. If the LAC were the same, we would get
1720 * identical LAC+CI and hence a match. */
1721
1722 cell_id_to_cgi(&a, discr2, u2);
1723 cell_id_to_cgi(&a, discr1, u1);
1724
1725 cell_id_to_cgi(&b, discr1, u1);
1726 cell_id_to_cgi(&b, discr2, u2);
1727
1728 return osmo_cgi_cmp(&a, &b) == 0;
1729}
1730
1731/*! Return true if the common information between the two Cell Identifiers match.
1732 * For example, if a LAC+CI is compared to LAC, return true if the LAC are the same.
1733 * Note that CELL_IDENT_NO_CELL will always return false.
1734 * Also CELL_IDENT_BSS will always return false, since this function cannot possibly
1735 * know the bounds of the BSS, so the caller must handle CELL_IDENT_BSS specially.
1736 * \param[in] id1 Cell Identifier.
1737 * \param[in] id2 Other Cell Identifier.
1738 * \param[in] exact_match If true, return true only if the CELL_IDENT types and all values are identical.
1739 * \returns True if the common fields of the above match.
1740 */
1741bool gsm0808_cell_ids_match(const struct gsm0808_cell_id *id1, const struct gsm0808_cell_id *id2, bool exact_match)
1742{
1743 return gsm0808_cell_id_u_match(id1->id_discr, &id1->id, id2->id_discr, &id2->id, exact_match);
1744}
1745
1746/*! Find an index in a Cell Identifier list that matches a given single Cell Identifer.
1747 * Compare \a id against each entry in \a list using gsm0808_cell_ids_match(), and return the list index
1748 * if a match is found. \a match_nr allows iterating all matches in the list. A match_nr <= 0 returns the
1749 * first match in the list, match_nr == 1 the second match, etc., and if match_nr exceeds the available
1750 * matches in the list, -1 is returned.
1751 * \param[in] id Cell Identifier to match.
1752 * \param[in] list Cell Identifier list to search in.
1753 * \param[in] match_nr Ignore this many matches.
1754 * \param[in] exact_match If true, consider as match only if the CELL_IDENT types and all values are identical.
Neels Hofmeyr8aa691f2019-02-26 02:59:37 +01001755 * \returns -1 if no match is found, list index if a match is found (i.e. rc == 0 means a match was found on the first
1756 * entry).
Neels Hofmeyrd01ef752018-09-21 15:57:26 +02001757 */
1758int gsm0808_cell_id_matches_list(const struct gsm0808_cell_id *id, const struct gsm0808_cell_id_list2 *list,
1759 unsigned int match_nr, bool exact_match)
1760{
1761 int i;
1762 for (i = 0; i < list->id_list_len; i++) {
1763 if (gsm0808_cell_id_u_match(id->id_discr, &id->id, list->id_discr, &list->id_list[i], exact_match)) {
1764 if (match_nr)
1765 match_nr--;
1766 else
1767 return i;
1768 }
1769 }
1770 return -1;
1771}
1772
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001773/*! Copy information from a CGI to form a Cell Identifier of the specified kind.
1774 * \param [out] cid Compose new Cell Identifier here.
1775 * \param [in] id_discr Which kind of Cell Identifier to compose.
1776 * \param [in] cgi Cell Global Identifier to form the Cell Identifier from.
1777 */
1778void gsm0808_cell_id_from_cgi(struct gsm0808_cell_id *cid, enum CELL_IDENT id_discr,
1779 const struct osmo_cell_global_id *cgi)
1780{
1781 *cid = (struct gsm0808_cell_id){
1782 .id_discr = id_discr,
1783 };
1784
1785 switch (id_discr) {
1786 case CELL_IDENT_WHOLE_GLOBAL:
1787 cid->id.global = *cgi;
1788 return;
1789
1790 case CELL_IDENT_LAC_AND_CI:
1791 cid->id.lac_and_ci = (struct osmo_lac_and_ci_id){
1792 .lac = cgi->lai.lac,
1793 .ci = cgi->cell_identity,
1794 };
1795 return;
1796
1797 case CELL_IDENT_CI:
1798 cid->id.ci = cgi->cell_identity;
1799 return;
1800
1801 case CELL_IDENT_LAI:
1802 cid->id.lai_and_lac = cgi->lai;
1803 return;
1804
1805 case CELL_IDENT_LAC:
1806 cid->id.lac = cgi->lai.lac;
1807 return;
1808
1809 case CELL_IDENT_NO_CELL:
1810 case CELL_IDENT_BSS:
1811 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1812 case CELL_IDENT_UTRAN_RNC:
1813 case CELL_IDENT_UTRAN_LAC_RNC:
1814 default:
1815 return;
1816 };
1817}
1818
1819/*! Overwrite parts of cgi with values from a Cell Identifier.
1820 * Place only those items given in cid into cgi, leaving other values unchanged.
1821 * \param[out] cgi Cell Global Identity to write to.
1822 * \param[in] cid Cell Identity to read from.
1823 * \return a bitmask of items that were set: OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI; 0 if nothing was
1824 * written to cgi.
1825 */
1826int gsm0808_cell_id_to_cgi(struct osmo_cell_global_id *cgi, const struct gsm0808_cell_id *cid)
1827{
1828 switch (cid->id_discr) {
1829 case CELL_IDENT_WHOLE_GLOBAL:
1830 *cgi = cid->id.global;
1831 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1832
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001833 case CELL_IDENT_WHOLE_GLOBAL_PS:
1834 cgi->lai = cid->id.global_ps.rai.lac;
1835 cgi->cell_identity = cid->id.global_ps.cell_identity;
1836 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1837
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001838 case CELL_IDENT_LAC_AND_CI:
1839 cgi->lai.lac = cid->id.lac_and_ci.lac;
1840 cgi->cell_identity = cid->id.lac_and_ci.ci;
1841 return OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1842
1843 case CELL_IDENT_CI:
1844 cgi->cell_identity = cid->id.ci;
1845 return OSMO_CGI_PART_CI;
1846
1847 case CELL_IDENT_LAI:
1848 cgi->lai = cid->id.lai_and_lac;
1849 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC;
1850
1851 case CELL_IDENT_LAC:
1852 cgi->lai.lac = cid->id.lac;
1853 return OSMO_CGI_PART_LAC;
1854
1855 case CELL_IDENT_NO_CELL:
1856 case CELL_IDENT_BSS:
1857 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1858 case CELL_IDENT_UTRAN_RNC:
1859 case CELL_IDENT_UTRAN_LAC_RNC:
1860 default:
1861 return 0;
1862 };
1863}
1864
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001865/*! value_string[] for enum CELL_IDENT. */
1866const struct value_string gsm0808_cell_id_discr_names[] = {
1867 { CELL_IDENT_WHOLE_GLOBAL, "CGI" },
1868 { CELL_IDENT_LAC_AND_CI, "LAC-CI" },
1869 { CELL_IDENT_CI, "CI" },
1870 { CELL_IDENT_NO_CELL, "NO-CELL" },
1871 { CELL_IDENT_LAI_AND_LAC, "LAI" },
1872 { CELL_IDENT_LAC, "LAC" },
1873 { CELL_IDENT_BSS, "BSS" },
1874 { CELL_IDENT_UTRAN_PLMN_LAC_RNC, "UTRAN-PLMN-LAC-RNC" },
1875 { CELL_IDENT_UTRAN_RNC, "UTRAN-RNC" },
1876 { CELL_IDENT_UTRAN_LAC_RNC, "UTRAN-LAC-RNC" },
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001877 { CELL_IDENT_WHOLE_GLOBAL_PS, "CGI-PS"},
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001878 { 0, NULL }
1879};
1880
1881#define APPEND_THING(func, args...) do { \
1882 int remain = buflen - (pos - buf); \
1883 int l = func(pos, remain, ##args); \
1884 if (l < 0 || l > remain) \
1885 pos = buf + buflen; \
1886 else \
1887 pos += l; \
1888 if (l > 0) \
1889 total_len += l; \
1890 } while(0)
1891#define APPEND_STR(fmt, args...) APPEND_THING(snprintf, fmt, ##args)
1892#define APPEND_CELL_ID_U(DISCR, U) APPEND_THING(gsm0808_cell_id_u_name, DISCR, U)
1893
Harald Welte179f3572019-03-18 18:38:47 +01001894char *gsm0808_cell_id_name_buf(char *buf, size_t buflen, const struct gsm0808_cell_id *cid)
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001895{
1896 char *pos = buf;
1897 int total_len = 0;
1898 APPEND_STR("%s:", gsm0808_cell_id_discr_name(cid->id_discr));
1899 APPEND_CELL_ID_U(cid->id_discr, &cid->id);
1900 return buf;
1901}
1902
1903/*! Return a human readable representation of a Cell Identifier, like "LAC:123"
1904 * or "CGI:001-01-42-23".
1905 * \param[in] cid Cell Identifer.
1906 * \returns String in a static buffer.
1907 */
1908const char *gsm0808_cell_id_name(const struct gsm0808_cell_id *cid)
1909{
Harald Welte171ef822019-03-28 10:49:05 +01001910 static __thread char buf[64];
Harald Welte179f3572019-03-18 18:38:47 +01001911 return gsm0808_cell_id_name_buf(buf, sizeof(buf), cid);
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001912}
1913
1914/*! Like gsm0808_cell_id_name() but uses a different static buffer.
1915 * \param[in] cid Cell Identifer.
1916 * \returns String in a static buffer.
1917 */
1918const char *gsm0808_cell_id_name2(const struct gsm0808_cell_id *cid)
1919{
Harald Welte171ef822019-03-28 10:49:05 +01001920 static __thread char buf[64];
Harald Welte179f3572019-03-18 18:38:47 +01001921 return gsm0808_cell_id_name_buf(buf, sizeof(buf), cid);
1922}
1923
1924char *gsm0808_cell_id_name_c(const void *ctx, const struct gsm0808_cell_id *cid)
1925{
1926 char *buf = talloc_size(ctx, 64);
1927 if (!buf)
1928 return NULL;
1929 return gsm0808_cell_id_name_buf(buf, 64, cid);
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001930}
1931
1932/*! Return a human readable representation of the Cell Identifier List, like
1933 * "LAC[2]:{123, 456}".
1934 * The return value semantics are like snprintf() and thus allow ensuring a complete
1935 * untruncated string by determining the required string length from the return value.
1936 * If buflen > 0, always nul-terminate the string in buf, also when it is truncated.
1937 * If buflen == 0, do not modify buf, just return the would-be length.
1938 * \param[out] buf Destination buffer to write string representation to.
1939 * \param[in] buflen Amount of memory available in \a buf.
1940 * \param[in] cil Cell Identifer List.
1941 * \returns Like snprintf(): the amount of characters (excluding terminating nul) written,
1942 * or that would have been written if the buffer were large enough.
1943 */
1944int gsm0808_cell_id_list_name_buf(char *buf, size_t buflen, const struct gsm0808_cell_id_list2 *cil)
1945{
1946 char *pos = buf;
1947 int total_len = 0;
1948 int i;
1949
1950 APPEND_STR("%s[%u]", gsm0808_cell_id_discr_name(cil->id_discr), cil->id_list_len);
1951
1952 switch (cil->id_discr) {
1953 case CELL_IDENT_BSS:
1954 case CELL_IDENT_NO_CELL:
1955 return total_len;
1956 default:
1957 break;
1958 }
1959
1960 APPEND_STR(":{");
1961
1962 for (i = 0; i < cil->id_list_len; i++) {
1963 if (i)
1964 APPEND_STR(", ");
1965 APPEND_CELL_ID_U(cil->id_discr, &cil->id_list[i]);
1966 }
1967
1968 APPEND_STR("}");
1969 return total_len;
1970}
1971
1972/*! Return a human-readable representation of \a cil in a static buffer.
1973 * If the list is too long, the output may be truncated.
1974 * See also gsm0808_cell_id_list_name_buf(). */
1975const char *gsm0808_cell_id_list_name(const struct gsm0808_cell_id_list2 *cil)
1976{
Harald Welte171ef822019-03-28 10:49:05 +01001977 static __thread char buf[1024];
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001978 gsm0808_cell_id_list_name_buf(buf, sizeof(buf), cil);
1979 return buf;
1980}
1981
Harald Welte179f3572019-03-18 18:38:47 +01001982char *gsm0808_cell_id_list_name_c(const void *ctx, const struct gsm0808_cell_id_list2 *cil)
1983{
1984 char *buf = talloc_size(ctx, 1024);
1985 if (!buf)
1986 return NULL;
1987 gsm0808_cell_id_list_name_buf(buf, 1024, cil);
1988 return buf;
1989}
1990
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001991#undef APPEND_STR
1992#undef APPEND_CELL_ID_U
1993
Harald Welte4a62eda2019-03-18 18:27:00 +01001994char *gsm0808_channel_type_name_buf(char *buf, size_t buf_len, const struct gsm0808_channel_type *ct)
Neels Hofmeyrafacc2b2018-04-16 22:41:51 +02001995{
Harald Welte4a62eda2019-03-18 18:27:00 +01001996 snprintf(buf, buf_len, "ch_indctr=0x%x ch_rate_type=0x%x perm_spch=%s",
Neels Hofmeyrafacc2b2018-04-16 22:41:51 +02001997 ct->ch_indctr, ct->ch_rate_type,
1998 osmo_hexdump(ct->perm_spch, ct->perm_spch_len));
1999 return buf;
2000}
2001
Harald Welte4a62eda2019-03-18 18:27:00 +01002002const char *gsm0808_channel_type_name(const struct gsm0808_channel_type *ct)
2003{
Harald Welte171ef822019-03-28 10:49:05 +01002004 static __thread char buf[128];
Harald Welte4a62eda2019-03-18 18:27:00 +01002005 return gsm0808_channel_type_name_buf(buf, sizeof(buf), ct);
2006}
2007
Harald Welte179f3572019-03-18 18:38:47 +01002008char *gsm0808_channel_type_name_c(const void *ctx, const struct gsm0808_channel_type *ct)
2009{
2010 char *buf = talloc_size(ctx, 128);
2011 if (!buf)
2012 return NULL;
2013 return gsm0808_channel_type_name_buf(buf, 128, ct);
2014}
2015
Harald Welte96e2a002017-06-12 21:44:18 +02002016/*! @} */