blob: b5b8431f563bf79102f54a6d5f7696400c62e9ea [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
Neels Hofmeyr4a9756c2021-06-10 00:48:15 +0200770/*! Encode TS 48.008 Kc128 IE.
771 * \param[out] msg Message Buffer to which IE is to be appended.
772 * \param[in] kc128 Pointer to 16 bytes of Kc128 key data.
773 * \returns number of bytes appended to msg */
774int gsm0808_enc_kc128(struct msgb *msg, const uint8_t *kc128)
775{
776 uint8_t *start = msg->tail;
777 msgb_tv_fixed_put(msg, GSM0808_IE_KC_128, 16, kc128);
778 return msg->tail - start;
779}
780
781/*! Decode TS 48.008 Kc128 IE.
782 * \param[out] kc128 Target buffer for received Kc128 key, 16 bytes long.
783 * \param[in] elem IE value to be decoded (without IE discriminator).
784 * \param[in] len Length of elem in bytes.
785 * \returns number of bytes parsed; negative on error */
786int gsm0808_dec_kc128(uint8_t *kc128, const uint8_t *elem, uint8_t len)
787{
788 if (len != 16)
789 return -EINVAL;
790 memcpy(kc128, elem, 16);
791 return len;
792}
793
Pau Espin Pedrol85a0f112021-02-15 16:25:33 +0100794/* Store individual Cell Identifier information in a CGI, without clearing the remaining ones.
795 * This is useful to supplement one CGI with information from more than one Cell Identifier,
796 * which in turn is useful to match Cell Identifiers of differing kinds to each other.
797 * Before first invocation, clear the *dst struct externally, this function does only write those members
798 * that are present in parameter u.
799 */
800static void cell_id_to_cgi(struct osmo_cell_global_id *dst,
801 enum CELL_IDENT discr, const union gsm0808_cell_id_u *u)
802{
803 switch (discr) {
804 case CELL_IDENT_WHOLE_GLOBAL:
805 *dst = u->global;
806 return;
807
808 case CELL_IDENT_WHOLE_GLOBAL_PS:
809 dst->lai = u->global_ps.rai.lac;
810 dst->cell_identity = u->global_ps.cell_identity;
811 return;
812
813 case CELL_IDENT_LAC_AND_CI:
814 dst->lai.lac = u->lac_and_ci.lac;
815 dst->cell_identity = u->lac_and_ci.ci;
816 return;
817
818 case CELL_IDENT_CI:
819 dst->cell_identity = u->ci;
820 return;
821
822 case CELL_IDENT_LAI_AND_LAC:
823 dst->lai = u->lai_and_lac;
824 return;
825
826 case CELL_IDENT_LAC:
827 dst->lai.lac = u->lac;
828 return;
829
830 case CELL_IDENT_NO_CELL:
831 case CELL_IDENT_BSS:
832 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
833 case CELL_IDENT_UTRAN_RNC:
834 case CELL_IDENT_UTRAN_LAC_RNC:
835 /* No values to set. */
836 return;
837 }
838}
839
Harald Weltef2210032019-08-31 21:25:05 +0200840/* Return the size of the value part of a cell identifier of given type */
841int gsm0808_cell_id_size(enum CELL_IDENT discr)
842{
843 switch (discr) {
844 case CELL_IDENT_WHOLE_GLOBAL:
845 return 7;
846 case CELL_IDENT_LAC_AND_CI:
847 return 4;
848 case CELL_IDENT_CI:
849 return 2;
850 case CELL_IDENT_LAI_AND_LAC:
851 return 5;
852 case CELL_IDENT_LAC:
853 return 2;
854 case CELL_IDENT_BSS:
855 case CELL_IDENT_NO_CELL:
856 return 0;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100857 case CELL_IDENT_WHOLE_GLOBAL_PS:
858 return 8;
Harald Weltef2210032019-08-31 21:25:05 +0200859 default:
860 return -EINVAL;
861 }
862}
Harald Welteef7be492019-05-03 21:01:13 +0200863/*! Decode a single GSM 08.08 Cell ID list element payload
864 * \param[out] out caller-provided output union
865 * \param[in] discr Cell ID discriminator describing type to be decoded
866 * \param[in] buf User-provided input buffer containing binary Cell ID list element
867 * \param[in] len Length of buf
868 * \returns 0 on success; negative on error */
869int gsm0808_decode_cell_id_u(union gsm0808_cell_id_u *out, enum CELL_IDENT discr, const uint8_t *buf, unsigned int len)
870{
871 switch (discr) {
872 case CELL_IDENT_WHOLE_GLOBAL:
873 if (len < 7)
874 return -EINVAL;
875 decode_lai(buf, &out->global.lai);
876 out->global.cell_identity = osmo_load16be(buf + sizeof(struct gsm48_loc_area_id));
877 break;
878 case CELL_IDENT_LAC_AND_CI:
879 if (len < 4)
880 return -EINVAL;
881 out->lac_and_ci.lac = osmo_load16be(buf);
882 out->lac_and_ci.ci = osmo_load16be(buf + sizeof(uint16_t));
883 break;
884 case CELL_IDENT_CI:
885 if (len < 2)
886 return -EINVAL;
887 out->ci = osmo_load16be(buf);
888 break;
889 case CELL_IDENT_LAI_AND_LAC:
890 if (len < 5)
891 return -EINVAL;
892 decode_lai(buf, &out->lai_and_lac);
893 break;
894 case CELL_IDENT_LAC:
895 if (len < 2)
896 return -EINVAL;
897 out->lac = osmo_load16be(buf);
898 break;
899 case CELL_IDENT_BSS:
900 case CELL_IDENT_NO_CELL:
901 /* Does not have any list items */
902 break;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100903 case CELL_IDENT_WHOLE_GLOBAL_PS:
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100904 /* 3GPP TS 48.018 sec 11.3.9 "Cell Identifier" */
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100905 if (len < 8)
906 return -EINVAL;
907 decode_lai(buf, (struct osmo_location_area_id *)&out->global_ps.rai); /* rai contains lai + non-decoded rac */
908 out->global_ps.rai.rac = *(buf + sizeof(struct gsm48_loc_area_id));
909 out->global_ps.cell_identity = osmo_load16be(buf + sizeof(struct gsm48_loc_area_id) + 1);
910 break;
Harald Welteef7be492019-05-03 21:01:13 +0200911 default:
912 /* Remaining cell identification types are not implemented. */
913 return -EINVAL;
914 }
915 return 0;
916}
917
Harald Weltee87693c2019-05-03 20:06:50 +0200918void gsm0808_msgb_put_cell_id_u(struct msgb *msg, enum CELL_IDENT id_discr, const union gsm0808_cell_id_u *u)
919{
920 switch (id_discr) {
921 case CELL_IDENT_WHOLE_GLOBAL: {
922 const struct osmo_cell_global_id *id = &u->global;
923 struct gsm48_loc_area_id lai;
924 gsm48_generate_lai2(&lai, &id->lai);
925 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
926 msgb_put_u16(msg, id->cell_identity);
927 break;
928 }
929 case CELL_IDENT_LAC_AND_CI: {
930 const struct osmo_lac_and_ci_id *id = &u->lac_and_ci;
931 msgb_put_u16(msg, id->lac);
932 msgb_put_u16(msg, id->ci);
933 break;
934 }
935 case CELL_IDENT_CI:
936 msgb_put_u16(msg, u->ci);
937 break;
938 case CELL_IDENT_LAI_AND_LAC: {
939 const struct osmo_location_area_id *id = &u->lai_and_lac;
940 struct gsm48_loc_area_id lai;
941 gsm48_generate_lai2(&lai, id);
942 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
943 break;
944 }
945 case CELL_IDENT_LAC:
946 msgb_put_u16(msg, u->lac);
947 break;
948 case CELL_IDENT_BSS:
949 case CELL_IDENT_NO_CELL:
950 /* Does not have any list items */
951 break;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100952 case CELL_IDENT_WHOLE_GLOBAL_PS: {
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100953 /* 3GPP TS 48.018 sec 11.3.9 "Cell Identifier" */
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100954 const struct osmo_cell_global_id_ps *id = &u->global_ps;
955 struct gsm48_loc_area_id lai;
956 gsm48_generate_lai2(&lai, &id->rai.lac);
957 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
958 memcpy(msgb_put(msg, 1), &id->rai.rac, 1);
959 msgb_put_u16(msg, id->cell_identity);
960 break;
961 }
Harald Weltee87693c2019-05-03 20:06:50 +0200962 default:
963 /* Support for other identifier list types is not implemented. */
964 OSMO_ASSERT(false);
965 }
966}
967
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200968/*! Encode TS 08.08 Cell Identifier List IE
Harald Welte96e2a002017-06-12 21:44:18 +0200969 * \param[out] msg Message Buffer to which IE is to be appended
970 * \param[in] cil Cell ID List to be encoded
971 * \returns number of bytes appended to \a msg */
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100972uint8_t gsm0808_enc_cell_id_list2(struct msgb *msg,
973 const struct gsm0808_cell_id_list2 *cil)
974{
975 uint8_t *old_tail;
976 uint8_t *tlv_len;
977 unsigned int i;
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100978 uint8_t id_discr;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100979
980 OSMO_ASSERT(msg);
981 OSMO_ASSERT(cil);
982
983 msgb_put_u8(msg, GSM0808_IE_CELL_IDENTIFIER_LIST);
984 tlv_len = msgb_put(msg, 1);
985 old_tail = msg->tail;
986
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100987 /* CGI-PS is an osmocom-specific type. In here we don't care about the
988 * PS part, only the CS one. */
989 if (cil->id_discr == CELL_IDENT_WHOLE_GLOBAL_PS)
990 id_discr = CELL_IDENT_WHOLE_GLOBAL;
991 else
992 id_discr = cil->id_discr & 0x0f;
993
994 msgb_put_u8(msg, id_discr);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100995
Alexander Couzens4e284b62019-06-23 01:53:43 +0200996 OSMO_ASSERT(cil->id_list_len <= GSM0808_CELL_ID_LIST2_MAXLEN);
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100997 for (i = 0; i < cil->id_list_len; i++) {
998 if (cil->id_discr == CELL_IDENT_WHOLE_GLOBAL_PS) {
999 union gsm0808_cell_id_u u;
1000 cell_id_to_cgi(&u.global, cil->id_discr, &cil->id_list[i]);
1001 gsm0808_msgb_put_cell_id_u(msg, CELL_IDENT_WHOLE_GLOBAL, &u);
1002 } else {
1003 gsm0808_msgb_put_cell_id_u(msg, cil->id_discr, &cil->id_list[i]);
1004 }
1005 }
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001006
1007 *tlv_len = (uint8_t) (msg->tail - old_tail);
1008 return *tlv_len + 2;
1009}
1010
1011/*! DEPRECATED: Use gsm0808_enc_cell_id_list2 instead.
1012 *
1013 * Encode TS 08.08 Cell Identifier List IE
1014 * \param[out] msg Message Buffer to which IE is to be appended
1015 * \param[in] cil Cell ID List to be encoded
1016 * \returns number of bytes appended to \a msg */
Philipp Maier783047e2017-03-29 11:35:50 +02001017uint8_t gsm0808_enc_cell_id_list(struct msgb *msg,
1018 const struct gsm0808_cell_id_list *cil)
1019{
1020 uint8_t *old_tail;
1021 uint8_t *tlv_len;
1022 unsigned int i;
1023
1024 OSMO_ASSERT(msg);
1025 OSMO_ASSERT(cil);
1026
1027 msgb_put_u8(msg, GSM0808_IE_CELL_IDENTIFIER_LIST);
1028 tlv_len = msgb_put(msg, 1);
1029 old_tail = msg->tail;
1030
1031 msgb_put_u8(msg, cil->id_discr & 0x0f);
1032
1033 switch (cil->id_discr) {
1034 case CELL_IDENT_LAC:
Alexander Couzens4e284b62019-06-23 01:53:43 +02001035 OSMO_ASSERT(cil->id_list_len <= CELL_ID_LIST_LAC_MAXLEN);
Philipp Maier783047e2017-03-29 11:35:50 +02001036 for (i=0;i<cil->id_list_len;i++) {
1037 msgb_put_u16(msg, cil->id_list_lac[i]);
1038 }
1039 break;
1040 case CELL_IDENT_BSS:
1041 /* Does not have any list items */
1042 break;
1043 default:
1044 /* FIXME: Implement support for all identifier list elements */
1045 OSMO_ASSERT(false);
1046 }
1047
1048 *tlv_len = (uint8_t) (msg->tail - old_tail);
1049 return *tlv_len + 2;
1050}
1051
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001052static 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 +01001053 size_t *consumed)
1054{
1055 struct osmo_cell_global_id *id;
1056 uint16_t *ci_be;
1057 size_t lai_offset;
1058 int i = 0;
1059 const size_t elemlen = sizeof(struct gsm48_loc_area_id) + sizeof(*ci_be);
1060
1061 *consumed = 0;
1062 while (remain >= elemlen) {
1063 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1064 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001065 id = &cil->id_list[i].global;
Stefan Sperling2873bf12018-03-14 18:38:41 +01001066 lai_offset = i * elemlen;
Stefan Sperling23381452018-03-15 19:38:15 +01001067 decode_lai(&data[lai_offset], &id->lai);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001068 ci_be = (uint16_t *)(&data[lai_offset + sizeof(struct gsm48_loc_area_id)]);
1069 id->cell_identity = osmo_load16be(ci_be);
1070 *consumed += elemlen;
1071 remain -= elemlen;
1072 i++;
1073 }
1074
1075 return i;
1076}
1077
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001078static 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 +01001079 size_t *consumed)
1080{
1081 uint16_t *lacp_be, *ci_be;
1082 struct osmo_lac_and_ci_id *id;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001083 int i = 0, j = 0;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001084 const size_t elemlen = sizeof(*lacp_be) + sizeof(*ci_be);
1085
1086 *consumed = 0;
1087
1088 if (remain < elemlen)
1089 return -EINVAL;
1090
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001091 lacp_be = (uint16_t *)(&data[j]);
1092 ci_be = (uint16_t *)(&data[j + elemlen/2]);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001093 while (remain >= elemlen) {
1094 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1095 return -ENOSPC;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001096 id = &cil->id_list[i++].lac_and_ci;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001097 id->lac = osmo_load16be(lacp_be);
1098 id->ci = osmo_load16be(ci_be);
1099 *consumed += elemlen;
1100 remain -= elemlen;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001101 j += elemlen;
1102 lacp_be = (uint16_t *)(&data[j]);
1103 ci_be = (uint16_t *)(&data[j + elemlen/2]);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001104 }
1105
1106 return i;
1107}
1108
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001109static int parse_cell_id_ci_list(struct gsm0808_cell_id_list2 *cil, const uint8_t *data, size_t remain,
1110 size_t *consumed)
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001111{
1112 const uint16_t *ci_be = (const uint16_t *)data;
1113 int i = 0;
1114 const size_t elemlen = sizeof(*ci_be);
1115
1116 *consumed = 0;
1117 while (remain >= elemlen) {
1118 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1119 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001120 cil->id_list[i++].ci = osmo_load16be(ci_be++);
Stefan Sperling9c62fc62018-03-16 10:23:34 +01001121 *consumed += elemlen;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001122 remain -= elemlen;
1123 }
1124 return i;
1125}
1126
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001127static 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 +01001128 size_t *consumed)
1129{
1130 struct osmo_location_area_id *id;
1131 int i = 0;
1132 const size_t elemlen = sizeof(struct gsm48_loc_area_id);
1133
1134 *consumed = 0;
1135 while (remain >= elemlen) {
1136 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1137 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001138 id = &cil->id_list[i].lai_and_lac;
Stefan Sperling23381452018-03-15 19:38:15 +01001139 decode_lai(&data[i * elemlen], id);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001140 *consumed += elemlen;
1141 remain -= elemlen;
1142 i++;
1143 }
1144
1145 return i;
1146}
1147
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001148static 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 +01001149{
1150 const uint16_t *lac_be = (const uint16_t *)data;
1151 int i = 0;
1152 const size_t elemlen = sizeof(*lac_be);
1153
1154 *consumed = 0;
1155 while (remain >= elemlen) {
1156 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1157 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001158 cil->id_list[i++].lac = osmo_load16be(lac_be++);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001159 *consumed += elemlen;
1160 remain -= elemlen;
1161 }
1162 return i;
1163}
1164
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001165/*! Decode Cell Identifier List IE
Harald Welte96e2a002017-06-12 21:44:18 +02001166 * \param[out] cil Caller-provided memory to store Cell ID list
1167 * \param[in] elem IE value to be decoded
1168 * \param[in] len Length of \a elem in bytes
1169 * \returns number of bytes parsed; negative on error */
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001170int gsm0808_dec_cell_id_list2(struct gsm0808_cell_id_list2 *cil,
1171 const uint8_t *elem, uint8_t len)
1172{
1173 uint8_t id_discr;
1174 size_t bytes_elem = 0;
1175 int list_len = 0;
1176
1177 OSMO_ASSERT(cil);
1178 if (!elem)
1179 return -EINVAL;
1180 if (len == 0)
1181 return -EINVAL;
1182
1183 memset(cil, 0, sizeof(*cil));
1184
1185 id_discr = *elem & 0x0f;
1186 elem++;
1187 len--;
1188
1189 switch (id_discr) {
1190 case CELL_IDENT_WHOLE_GLOBAL:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001191 list_len = parse_cell_id_global_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001192 break;
1193 case CELL_IDENT_LAC_AND_CI:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001194 list_len = parse_cell_id_lac_and_ci_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001195 break;
1196 case CELL_IDENT_CI:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001197 list_len = parse_cell_id_ci_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001198 break;
1199 case CELL_IDENT_LAI_AND_LAC:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001200 list_len = parse_cell_id_lai_and_lac(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001201 break;
1202 case CELL_IDENT_LAC:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001203 list_len = parse_cell_id_lac_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001204 break;
1205 case CELL_IDENT_BSS:
1206 case CELL_IDENT_NO_CELL:
1207 /* Does not have any list items */
1208 break;
1209 default:
1210 /* Remaining cell identification types are not implemented. */
1211 return -EINVAL;
1212 }
1213
1214 if (list_len < 0) /* parsing error */
1215 return list_len;
1216
1217 cil->id_discr = id_discr;
1218 cil->id_list_len = list_len;
1219
1220 /* One byte for the cell ID discriminator + any remaining bytes in
1221 * the IE which were consumed by the parser functions above. */
1222 return 1 + (int)bytes_elem;
1223}
1224
1225/*! DEPRECATED: Use gsm0808_dec_cell_id_list2 instead.
1226 *
1227 * Decode Cell Identifier List IE
1228 * \param[out] cil Caller-provided memory to store Cell ID list
1229 * \param[in] elem IE value to be decoded
1230 * \param[in] len Length of \a elem in bytes
1231 * \returns number of bytes parsed; negative on error */
Philipp Maier783047e2017-03-29 11:35:50 +02001232int gsm0808_dec_cell_id_list(struct gsm0808_cell_id_list *cil,
1233 const uint8_t *elem, uint8_t len)
1234{
1235 uint8_t id_discr;
1236 const uint8_t *old_elem = elem;
1237 unsigned int item_count = 0;
1238
1239 OSMO_ASSERT(cil);
1240 if (!elem)
1241 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +02001242 if (len == 0)
Philipp Maier783047e2017-03-29 11:35:50 +02001243 return -EINVAL;
1244
1245 memset(cil, 0, sizeof(*cil));
1246
1247 id_discr = *elem & 0x0f;
1248 elem++;
1249 len--;
1250
1251 cil->id_discr = id_discr;
1252
1253 switch (id_discr) {
1254 case CELL_IDENT_LAC:
1255 while (len >= 2) {
1256 cil->id_list_lac[item_count] = osmo_load16be(elem);
1257 elem += 2;
1258 item_count++;
1259 len -= 2;
1260 }
1261 case CELL_IDENT_BSS:
1262 /* Does not have any list items */
1263 break;
1264 default:
1265 /* FIXME: Implement support for all identifier list elements */
1266 return -EINVAL;
1267 }
1268
1269 cil->id_list_len = item_count;
1270 return (int)(elem - old_elem);
1271}
Harald Welte96e2a002017-06-12 21:44:18 +02001272
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001273static bool same_cell_id_list_entries(const struct gsm0808_cell_id_list2 *a, int ai,
1274 const struct gsm0808_cell_id_list2 *b, int bi)
1275{
1276 struct gsm0808_cell_id_list2 tmp = {
1277 .id_discr = a->id_discr,
1278 .id_list_len = 1,
1279 };
1280 uint8_t buf_a[32 + sizeof(struct msgb)];
1281 uint8_t buf_b[32 + sizeof(struct msgb)];
1282 struct msgb *msg_a = (void*)buf_a;
1283 struct msgb *msg_b = (void*)buf_b;
1284
1285 msg_a->data_len = 32;
1286 msg_b->data_len = 32;
1287 msgb_reset(msg_a);
1288 msgb_reset(msg_b);
1289
1290 if (a->id_discr != b->id_discr)
1291 return false;
1292 if (ai >= a->id_list_len
1293 || bi >= b->id_list_len)
1294 return false;
1295
1296 tmp.id_list[0] = a->id_list[ai];
1297 gsm0808_enc_cell_id_list2(msg_a, &tmp);
1298
1299 tmp.id_list[0] = b->id_list[bi];
1300 gsm0808_enc_cell_id_list2(msg_b, &tmp);
1301
1302 if (msg_a->len != msg_b->len)
1303 return false;
1304 if (memcmp(msg_a->data, msg_b->data, msg_a->len))
1305 return false;
1306
1307 return true;
1308}
1309
1310/*! Append entries from one Cell Identifier List to another.
1311 * The cell identifier types must be identical between the two lists.
1312 * \param dst[out] Append entries to this list.
1313 * \param src[in] Append these entries to \a dst.
1314 * \returns the nr of items added, or negative on error: -EINVAL if the id_discr mismatch
1315 * between the lists, -ENOSPC if the destination list does not have enough space. If an error is
1316 * returned, \a dst may have already been changed (particularly on -ENOSPC). Note that a return value
1317 * of zero may occur when the src->id_list_len is zero, or when all entries from \a src already exist
1318 * in \a dst, and does not indicate error per se. */
1319int gsm0808_cell_id_list_add(struct gsm0808_cell_id_list2 *dst, const struct gsm0808_cell_id_list2 *src)
1320{
1321 int i, j;
1322 int added = 0;
1323
1324 if (dst->id_list_len == 0
1325 && dst->id_discr != CELL_IDENT_BSS)
1326 dst->id_discr = src->id_discr;
1327 else if (dst->id_discr != src->id_discr)
1328 return -EINVAL;
1329
1330 for (i = 0; i < src->id_list_len; i++) {
1331 /* don't add duplicate entries */
1332 bool skip = false;
1333 for (j = 0; j < dst->id_list_len; j++) {
1334 if (same_cell_id_list_entries(dst, j, src, i)) {
1335 skip = true;
1336 break;
1337 }
1338 }
1339 if (skip)
1340 continue;
1341
1342 if (dst->id_list_len >= ARRAY_SIZE(dst->id_list))
1343 return -ENOSPC;
1344
1345 dst->id_list[dst->id_list_len++] = src->id_list[i];
1346 added ++;
1347 }
1348
1349 return added;
1350}
1351
Neels Hofmeyr38e58412018-05-25 16:56:35 +02001352/*! Convert a single Cell Identifier to a Cell Identifier List with one entry.
1353 * \param dst[out] Overwrite this list.
1354 * \param src[in] Set \a dst to contain exactly this item.
1355 */
1356void gsm0808_cell_id_to_list(struct gsm0808_cell_id_list2 *dst, const struct gsm0808_cell_id *src)
1357{
1358 if (!dst)
1359 return;
1360 if (!src) {
1361 *dst = (struct gsm0808_cell_id_list2){
1362 .id_discr = CELL_IDENT_NO_CELL,
1363 };
1364 return;
1365 }
1366
1367 *dst = (struct gsm0808_cell_id_list2){
1368 .id_discr = src->id_discr,
1369 .id_list = { src->id },
1370 .id_list_len = 1,
1371 };
1372
1373 switch (src->id_discr) {
1374 case CELL_IDENT_NO_CELL:
1375 case CELL_IDENT_BSS:
1376 dst->id_list_len = 0;
1377 break;
1378 default:
1379 break;
1380 }
1381}
1382
Neels Hofmeyr250e7f72018-04-13 03:30:14 +02001383/*! Encode Cell Identifier IE (3GPP TS 48.008 3.2.2.17).
1384 * \param[out] msg Message Buffer to which IE is to be appended
1385 * \param[in] ci Cell ID to be encoded
1386 * \returns number of bytes appended to \a msg */
1387uint8_t gsm0808_enc_cell_id(struct msgb *msg, const struct gsm0808_cell_id *ci)
1388{
1389 uint8_t rc;
1390 uint8_t *ie_tag;
1391 struct gsm0808_cell_id_list2 cil = {
1392 .id_discr = ci->id_discr,
1393 .id_list = { ci->id },
1394 .id_list_len = 1,
1395 };
1396
1397 OSMO_ASSERT(msg);
1398 OSMO_ASSERT(ci);
1399
1400 ie_tag = msg->tail;
1401 rc = gsm0808_enc_cell_id_list2(msg, &cil);
1402
1403 if (rc <= 0)
1404 return rc;
1405
1406 *ie_tag = GSM0808_IE_CELL_IDENTIFIER;
1407 return rc;
1408}
1409
1410/*! Decode Cell Identifier IE (3GPP TS 48.008 3.2.2.17).
1411 * \param[out] ci Caller-provided memory to store Cell ID.
1412 * \param[in] elem IE value to be decoded.
1413 * \param[in] len Length of \a elem in bytes.
1414 * \returns number of bytes parsed; negative on error */
1415int gsm0808_dec_cell_id(struct gsm0808_cell_id *ci, const uint8_t *elem, uint8_t len)
1416{
1417 struct gsm0808_cell_id_list2 cil;
1418 int rc;
1419 rc = gsm0808_dec_cell_id_list2(&cil, elem, len);
1420 if (rc < 0)
1421 return rc;
1422 if (cil.id_discr == CELL_IDENT_BSS || cil.id_discr == CELL_IDENT_NO_CELL) {
1423 if (cil.id_list_len != 0)
1424 return -EINVAL;
1425 } else {
1426 if (cil.id_list_len != 1)
1427 return -EINVAL;
1428 }
1429 ci->id_discr = cil.id_discr;
1430 ci->id = cil.id_list[0];
1431 return rc;
1432}
1433
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001434/*! Convert the representation of the permitted speech codec identifier
Philipp Maier3149b0d2017-06-02 13:22:34 +02001435 * that is used in struct gsm0808_channel_type to the speech codec
1436 * representation we use in struct gsm0808_speech_codec.
1437 * \param[in] perm_spch to be converted (see also gsm0808_permitted_speech)
1438 * \returns GSM speech codec type; negative on error */
1439int gsm0808_chan_type_to_speech_codec(uint8_t perm_spch)
1440{
1441 /*! The speech codec type, which is used in the channel type field to
1442 * signal the permitted speech versions (codecs) has a different
1443 * encoding than the type field in the speech codec type element
1444 * (See also 3GPP TS 48.008, 3.2.2.11 and 3.2.2.103) */
1445
1446 switch (perm_spch) {
1447 case GSM0808_PERM_FR1:
1448 return GSM0808_SCT_FR1;
1449 case GSM0808_PERM_FR2:
1450 return GSM0808_SCT_FR2;
1451 case GSM0808_PERM_FR3:
1452 return GSM0808_SCT_FR3;
1453 case GSM0808_PERM_FR4:
1454 return GSM0808_SCT_FR4;
1455 case GSM0808_PERM_FR5:
1456 return GSM0808_SCT_FR5;
1457 case GSM0808_PERM_HR1:
1458 return GSM0808_SCT_HR1;
1459 case GSM0808_PERM_HR3:
1460 return GSM0808_SCT_HR3;
1461 case GSM0808_PERM_HR4:
1462 return GSM0808_SCT_HR4;
1463 case GSM0808_PERM_HR6:
1464 return GSM0808_SCT_HR6;
1465 }
1466
1467 /* Invalid input */
1468 return -EINVAL;
1469}
1470
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001471/*! Extrapolate a speech codec field from a given permitted speech
Philipp Maier884ba0f2017-06-02 13:49:16 +02001472 * parameter (channel type).
1473 * \param[out] sc Caller provided memory to store the resulting speech codec
1474 * \param[in] perm_spch value that is used to derive the speech codec info
1475 * (see also: enum gsm0808_speech_codec_type in gsm0808_utils.h)
1476 * \returns zero when successful; negative on error */
1477int gsm0808_speech_codec_from_chan_type(struct gsm0808_speech_codec *sc,
1478 uint8_t perm_spch)
1479{
1480 int rc;
1481
1482 memset(sc, 0, sizeof(*sc));
1483
1484 /* Determine codec type */
1485 rc = gsm0808_chan_type_to_speech_codec(perm_spch);
1486 if (rc < 0)
1487 return -EINVAL;
1488 sc->type = (uint8_t) rc;
1489
1490 /* Depending on the speech codec type, pick a default codec
1491 * configuration that exactly matches the configuration on the
1492 * air interface. */
1493 switch (sc->type) {
1494 case GSM0808_SCT_FR3:
1495 sc->cfg = GSM0808_SC_CFG_DEFAULT_FR_AMR;
1496 break;
1497 case GSM0808_SCT_FR4:
1498 sc->cfg = GSM0808_SC_CFG_DEFAULT_OFR_AMR_WB;
1499 break;
1500 case GSM0808_SCT_FR5:
1501 sc->cfg = GSM0808_SC_CFG_DEFAULT_FR_AMR_WB;
1502 break;
1503 case GSM0808_SCT_HR3:
1504 sc->cfg = GSM0808_SC_CFG_DEFAULT_HR_AMR;
1505 break;
1506 case GSM0808_SCT_HR4:
1507 sc->cfg = GSM0808_SC_CFG_DEFAULT_OHR_AMR_WB;
1508 break;
1509 case GSM0808_SCT_HR6:
1510 sc->cfg = GSM0808_SC_CFG_DEFAULT_OHR_AMR;
1511 break;
1512 default:
1513 /* Note: Not all codec types specify a default setting,
1514 * in this case, we just set the field to zero. */
1515 sc->cfg = 0;
1516 }
1517
1518 /* Tag all codecs as "Full IP"
1519 * (see als 3GPP TS 48.008 3.2.2.103) */
1520 sc->fi = true;
1521
1522 return 0;
1523}
1524
Philipp Maier5f2eb152018-09-19 13:40:21 +02001525/*! Determine a set of AMR speech codec configuration bits (S0-S15) from a
1526 * given GSM 04.08 AMR configuration struct.
1527 * \param[in] cfg AMR configuration in GSM 04.08 format.
1528 * \param[in] hint if the resulting configuration shall be used with a FR or HR TCH.
1529 * \returns configuration bits (S0-S15) */
Philipp Maier369015c2018-09-21 09:07:20 +02001530uint16_t gsm0808_sc_cfg_from_gsm48_mr_cfg(const struct gsm48_multi_rate_conf *cfg,
Philipp Maier5f2eb152018-09-19 13:40:21 +02001531 bool fr)
1532{
1533 uint16_t s15_s0 = 0;
1534
1535 /* Check each rate bit in the AMR multirate configuration and pick the
1536 * matching default configuration as specified in 3GPP TS 28.062,
1537 * Table 7.11.3.1.3-2. */
1538 if (cfg->m4_75)
1539 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_4_75;
1540 if (cfg->m5_15)
1541 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_5_15;
1542 if (cfg->m5_90)
1543 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_5_90;
1544 if (cfg->m6_70)
1545 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_6_70;
1546 if (cfg->m7_40)
1547 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_7_40;
1548 if (cfg->m7_95)
1549 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_7_95;
1550 if (cfg->m10_2)
1551 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_10_2;
1552 if (cfg->m12_2)
1553 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_12_2;
1554
1555 /* Note: 3GPP TS 48.008, chapter 3GPP TS 48.008 states that for AMR
1556 * some of the configuration bits must be coded as zeros. The applied
1557 * bitmask matches the default codec settings. See also the definition
1558 * of enum gsm0808_speech_codec_defaults in gsm_08_08.h and
1559 * 3GPP TS 28.062, Table 7.11.3.1.3-2. */
1560 if (fr)
1561 s15_s0 &= GSM0808_SC_CFG_DEFAULT_FR_AMR;
1562 else
1563 s15_s0 &= GSM0808_SC_CFG_DEFAULT_HR_AMR;
1564
Philipp Maier94d79fd2019-03-01 10:40:48 +01001565 /* The mode that is encoded by S1 (Config-NB-Code = 1), takes a special
1566 * role as it does not stand for a single rate, but for up to four rates
1567 * at once (12.2, 7.4, 5.9, 4.75). We must check if the supplied cfg
1568 * covers this mode. If not, we need to make sure that the related
1569 * bit is removed. (See also 3GPP TS 28.062, Table 7.11.3.1.3-2) */
1570 if (!(cfg->m12_2 && cfg->m7_40 && cfg->m5_90 && cfg->m4_75) && fr)
1571 s15_s0 &= ~GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20;
1572 else if (!(cfg->m7_40 && cfg->m5_90 && cfg->m4_75))
1573 s15_s0 &= ~GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20;
1574
Philipp Maier5f2eb152018-09-19 13:40:21 +02001575 return s15_s0;
1576}
1577
Philipp Maier8515d032018-09-25 15:57:49 +02001578/*! Determine a GSM 04.08 AMR configuration struct from a set of speech codec
1579 * configuration bits (S0-S15)
1580 * \param[out] cfg AMR configuration in GSM 04.08 format.
Philipp Maier3713af82019-02-27 16:48:25 +01001581 * \param[in] s15_s0 configuration bits (S15-S0, non-ambiguous).
1582 * \returns zero when successful; negative on error */
1583int gsm48_mr_cfg_from_gsm0808_sc_cfg(struct gsm48_multi_rate_conf *cfg,
1584 uint16_t s15_s0)
Philipp Maier8515d032018-09-25 15:57:49 +02001585{
Philipp Maier3713af82019-02-27 16:48:25 +01001586 unsigned int count = 0;
1587
1588 /* Note: See also: 3GPP TS 28.062
1589 * Table 7.11.3.1.3-2: Preferred Configurations for the Adaptive
1590 * Multi-Rate Codec Types */
1591
1592 /* Note: The resulting multirate-configuration must not contain an
1593 * active set of more than four codec rates. The active set also
1594 * must contain at least one rate. */
1595
Philipp Maier8515d032018-09-25 15:57:49 +02001596 memset(cfg, 0, sizeof(*cfg));
Philipp Maier3713af82019-02-27 16:48:25 +01001597 cfg->ver = 1;
1598 cfg->icmi = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001599
1600 /* Strip option bits */
1601 s15_s0 &= 0x00ff;
1602
Philipp Maier3713af82019-02-27 16:48:25 +01001603 /* Rate 5,15k can never be selected (see table) */
1604 cfg->m5_15 = 0;
Philipp Maier8515d032018-09-25 15:57:49 +02001605
Neels Hofmeyra0f2b212021-04-14 22:45:13 +02001606 if (s15_s0 & GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20) {
Philipp Maier3713af82019-02-27 16:48:25 +01001607 /* Table Table 7.11.3.1.3-2 lists one mode that selects 4
1608 * rates at once (Config-NB-Code = 1). The rates selected
1609 * are known to be compatible between GERAN and UTRAN, since
1610 * an active set must not contain more than four rates at
1611 * a time, we ignore all other settings as they are either
1612 * redundaned or excess settings (invalid) */
Philipp Maier8515d032018-09-25 15:57:49 +02001613 cfg->m4_75 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001614 cfg->m5_90 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001615 cfg->m7_40 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001616 cfg->m12_2 = 1;
Philipp Maier3713af82019-02-27 16:48:25 +01001617 count += 4;
1618 }
Philipp Maier8515d032018-09-25 15:57:49 +02001619
Philipp Maier3713af82019-02-27 16:48:25 +01001620 /* Check the bits in s15_s0 and set the flags for the
1621 * respective rates. */
1622 if (s15_s0 & GSM0808_SC_CFG_AMR_4_75 && !cfg->m4_75) {
1623 if (count >= 4)
1624 return -EINVAL;
1625 cfg->m4_75 = 1;
1626 count++;
1627 }
1628 if (s15_s0 & GSM0808_SC_CFG_AMR_5_90 && !cfg->m5_90) {
1629 if (count >= 4)
1630 return -EINVAL;
1631 cfg->m5_90 = 1;
1632 count++;
1633 }
1634 if (s15_s0 & GSM0808_SC_CFG_AMR_6_70) {
1635 if (count >= 4)
1636 return -EINVAL;
1637 cfg->m6_70 = 1;
1638 count++;
1639 }
1640 if (s15_s0 & GSM0808_SC_CFG_AMR_7_40 && !cfg->m7_40) {
1641 if (count >= 4)
1642 return -EINVAL;
1643 cfg->m7_40 = 1;
1644 count++;
1645 }
1646 if (s15_s0 & GSM0808_SC_CFG_AMR_7_95) {
1647 if (count >= 4)
1648 return -EINVAL;
1649 cfg->m7_95 = 1;
1650 count++;
1651 }
1652 if (s15_s0 & GSM0808_SC_CFG_AMR_10_2) {
1653 if (count >= 4)
1654 return -EINVAL;
1655 cfg->m10_2 = 1;
1656 count++;
1657 }
1658 if (s15_s0 & GSM0808_SC_CFG_AMR_12_2 && !cfg->m12_2) {
1659 if (count >= 4)
1660 return -EINVAL;
1661 cfg->m12_2 = 1;
1662 count++;
1663 }
1664
1665 if (count == 0)
1666 return -EINVAL;
1667
1668 return 0;
Philipp Maier8515d032018-09-25 15:57:49 +02001669}
1670
Alexander Chemeris2ac8f912020-05-13 22:38:08 +03001671int gsm0808_get_cipher_reject_cause(const struct tlv_parsed *tp)
1672{
1673 return gsm0808_get_cause(tp);
1674}
1675
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001676/*! Print a human readable name of the cell identifier to the char buffer.
1677 * This is useful both for struct gsm0808_cell_id and struct gsm0808_cell_id_list2.
1678 * See also gsm0808_cell_id_name() and gsm0808_cell_id_list_name().
1679 * \param[out] buf Destination buffer to write string representation to.
1680 * \param[in] buflen Amount of memory available in \a buf.
1681 * \param[in] id_discr Cell Identifier type.
1682 * \param[in] u Cell Identifer value.
1683 * \returns Like snprintf(): the amount of characters (excluding terminating nul) written,
1684 * or that would have been written if the buffer were large enough.
1685 */
1686int gsm0808_cell_id_u_name(char *buf, size_t buflen,
1687 enum CELL_IDENT id_discr, const union gsm0808_cell_id_u *u)
1688{
1689 switch (id_discr) {
1690 case CELL_IDENT_LAC:
1691 return snprintf(buf, buflen, "%u", u->lac);
1692 case CELL_IDENT_CI:
1693 return snprintf(buf, buflen, "%u", u->ci);
1694 case CELL_IDENT_LAC_AND_CI:
1695 return snprintf(buf, buflen, "%u-%u", u->lac_and_ci.lac, u->lac_and_ci.ci);
1696 case CELL_IDENT_LAI_AND_LAC:
1697 return snprintf(buf, buflen, "%s", osmo_lai_name(&u->lai_and_lac));
1698 case CELL_IDENT_WHOLE_GLOBAL:
1699 return snprintf(buf, buflen, "%s", osmo_cgi_name(&u->global));
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001700 case CELL_IDENT_WHOLE_GLOBAL_PS:
1701 return snprintf(buf, buflen, "%s", osmo_cgi_ps_name(&u->global_ps));
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001702 default:
1703 /* For CELL_IDENT_BSS and CELL_IDENT_NO_CELL, just print the discriminator.
1704 * Same for kinds we have no string representation of yet. */
1705 return snprintf(buf, buflen, "%s", gsm0808_cell_id_discr_name(id_discr));
1706 }
1707}
1708
Neels Hofmeyrd01ef752018-09-21 15:57:26 +02001709/*! Return true if the common information between the two Cell Identifiers match.
1710 * For example, if a LAC+CI is compared to LAC, return true if the LAC are the same.
1711 * Note that CELL_IDENT_NO_CELL will always return false.
1712 * Also CELL_IDENT_BSS will always return false, since this function cannot possibly
1713 * know the bounds of the BSS, so the caller must handle CELL_IDENT_BSS specially.
1714 * \param[in] discr1 Cell Identifier type.
1715 * \param[in] u1 Cell Identifier value.
1716 * \param[in] discr2 Other Cell Identifier type.
1717 * \param[in] u2 Other Cell Identifier value.
1718 * \param[in] exact_match If true, return true only if the CELL_IDENT types and all values are identical.
1719 * \returns True if the common fields of the above match.
1720 */
1721static bool gsm0808_cell_id_u_match(enum CELL_IDENT discr1, const union gsm0808_cell_id_u *u1,
1722 enum CELL_IDENT discr2, const union gsm0808_cell_id_u *u2,
1723 bool exact_match)
1724{
1725 struct osmo_cell_global_id a = {};
1726 struct osmo_cell_global_id b = {};
1727
1728 if (exact_match && discr1 != discr2)
1729 return false;
1730
1731 /* First handle the odd wildcard like CELL_IDENT kinds. We can't really match any of these. */
1732 switch (discr1) {
1733 case CELL_IDENT_NO_CELL:
1734 case CELL_IDENT_BSS:
1735 return discr1 == discr2;
1736 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1737 case CELL_IDENT_UTRAN_RNC:
1738 case CELL_IDENT_UTRAN_LAC_RNC:
1739 return false;
1740 default:
1741 break;
1742 }
1743 switch (discr2) {
1744 case CELL_IDENT_NO_CELL:
1745 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1746 case CELL_IDENT_UTRAN_RNC:
1747 case CELL_IDENT_UTRAN_LAC_RNC:
1748 case CELL_IDENT_BSS:
1749 return false;
1750 default:
1751 break;
1752 }
1753
1754 /* Enrich both sides to full CGI, then compare those. First set the *other* ID's values in case
1755 * they assign more items. For example:
1756 * u1 = LAC:42
1757 * u2 = LAC+CI:23+5
1758 * 1) a <- LAC+CI:23+5
1759 * 2) a <- LAC:42 so that a = LAC+CI:42+5
1760 * Now we can compare those two and find a mismatch. If the LAC were the same, we would get
1761 * identical LAC+CI and hence a match. */
1762
1763 cell_id_to_cgi(&a, discr2, u2);
1764 cell_id_to_cgi(&a, discr1, u1);
1765
1766 cell_id_to_cgi(&b, discr1, u1);
1767 cell_id_to_cgi(&b, discr2, u2);
1768
1769 return osmo_cgi_cmp(&a, &b) == 0;
1770}
1771
1772/*! Return true if the common information between the two Cell Identifiers match.
1773 * For example, if a LAC+CI is compared to LAC, return true if the LAC are the same.
1774 * Note that CELL_IDENT_NO_CELL will always return false.
1775 * Also CELL_IDENT_BSS will always return false, since this function cannot possibly
1776 * know the bounds of the BSS, so the caller must handle CELL_IDENT_BSS specially.
1777 * \param[in] id1 Cell Identifier.
1778 * \param[in] id2 Other Cell Identifier.
1779 * \param[in] exact_match If true, return true only if the CELL_IDENT types and all values are identical.
1780 * \returns True if the common fields of the above match.
1781 */
1782bool gsm0808_cell_ids_match(const struct gsm0808_cell_id *id1, const struct gsm0808_cell_id *id2, bool exact_match)
1783{
1784 return gsm0808_cell_id_u_match(id1->id_discr, &id1->id, id2->id_discr, &id2->id, exact_match);
1785}
1786
1787/*! Find an index in a Cell Identifier list that matches a given single Cell Identifer.
1788 * Compare \a id against each entry in \a list using gsm0808_cell_ids_match(), and return the list index
1789 * if a match is found. \a match_nr allows iterating all matches in the list. A match_nr <= 0 returns the
1790 * first match in the list, match_nr == 1 the second match, etc., and if match_nr exceeds the available
1791 * matches in the list, -1 is returned.
1792 * \param[in] id Cell Identifier to match.
1793 * \param[in] list Cell Identifier list to search in.
1794 * \param[in] match_nr Ignore this many matches.
1795 * \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 +01001796 * \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
1797 * entry).
Neels Hofmeyrd01ef752018-09-21 15:57:26 +02001798 */
1799int gsm0808_cell_id_matches_list(const struct gsm0808_cell_id *id, const struct gsm0808_cell_id_list2 *list,
1800 unsigned int match_nr, bool exact_match)
1801{
1802 int i;
1803 for (i = 0; i < list->id_list_len; i++) {
1804 if (gsm0808_cell_id_u_match(id->id_discr, &id->id, list->id_discr, &list->id_list[i], exact_match)) {
1805 if (match_nr)
1806 match_nr--;
1807 else
1808 return i;
1809 }
1810 }
1811 return -1;
1812}
1813
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001814/*! Copy information from a CGI to form a Cell Identifier of the specified kind.
1815 * \param [out] cid Compose new Cell Identifier here.
1816 * \param [in] id_discr Which kind of Cell Identifier to compose.
1817 * \param [in] cgi Cell Global Identifier to form the Cell Identifier from.
1818 */
1819void gsm0808_cell_id_from_cgi(struct gsm0808_cell_id *cid, enum CELL_IDENT id_discr,
1820 const struct osmo_cell_global_id *cgi)
1821{
1822 *cid = (struct gsm0808_cell_id){
1823 .id_discr = id_discr,
1824 };
1825
1826 switch (id_discr) {
1827 case CELL_IDENT_WHOLE_GLOBAL:
1828 cid->id.global = *cgi;
1829 return;
1830
Pau Espin Pedrol20b763d2021-02-15 16:06:22 +01001831 case CELL_IDENT_WHOLE_GLOBAL_PS:
1832 cid->id.global_ps = (struct osmo_cell_global_id_ps){
1833 .rai = {
1834 .lac = cgi->lai,
1835 },
1836 .cell_identity = cgi->cell_identity,
1837 };
1838 return;
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001839 case CELL_IDENT_LAC_AND_CI:
1840 cid->id.lac_and_ci = (struct osmo_lac_and_ci_id){
1841 .lac = cgi->lai.lac,
1842 .ci = cgi->cell_identity,
1843 };
1844 return;
1845
1846 case CELL_IDENT_CI:
1847 cid->id.ci = cgi->cell_identity;
1848 return;
1849
1850 case CELL_IDENT_LAI:
1851 cid->id.lai_and_lac = cgi->lai;
1852 return;
1853
1854 case CELL_IDENT_LAC:
1855 cid->id.lac = cgi->lai.lac;
1856 return;
1857
1858 case CELL_IDENT_NO_CELL:
1859 case CELL_IDENT_BSS:
1860 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1861 case CELL_IDENT_UTRAN_RNC:
1862 case CELL_IDENT_UTRAN_LAC_RNC:
1863 default:
1864 return;
1865 };
1866}
1867
1868/*! Overwrite parts of cgi with values from a Cell Identifier.
1869 * Place only those items given in cid into cgi, leaving other values unchanged.
1870 * \param[out] cgi Cell Global Identity to write to.
1871 * \param[in] cid Cell Identity to read from.
1872 * \return a bitmask of items that were set: OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI; 0 if nothing was
1873 * written to cgi.
1874 */
1875int gsm0808_cell_id_to_cgi(struct osmo_cell_global_id *cgi, const struct gsm0808_cell_id *cid)
1876{
1877 switch (cid->id_discr) {
1878 case CELL_IDENT_WHOLE_GLOBAL:
1879 *cgi = cid->id.global;
1880 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1881
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001882 case CELL_IDENT_WHOLE_GLOBAL_PS:
1883 cgi->lai = cid->id.global_ps.rai.lac;
1884 cgi->cell_identity = cid->id.global_ps.cell_identity;
1885 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1886
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001887 case CELL_IDENT_LAC_AND_CI:
1888 cgi->lai.lac = cid->id.lac_and_ci.lac;
1889 cgi->cell_identity = cid->id.lac_and_ci.ci;
1890 return OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1891
1892 case CELL_IDENT_CI:
1893 cgi->cell_identity = cid->id.ci;
1894 return OSMO_CGI_PART_CI;
1895
1896 case CELL_IDENT_LAI:
1897 cgi->lai = cid->id.lai_and_lac;
1898 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC;
1899
1900 case CELL_IDENT_LAC:
1901 cgi->lai.lac = cid->id.lac;
1902 return OSMO_CGI_PART_LAC;
1903
1904 case CELL_IDENT_NO_CELL:
1905 case CELL_IDENT_BSS:
1906 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1907 case CELL_IDENT_UTRAN_RNC:
1908 case CELL_IDENT_UTRAN_LAC_RNC:
1909 default:
1910 return 0;
1911 };
1912}
1913
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001914/*! value_string[] for enum CELL_IDENT. */
1915const struct value_string gsm0808_cell_id_discr_names[] = {
1916 { CELL_IDENT_WHOLE_GLOBAL, "CGI" },
1917 { CELL_IDENT_LAC_AND_CI, "LAC-CI" },
1918 { CELL_IDENT_CI, "CI" },
1919 { CELL_IDENT_NO_CELL, "NO-CELL" },
1920 { CELL_IDENT_LAI_AND_LAC, "LAI" },
1921 { CELL_IDENT_LAC, "LAC" },
1922 { CELL_IDENT_BSS, "BSS" },
1923 { CELL_IDENT_UTRAN_PLMN_LAC_RNC, "UTRAN-PLMN-LAC-RNC" },
1924 { CELL_IDENT_UTRAN_RNC, "UTRAN-RNC" },
1925 { CELL_IDENT_UTRAN_LAC_RNC, "UTRAN-LAC-RNC" },
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001926 { CELL_IDENT_WHOLE_GLOBAL_PS, "CGI-PS"},
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001927 { 0, NULL }
1928};
1929
1930#define APPEND_THING(func, args...) do { \
1931 int remain = buflen - (pos - buf); \
1932 int l = func(pos, remain, ##args); \
1933 if (l < 0 || l > remain) \
1934 pos = buf + buflen; \
1935 else \
1936 pos += l; \
1937 if (l > 0) \
1938 total_len += l; \
1939 } while(0)
1940#define APPEND_STR(fmt, args...) APPEND_THING(snprintf, fmt, ##args)
1941#define APPEND_CELL_ID_U(DISCR, U) APPEND_THING(gsm0808_cell_id_u_name, DISCR, U)
1942
Harald Welte179f3572019-03-18 18:38:47 +01001943char *gsm0808_cell_id_name_buf(char *buf, size_t buflen, const struct gsm0808_cell_id *cid)
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001944{
1945 char *pos = buf;
1946 int total_len = 0;
1947 APPEND_STR("%s:", gsm0808_cell_id_discr_name(cid->id_discr));
1948 APPEND_CELL_ID_U(cid->id_discr, &cid->id);
1949 return buf;
1950}
1951
1952/*! Return a human readable representation of a Cell Identifier, like "LAC:123"
1953 * or "CGI:001-01-42-23".
1954 * \param[in] cid Cell Identifer.
1955 * \returns String in a static buffer.
1956 */
1957const char *gsm0808_cell_id_name(const struct gsm0808_cell_id *cid)
1958{
Harald Welte171ef822019-03-28 10:49:05 +01001959 static __thread char buf[64];
Harald Welte179f3572019-03-18 18:38:47 +01001960 return gsm0808_cell_id_name_buf(buf, sizeof(buf), cid);
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001961}
1962
1963/*! Like gsm0808_cell_id_name() but uses a different static buffer.
1964 * \param[in] cid Cell Identifer.
1965 * \returns String in a static buffer.
1966 */
1967const char *gsm0808_cell_id_name2(const struct gsm0808_cell_id *cid)
1968{
Harald Welte171ef822019-03-28 10:49:05 +01001969 static __thread char buf[64];
Harald Welte179f3572019-03-18 18:38:47 +01001970 return gsm0808_cell_id_name_buf(buf, sizeof(buf), cid);
1971}
1972
1973char *gsm0808_cell_id_name_c(const void *ctx, const struct gsm0808_cell_id *cid)
1974{
1975 char *buf = talloc_size(ctx, 64);
1976 if (!buf)
1977 return NULL;
1978 return gsm0808_cell_id_name_buf(buf, 64, cid);
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001979}
1980
1981/*! Return a human readable representation of the Cell Identifier List, like
1982 * "LAC[2]:{123, 456}".
1983 * The return value semantics are like snprintf() and thus allow ensuring a complete
1984 * untruncated string by determining the required string length from the return value.
1985 * If buflen > 0, always nul-terminate the string in buf, also when it is truncated.
1986 * If buflen == 0, do not modify buf, just return the would-be length.
1987 * \param[out] buf Destination buffer to write string representation to.
1988 * \param[in] buflen Amount of memory available in \a buf.
1989 * \param[in] cil Cell Identifer List.
1990 * \returns Like snprintf(): the amount of characters (excluding terminating nul) written,
1991 * or that would have been written if the buffer were large enough.
1992 */
1993int gsm0808_cell_id_list_name_buf(char *buf, size_t buflen, const struct gsm0808_cell_id_list2 *cil)
1994{
1995 char *pos = buf;
1996 int total_len = 0;
1997 int i;
1998
1999 APPEND_STR("%s[%u]", gsm0808_cell_id_discr_name(cil->id_discr), cil->id_list_len);
2000
2001 switch (cil->id_discr) {
2002 case CELL_IDENT_BSS:
2003 case CELL_IDENT_NO_CELL:
2004 return total_len;
2005 default:
2006 break;
2007 }
2008
2009 APPEND_STR(":{");
2010
2011 for (i = 0; i < cil->id_list_len; i++) {
2012 if (i)
2013 APPEND_STR(", ");
2014 APPEND_CELL_ID_U(cil->id_discr, &cil->id_list[i]);
2015 }
2016
2017 APPEND_STR("}");
2018 return total_len;
2019}
2020
2021/*! Return a human-readable representation of \a cil in a static buffer.
2022 * If the list is too long, the output may be truncated.
2023 * See also gsm0808_cell_id_list_name_buf(). */
2024const char *gsm0808_cell_id_list_name(const struct gsm0808_cell_id_list2 *cil)
2025{
Harald Welte171ef822019-03-28 10:49:05 +01002026 static __thread char buf[1024];
Neels Hofmeyra4399c82018-04-17 02:26:10 +02002027 gsm0808_cell_id_list_name_buf(buf, sizeof(buf), cil);
2028 return buf;
2029}
2030
Harald Welte179f3572019-03-18 18:38:47 +01002031char *gsm0808_cell_id_list_name_c(const void *ctx, const struct gsm0808_cell_id_list2 *cil)
2032{
2033 char *buf = talloc_size(ctx, 1024);
2034 if (!buf)
2035 return NULL;
2036 gsm0808_cell_id_list_name_buf(buf, 1024, cil);
2037 return buf;
2038}
2039
Neels Hofmeyra4399c82018-04-17 02:26:10 +02002040#undef APPEND_STR
2041#undef APPEND_CELL_ID_U
2042
Harald Welte4a62eda2019-03-18 18:27:00 +01002043char *gsm0808_channel_type_name_buf(char *buf, size_t buf_len, const struct gsm0808_channel_type *ct)
Neels Hofmeyrafacc2b2018-04-16 22:41:51 +02002044{
Harald Welte4a62eda2019-03-18 18:27:00 +01002045 snprintf(buf, buf_len, "ch_indctr=0x%x ch_rate_type=0x%x perm_spch=%s",
Neels Hofmeyrafacc2b2018-04-16 22:41:51 +02002046 ct->ch_indctr, ct->ch_rate_type,
2047 osmo_hexdump(ct->perm_spch, ct->perm_spch_len));
2048 return buf;
2049}
2050
Harald Welte4a62eda2019-03-18 18:27:00 +01002051const char *gsm0808_channel_type_name(const struct gsm0808_channel_type *ct)
2052{
Harald Welte171ef822019-03-28 10:49:05 +01002053 static __thread char buf[128];
Harald Welte4a62eda2019-03-18 18:27:00 +01002054 return gsm0808_channel_type_name_buf(buf, sizeof(buf), ct);
2055}
2056
Harald Welte179f3572019-03-18 18:38:47 +01002057char *gsm0808_channel_type_name_c(const void *ctx, const struct gsm0808_channel_type *ct)
2058{
2059 char *buf = talloc_size(ctx, 128);
2060 if (!buf)
2061 return NULL;
2062 return gsm0808_channel_type_name_buf(buf, 128, ct);
2063}
2064
Harald Welte96e2a002017-06-12 21:44:18 +02002065/*! @} */