blob: 78cbe92e8cf1d15a4e551aa1622f16c32161f8cb [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);
Neels Hofmeyr26e53b12021-06-10 00:47:03 +0200724 /* FIXME: 48.008 3.2.2.10 Encryption Information says:
725 * "When present, the key shall be 8 octets long." */
Philipp Maier14e76b92017-03-28 18:36:52 +0200726 ptr = msgb_put(msg, ei->key_len);
727 memcpy(ptr, ei->key, ei->key_len);
728
729 *tlv_len = (uint8_t) (msg->tail - old_tail);
730 return *tlv_len + 2;
731}
732
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200733/*! Decode TS 08.08 Encryption Information IE
Harald Welte96e2a002017-06-12 21:44:18 +0200734 * \param[out] ei Caller-provided memory to store encryption information
735 * \param[in] elem IE value to be decoded
736 * \param[in] len Length of \a elem in bytes
737 * \returns number of bytes parsed; negative on error */
Philipp Maier14e76b92017-03-28 18:36:52 +0200738int gsm0808_dec_encrypt_info(struct gsm0808_encrypt_info *ei,
739 const uint8_t *elem, uint8_t len)
740{
741 uint8_t perm_algo;
742 unsigned int i;
743 unsigned int perm_algo_len = 0;
744 const uint8_t *old_elem = elem;
745
746 OSMO_ASSERT(ei);
747 if (!elem)
748 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +0200749 if (len == 0)
Philipp Maier14e76b92017-03-28 18:36:52 +0200750 return -EINVAL;
751
752 memset(ei, 0, sizeof(*ei));
753
754 perm_algo = *elem;
755 elem++;
756
757 for (i = 0; i < ENCRY_INFO_PERM_ALGO_MAXLEN; i++) {
758 if (perm_algo & (1 << i)) {
759 ei->perm_algo[perm_algo_len] = i + 1;
760 perm_algo_len++;
761 }
762 }
763 ei->perm_algo_len = perm_algo_len;
764
Neels Hofmeyr26e53b12021-06-10 00:47:03 +0200765 /* FIXME: 48.008 3.2.2.10 Encryption Information says:
766 * "When present, the key shall be 8 octets long." */
Philipp Maier14e76b92017-03-28 18:36:52 +0200767 ei->key_len = len - 1;
768 memcpy(ei->key, elem, ei->key_len);
769 elem+=ei->key_len;
770
771 return (int)(elem - old_elem);
772}
Philipp Maier783047e2017-03-29 11:35:50 +0200773
Neels Hofmeyr4a9756c2021-06-10 00:48:15 +0200774/*! Encode TS 48.008 Kc128 IE.
775 * \param[out] msg Message Buffer to which IE is to be appended.
776 * \param[in] kc128 Pointer to 16 bytes of Kc128 key data.
777 * \returns number of bytes appended to msg */
778int gsm0808_enc_kc128(struct msgb *msg, const uint8_t *kc128)
779{
780 uint8_t *start = msg->tail;
781 msgb_tv_fixed_put(msg, GSM0808_IE_KC_128, 16, kc128);
782 return msg->tail - start;
783}
784
785/*! Decode TS 48.008 Kc128 IE.
786 * \param[out] kc128 Target buffer for received Kc128 key, 16 bytes long.
787 * \param[in] elem IE value to be decoded (without IE discriminator).
788 * \param[in] len Length of elem in bytes.
789 * \returns number of bytes parsed; negative on error */
790int gsm0808_dec_kc128(uint8_t *kc128, const uint8_t *elem, uint8_t len)
791{
792 if (len != 16)
793 return -EINVAL;
794 memcpy(kc128, elem, 16);
795 return len;
796}
797
Pau Espin Pedrol85a0f112021-02-15 16:25:33 +0100798/* Store individual Cell Identifier information in a CGI, without clearing the remaining ones.
799 * This is useful to supplement one CGI with information from more than one Cell Identifier,
800 * which in turn is useful to match Cell Identifiers of differing kinds to each other.
801 * Before first invocation, clear the *dst struct externally, this function does only write those members
802 * that are present in parameter u.
803 */
804static void cell_id_to_cgi(struct osmo_cell_global_id *dst,
805 enum CELL_IDENT discr, const union gsm0808_cell_id_u *u)
806{
807 switch (discr) {
808 case CELL_IDENT_WHOLE_GLOBAL:
809 *dst = u->global;
810 return;
811
812 case CELL_IDENT_WHOLE_GLOBAL_PS:
813 dst->lai = u->global_ps.rai.lac;
814 dst->cell_identity = u->global_ps.cell_identity;
815 return;
816
817 case CELL_IDENT_LAC_AND_CI:
818 dst->lai.lac = u->lac_and_ci.lac;
819 dst->cell_identity = u->lac_and_ci.ci;
820 return;
821
822 case CELL_IDENT_CI:
823 dst->cell_identity = u->ci;
824 return;
825
826 case CELL_IDENT_LAI_AND_LAC:
827 dst->lai = u->lai_and_lac;
828 return;
829
830 case CELL_IDENT_LAC:
831 dst->lai.lac = u->lac;
832 return;
833
834 case CELL_IDENT_NO_CELL:
835 case CELL_IDENT_BSS:
836 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
837 case CELL_IDENT_UTRAN_RNC:
838 case CELL_IDENT_UTRAN_LAC_RNC:
839 /* No values to set. */
840 return;
841 }
842}
843
Harald Weltef2210032019-08-31 21:25:05 +0200844/* Return the size of the value part of a cell identifier of given type */
845int gsm0808_cell_id_size(enum CELL_IDENT discr)
846{
847 switch (discr) {
848 case CELL_IDENT_WHOLE_GLOBAL:
849 return 7;
850 case CELL_IDENT_LAC_AND_CI:
851 return 4;
852 case CELL_IDENT_CI:
853 return 2;
854 case CELL_IDENT_LAI_AND_LAC:
855 return 5;
856 case CELL_IDENT_LAC:
857 return 2;
858 case CELL_IDENT_BSS:
859 case CELL_IDENT_NO_CELL:
860 return 0;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100861 case CELL_IDENT_WHOLE_GLOBAL_PS:
862 return 8;
Harald Weltef2210032019-08-31 21:25:05 +0200863 default:
864 return -EINVAL;
865 }
866}
Harald Welteef7be492019-05-03 21:01:13 +0200867/*! Decode a single GSM 08.08 Cell ID list element payload
868 * \param[out] out caller-provided output union
869 * \param[in] discr Cell ID discriminator describing type to be decoded
870 * \param[in] buf User-provided input buffer containing binary Cell ID list element
871 * \param[in] len Length of buf
872 * \returns 0 on success; negative on error */
873int gsm0808_decode_cell_id_u(union gsm0808_cell_id_u *out, enum CELL_IDENT discr, const uint8_t *buf, unsigned int len)
874{
875 switch (discr) {
876 case CELL_IDENT_WHOLE_GLOBAL:
877 if (len < 7)
878 return -EINVAL;
879 decode_lai(buf, &out->global.lai);
880 out->global.cell_identity = osmo_load16be(buf + sizeof(struct gsm48_loc_area_id));
881 break;
882 case CELL_IDENT_LAC_AND_CI:
883 if (len < 4)
884 return -EINVAL;
885 out->lac_and_ci.lac = osmo_load16be(buf);
886 out->lac_and_ci.ci = osmo_load16be(buf + sizeof(uint16_t));
887 break;
888 case CELL_IDENT_CI:
889 if (len < 2)
890 return -EINVAL;
891 out->ci = osmo_load16be(buf);
892 break;
893 case CELL_IDENT_LAI_AND_LAC:
894 if (len < 5)
895 return -EINVAL;
896 decode_lai(buf, &out->lai_and_lac);
897 break;
898 case CELL_IDENT_LAC:
899 if (len < 2)
900 return -EINVAL;
901 out->lac = osmo_load16be(buf);
902 break;
903 case CELL_IDENT_BSS:
904 case CELL_IDENT_NO_CELL:
905 /* Does not have any list items */
906 break;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100907 case CELL_IDENT_WHOLE_GLOBAL_PS:
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100908 /* 3GPP TS 48.018 sec 11.3.9 "Cell Identifier" */
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100909 if (len < 8)
910 return -EINVAL;
911 decode_lai(buf, (struct osmo_location_area_id *)&out->global_ps.rai); /* rai contains lai + non-decoded rac */
912 out->global_ps.rai.rac = *(buf + sizeof(struct gsm48_loc_area_id));
913 out->global_ps.cell_identity = osmo_load16be(buf + sizeof(struct gsm48_loc_area_id) + 1);
914 break;
Harald Welteef7be492019-05-03 21:01:13 +0200915 default:
916 /* Remaining cell identification types are not implemented. */
917 return -EINVAL;
918 }
919 return 0;
920}
921
Harald Weltee87693c2019-05-03 20:06:50 +0200922void gsm0808_msgb_put_cell_id_u(struct msgb *msg, enum CELL_IDENT id_discr, const union gsm0808_cell_id_u *u)
923{
924 switch (id_discr) {
925 case CELL_IDENT_WHOLE_GLOBAL: {
926 const struct osmo_cell_global_id *id = &u->global;
927 struct gsm48_loc_area_id lai;
928 gsm48_generate_lai2(&lai, &id->lai);
929 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
930 msgb_put_u16(msg, id->cell_identity);
931 break;
932 }
933 case CELL_IDENT_LAC_AND_CI: {
934 const struct osmo_lac_and_ci_id *id = &u->lac_and_ci;
935 msgb_put_u16(msg, id->lac);
936 msgb_put_u16(msg, id->ci);
937 break;
938 }
939 case CELL_IDENT_CI:
940 msgb_put_u16(msg, u->ci);
941 break;
942 case CELL_IDENT_LAI_AND_LAC: {
943 const struct osmo_location_area_id *id = &u->lai_and_lac;
944 struct gsm48_loc_area_id lai;
945 gsm48_generate_lai2(&lai, id);
946 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
947 break;
948 }
949 case CELL_IDENT_LAC:
950 msgb_put_u16(msg, u->lac);
951 break;
952 case CELL_IDENT_BSS:
953 case CELL_IDENT_NO_CELL:
954 /* Does not have any list items */
955 break;
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100956 case CELL_IDENT_WHOLE_GLOBAL_PS: {
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100957 /* 3GPP TS 48.018 sec 11.3.9 "Cell Identifier" */
Pau Espin Pedrolca33a712021-01-05 19:36:48 +0100958 const struct osmo_cell_global_id_ps *id = &u->global_ps;
959 struct gsm48_loc_area_id lai;
960 gsm48_generate_lai2(&lai, &id->rai.lac);
961 memcpy(msgb_put(msg, sizeof(lai)), &lai, sizeof(lai));
962 memcpy(msgb_put(msg, 1), &id->rai.rac, 1);
963 msgb_put_u16(msg, id->cell_identity);
964 break;
965 }
Harald Weltee87693c2019-05-03 20:06:50 +0200966 default:
967 /* Support for other identifier list types is not implemented. */
968 OSMO_ASSERT(false);
969 }
970}
971
Neels Hofmeyr87e45502017-06-20 00:17:59 +0200972/*! Encode TS 08.08 Cell Identifier List IE
Harald Welte96e2a002017-06-12 21:44:18 +0200973 * \param[out] msg Message Buffer to which IE is to be appended
974 * \param[in] cil Cell ID List to be encoded
975 * \returns number of bytes appended to \a msg */
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100976uint8_t gsm0808_enc_cell_id_list2(struct msgb *msg,
977 const struct gsm0808_cell_id_list2 *cil)
978{
979 uint8_t *old_tail;
980 uint8_t *tlv_len;
981 unsigned int i;
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100982 uint8_t id_discr;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100983
984 OSMO_ASSERT(msg);
985 OSMO_ASSERT(cil);
986
987 msgb_put_u8(msg, GSM0808_IE_CELL_IDENTIFIER_LIST);
988 tlv_len = msgb_put(msg, 1);
989 old_tail = msg->tail;
990
Pau Espin Pedrol52489852021-02-15 16:26:37 +0100991 /* CGI-PS is an osmocom-specific type. In here we don't care about the
992 * PS part, only the CS one. */
993 if (cil->id_discr == CELL_IDENT_WHOLE_GLOBAL_PS)
994 id_discr = CELL_IDENT_WHOLE_GLOBAL;
995 else
996 id_discr = cil->id_discr & 0x0f;
997
998 msgb_put_u8(msg, id_discr);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100999
Alexander Couzens4e284b62019-06-23 01:53:43 +02001000 OSMO_ASSERT(cil->id_list_len <= GSM0808_CELL_ID_LIST2_MAXLEN);
Pau Espin Pedrol52489852021-02-15 16:26:37 +01001001 for (i = 0; i < cil->id_list_len; i++) {
1002 if (cil->id_discr == CELL_IDENT_WHOLE_GLOBAL_PS) {
1003 union gsm0808_cell_id_u u;
1004 cell_id_to_cgi(&u.global, cil->id_discr, &cil->id_list[i]);
1005 gsm0808_msgb_put_cell_id_u(msg, CELL_IDENT_WHOLE_GLOBAL, &u);
1006 } else {
1007 gsm0808_msgb_put_cell_id_u(msg, cil->id_discr, &cil->id_list[i]);
1008 }
1009 }
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001010
1011 *tlv_len = (uint8_t) (msg->tail - old_tail);
1012 return *tlv_len + 2;
1013}
1014
1015/*! DEPRECATED: Use gsm0808_enc_cell_id_list2 instead.
1016 *
1017 * Encode TS 08.08 Cell Identifier List IE
1018 * \param[out] msg Message Buffer to which IE is to be appended
1019 * \param[in] cil Cell ID List to be encoded
1020 * \returns number of bytes appended to \a msg */
Philipp Maier783047e2017-03-29 11:35:50 +02001021uint8_t gsm0808_enc_cell_id_list(struct msgb *msg,
1022 const struct gsm0808_cell_id_list *cil)
1023{
1024 uint8_t *old_tail;
1025 uint8_t *tlv_len;
1026 unsigned int i;
1027
1028 OSMO_ASSERT(msg);
1029 OSMO_ASSERT(cil);
1030
1031 msgb_put_u8(msg, GSM0808_IE_CELL_IDENTIFIER_LIST);
1032 tlv_len = msgb_put(msg, 1);
1033 old_tail = msg->tail;
1034
1035 msgb_put_u8(msg, cil->id_discr & 0x0f);
1036
1037 switch (cil->id_discr) {
1038 case CELL_IDENT_LAC:
Alexander Couzens4e284b62019-06-23 01:53:43 +02001039 OSMO_ASSERT(cil->id_list_len <= CELL_ID_LIST_LAC_MAXLEN);
Philipp Maier783047e2017-03-29 11:35:50 +02001040 for (i=0;i<cil->id_list_len;i++) {
1041 msgb_put_u16(msg, cil->id_list_lac[i]);
1042 }
1043 break;
1044 case CELL_IDENT_BSS:
1045 /* Does not have any list items */
1046 break;
1047 default:
1048 /* FIXME: Implement support for all identifier list elements */
1049 OSMO_ASSERT(false);
1050 }
1051
1052 *tlv_len = (uint8_t) (msg->tail - old_tail);
1053 return *tlv_len + 2;
1054}
1055
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001056static 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 +01001057 size_t *consumed)
1058{
1059 struct osmo_cell_global_id *id;
1060 uint16_t *ci_be;
1061 size_t lai_offset;
1062 int i = 0;
1063 const size_t elemlen = sizeof(struct gsm48_loc_area_id) + sizeof(*ci_be);
1064
1065 *consumed = 0;
1066 while (remain >= elemlen) {
1067 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1068 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001069 id = &cil->id_list[i].global;
Stefan Sperling2873bf12018-03-14 18:38:41 +01001070 lai_offset = i * elemlen;
Stefan Sperling23381452018-03-15 19:38:15 +01001071 decode_lai(&data[lai_offset], &id->lai);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001072 ci_be = (uint16_t *)(&data[lai_offset + sizeof(struct gsm48_loc_area_id)]);
1073 id->cell_identity = osmo_load16be(ci_be);
1074 *consumed += elemlen;
1075 remain -= elemlen;
1076 i++;
1077 }
1078
1079 return i;
1080}
1081
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001082static 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 +01001083 size_t *consumed)
1084{
1085 uint16_t *lacp_be, *ci_be;
1086 struct osmo_lac_and_ci_id *id;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001087 int i = 0, j = 0;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001088 const size_t elemlen = sizeof(*lacp_be) + sizeof(*ci_be);
1089
1090 *consumed = 0;
1091
1092 if (remain < elemlen)
1093 return -EINVAL;
1094
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001095 lacp_be = (uint16_t *)(&data[j]);
1096 ci_be = (uint16_t *)(&data[j + elemlen/2]);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001097 while (remain >= elemlen) {
1098 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1099 return -ENOSPC;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001100 id = &cil->id_list[i++].lac_and_ci;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001101 id->lac = osmo_load16be(lacp_be);
1102 id->ci = osmo_load16be(ci_be);
1103 *consumed += elemlen;
1104 remain -= elemlen;
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001105 j += elemlen;
1106 lacp_be = (uint16_t *)(&data[j]);
1107 ci_be = (uint16_t *)(&data[j + elemlen/2]);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001108 }
1109
1110 return i;
1111}
1112
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001113static int parse_cell_id_ci_list(struct gsm0808_cell_id_list2 *cil, const uint8_t *data, size_t remain,
1114 size_t *consumed)
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001115{
1116 const uint16_t *ci_be = (const uint16_t *)data;
1117 int i = 0;
1118 const size_t elemlen = sizeof(*ci_be);
1119
1120 *consumed = 0;
1121 while (remain >= elemlen) {
1122 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1123 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001124 cil->id_list[i++].ci = osmo_load16be(ci_be++);
Stefan Sperling9c62fc62018-03-16 10:23:34 +01001125 *consumed += elemlen;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001126 remain -= elemlen;
1127 }
1128 return i;
1129}
1130
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001131static 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 +01001132 size_t *consumed)
1133{
1134 struct osmo_location_area_id *id;
1135 int i = 0;
1136 const size_t elemlen = sizeof(struct gsm48_loc_area_id);
1137
1138 *consumed = 0;
1139 while (remain >= elemlen) {
1140 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1141 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001142 id = &cil->id_list[i].lai_and_lac;
Stefan Sperling23381452018-03-15 19:38:15 +01001143 decode_lai(&data[i * elemlen], id);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001144 *consumed += elemlen;
1145 remain -= elemlen;
1146 i++;
1147 }
1148
1149 return i;
1150}
1151
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001152static 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 +01001153{
1154 const uint16_t *lac_be = (const uint16_t *)data;
1155 int i = 0;
1156 const size_t elemlen = sizeof(*lac_be);
1157
1158 *consumed = 0;
1159 while (remain >= elemlen) {
1160 if (i >= GSM0808_CELL_ID_LIST2_MAXLEN)
1161 return -ENOSPC;
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001162 cil->id_list[i++].lac = osmo_load16be(lac_be++);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001163 *consumed += elemlen;
1164 remain -= elemlen;
1165 }
1166 return i;
1167}
1168
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001169/*! Decode Cell Identifier List IE
Harald Welte96e2a002017-06-12 21:44:18 +02001170 * \param[out] cil Caller-provided memory to store Cell ID list
1171 * \param[in] elem IE value to be decoded
1172 * \param[in] len Length of \a elem in bytes
1173 * \returns number of bytes parsed; negative on error */
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001174int gsm0808_dec_cell_id_list2(struct gsm0808_cell_id_list2 *cil,
1175 const uint8_t *elem, uint8_t len)
1176{
1177 uint8_t id_discr;
1178 size_t bytes_elem = 0;
1179 int list_len = 0;
1180
1181 OSMO_ASSERT(cil);
1182 if (!elem)
1183 return -EINVAL;
1184 if (len == 0)
1185 return -EINVAL;
1186
1187 memset(cil, 0, sizeof(*cil));
1188
1189 id_discr = *elem & 0x0f;
1190 elem++;
1191 len--;
1192
1193 switch (id_discr) {
1194 case CELL_IDENT_WHOLE_GLOBAL:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001195 list_len = parse_cell_id_global_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001196 break;
1197 case CELL_IDENT_LAC_AND_CI:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001198 list_len = parse_cell_id_lac_and_ci_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001199 break;
1200 case CELL_IDENT_CI:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001201 list_len = parse_cell_id_ci_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001202 break;
1203 case CELL_IDENT_LAI_AND_LAC:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001204 list_len = parse_cell_id_lai_and_lac(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001205 break;
1206 case CELL_IDENT_LAC:
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001207 list_len = parse_cell_id_lac_list(cil, elem, len, &bytes_elem);
Stefan Sperling11a4d9d2018-02-15 18:28:04 +01001208 break;
1209 case CELL_IDENT_BSS:
1210 case CELL_IDENT_NO_CELL:
1211 /* Does not have any list items */
1212 break;
1213 default:
1214 /* Remaining cell identification types are not implemented. */
1215 return -EINVAL;
1216 }
1217
1218 if (list_len < 0) /* parsing error */
1219 return list_len;
1220
1221 cil->id_discr = id_discr;
1222 cil->id_list_len = list_len;
1223
1224 /* One byte for the cell ID discriminator + any remaining bytes in
1225 * the IE which were consumed by the parser functions above. */
1226 return 1 + (int)bytes_elem;
1227}
1228
1229/*! DEPRECATED: Use gsm0808_dec_cell_id_list2 instead.
1230 *
1231 * Decode Cell Identifier List IE
1232 * \param[out] cil Caller-provided memory to store Cell ID list
1233 * \param[in] elem IE value to be decoded
1234 * \param[in] len Length of \a elem in bytes
1235 * \returns number of bytes parsed; negative on error */
Philipp Maier783047e2017-03-29 11:35:50 +02001236int gsm0808_dec_cell_id_list(struct gsm0808_cell_id_list *cil,
1237 const uint8_t *elem, uint8_t len)
1238{
1239 uint8_t id_discr;
1240 const uint8_t *old_elem = elem;
1241 unsigned int item_count = 0;
1242
1243 OSMO_ASSERT(cil);
1244 if (!elem)
1245 return -EINVAL;
Philipp Maier17778bd2017-04-28 11:05:44 +02001246 if (len == 0)
Philipp Maier783047e2017-03-29 11:35:50 +02001247 return -EINVAL;
1248
1249 memset(cil, 0, sizeof(*cil));
1250
1251 id_discr = *elem & 0x0f;
1252 elem++;
1253 len--;
1254
1255 cil->id_discr = id_discr;
1256
1257 switch (id_discr) {
1258 case CELL_IDENT_LAC:
1259 while (len >= 2) {
1260 cil->id_list_lac[item_count] = osmo_load16be(elem);
1261 elem += 2;
1262 item_count++;
1263 len -= 2;
1264 }
1265 case CELL_IDENT_BSS:
1266 /* Does not have any list items */
1267 break;
1268 default:
1269 /* FIXME: Implement support for all identifier list elements */
1270 return -EINVAL;
1271 }
1272
1273 cil->id_list_len = item_count;
1274 return (int)(elem - old_elem);
1275}
Harald Welte96e2a002017-06-12 21:44:18 +02001276
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001277static bool same_cell_id_list_entries(const struct gsm0808_cell_id_list2 *a, int ai,
1278 const struct gsm0808_cell_id_list2 *b, int bi)
1279{
1280 struct gsm0808_cell_id_list2 tmp = {
1281 .id_discr = a->id_discr,
1282 .id_list_len = 1,
1283 };
1284 uint8_t buf_a[32 + sizeof(struct msgb)];
1285 uint8_t buf_b[32 + sizeof(struct msgb)];
1286 struct msgb *msg_a = (void*)buf_a;
1287 struct msgb *msg_b = (void*)buf_b;
1288
1289 msg_a->data_len = 32;
1290 msg_b->data_len = 32;
1291 msgb_reset(msg_a);
1292 msgb_reset(msg_b);
1293
1294 if (a->id_discr != b->id_discr)
1295 return false;
1296 if (ai >= a->id_list_len
1297 || bi >= b->id_list_len)
1298 return false;
1299
1300 tmp.id_list[0] = a->id_list[ai];
1301 gsm0808_enc_cell_id_list2(msg_a, &tmp);
1302
1303 tmp.id_list[0] = b->id_list[bi];
1304 gsm0808_enc_cell_id_list2(msg_b, &tmp);
1305
1306 if (msg_a->len != msg_b->len)
1307 return false;
1308 if (memcmp(msg_a->data, msg_b->data, msg_a->len))
1309 return false;
1310
1311 return true;
1312}
1313
1314/*! Append entries from one Cell Identifier List to another.
1315 * The cell identifier types must be identical between the two lists.
1316 * \param dst[out] Append entries to this list.
1317 * \param src[in] Append these entries to \a dst.
1318 * \returns the nr of items added, or negative on error: -EINVAL if the id_discr mismatch
1319 * between the lists, -ENOSPC if the destination list does not have enough space. If an error is
1320 * returned, \a dst may have already been changed (particularly on -ENOSPC). Note that a return value
1321 * of zero may occur when the src->id_list_len is zero, or when all entries from \a src already exist
1322 * in \a dst, and does not indicate error per se. */
1323int gsm0808_cell_id_list_add(struct gsm0808_cell_id_list2 *dst, const struct gsm0808_cell_id_list2 *src)
1324{
1325 int i, j;
1326 int added = 0;
1327
1328 if (dst->id_list_len == 0
1329 && dst->id_discr != CELL_IDENT_BSS)
1330 dst->id_discr = src->id_discr;
1331 else if (dst->id_discr != src->id_discr)
1332 return -EINVAL;
1333
1334 for (i = 0; i < src->id_list_len; i++) {
1335 /* don't add duplicate entries */
1336 bool skip = false;
1337 for (j = 0; j < dst->id_list_len; j++) {
1338 if (same_cell_id_list_entries(dst, j, src, i)) {
1339 skip = true;
1340 break;
1341 }
1342 }
1343 if (skip)
1344 continue;
1345
1346 if (dst->id_list_len >= ARRAY_SIZE(dst->id_list))
1347 return -ENOSPC;
1348
1349 dst->id_list[dst->id_list_len++] = src->id_list[i];
1350 added ++;
1351 }
1352
1353 return added;
1354}
1355
Neels Hofmeyr38e58412018-05-25 16:56:35 +02001356/*! Convert a single Cell Identifier to a Cell Identifier List with one entry.
1357 * \param dst[out] Overwrite this list.
1358 * \param src[in] Set \a dst to contain exactly this item.
1359 */
1360void gsm0808_cell_id_to_list(struct gsm0808_cell_id_list2 *dst, const struct gsm0808_cell_id *src)
1361{
1362 if (!dst)
1363 return;
1364 if (!src) {
1365 *dst = (struct gsm0808_cell_id_list2){
1366 .id_discr = CELL_IDENT_NO_CELL,
1367 };
1368 return;
1369 }
1370
1371 *dst = (struct gsm0808_cell_id_list2){
1372 .id_discr = src->id_discr,
1373 .id_list = { src->id },
1374 .id_list_len = 1,
1375 };
1376
1377 switch (src->id_discr) {
1378 case CELL_IDENT_NO_CELL:
1379 case CELL_IDENT_BSS:
1380 dst->id_list_len = 0;
1381 break;
1382 default:
1383 break;
1384 }
1385}
1386
Neels Hofmeyr250e7f72018-04-13 03:30:14 +02001387/*! Encode Cell Identifier IE (3GPP TS 48.008 3.2.2.17).
1388 * \param[out] msg Message Buffer to which IE is to be appended
1389 * \param[in] ci Cell ID to be encoded
1390 * \returns number of bytes appended to \a msg */
1391uint8_t gsm0808_enc_cell_id(struct msgb *msg, const struct gsm0808_cell_id *ci)
1392{
1393 uint8_t rc;
1394 uint8_t *ie_tag;
1395 struct gsm0808_cell_id_list2 cil = {
1396 .id_discr = ci->id_discr,
1397 .id_list = { ci->id },
1398 .id_list_len = 1,
1399 };
1400
1401 OSMO_ASSERT(msg);
1402 OSMO_ASSERT(ci);
1403
1404 ie_tag = msg->tail;
1405 rc = gsm0808_enc_cell_id_list2(msg, &cil);
1406
1407 if (rc <= 0)
1408 return rc;
1409
1410 *ie_tag = GSM0808_IE_CELL_IDENTIFIER;
1411 return rc;
1412}
1413
1414/*! Decode Cell Identifier IE (3GPP TS 48.008 3.2.2.17).
1415 * \param[out] ci Caller-provided memory to store Cell ID.
1416 * \param[in] elem IE value to be decoded.
1417 * \param[in] len Length of \a elem in bytes.
1418 * \returns number of bytes parsed; negative on error */
1419int gsm0808_dec_cell_id(struct gsm0808_cell_id *ci, const uint8_t *elem, uint8_t len)
1420{
1421 struct gsm0808_cell_id_list2 cil;
1422 int rc;
1423 rc = gsm0808_dec_cell_id_list2(&cil, elem, len);
1424 if (rc < 0)
1425 return rc;
1426 if (cil.id_discr == CELL_IDENT_BSS || cil.id_discr == CELL_IDENT_NO_CELL) {
1427 if (cil.id_list_len != 0)
1428 return -EINVAL;
1429 } else {
1430 if (cil.id_list_len != 1)
1431 return -EINVAL;
1432 }
1433 ci->id_discr = cil.id_discr;
1434 ci->id = cil.id_list[0];
1435 return rc;
1436}
1437
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001438/*! Convert the representation of the permitted speech codec identifier
Philipp Maier3149b0d2017-06-02 13:22:34 +02001439 * that is used in struct gsm0808_channel_type to the speech codec
1440 * representation we use in struct gsm0808_speech_codec.
1441 * \param[in] perm_spch to be converted (see also gsm0808_permitted_speech)
1442 * \returns GSM speech codec type; negative on error */
1443int gsm0808_chan_type_to_speech_codec(uint8_t perm_spch)
1444{
1445 /*! The speech codec type, which is used in the channel type field to
1446 * signal the permitted speech versions (codecs) has a different
1447 * encoding than the type field in the speech codec type element
1448 * (See also 3GPP TS 48.008, 3.2.2.11 and 3.2.2.103) */
1449
1450 switch (perm_spch) {
1451 case GSM0808_PERM_FR1:
1452 return GSM0808_SCT_FR1;
1453 case GSM0808_PERM_FR2:
1454 return GSM0808_SCT_FR2;
1455 case GSM0808_PERM_FR3:
1456 return GSM0808_SCT_FR3;
1457 case GSM0808_PERM_FR4:
1458 return GSM0808_SCT_FR4;
1459 case GSM0808_PERM_FR5:
1460 return GSM0808_SCT_FR5;
1461 case GSM0808_PERM_HR1:
1462 return GSM0808_SCT_HR1;
1463 case GSM0808_PERM_HR3:
1464 return GSM0808_SCT_HR3;
1465 case GSM0808_PERM_HR4:
1466 return GSM0808_SCT_HR4;
1467 case GSM0808_PERM_HR6:
1468 return GSM0808_SCT_HR6;
1469 }
1470
1471 /* Invalid input */
1472 return -EINVAL;
1473}
1474
Neels Hofmeyr87e45502017-06-20 00:17:59 +02001475/*! Extrapolate a speech codec field from a given permitted speech
Philipp Maier884ba0f2017-06-02 13:49:16 +02001476 * parameter (channel type).
1477 * \param[out] sc Caller provided memory to store the resulting speech codec
1478 * \param[in] perm_spch value that is used to derive the speech codec info
1479 * (see also: enum gsm0808_speech_codec_type in gsm0808_utils.h)
1480 * \returns zero when successful; negative on error */
1481int gsm0808_speech_codec_from_chan_type(struct gsm0808_speech_codec *sc,
1482 uint8_t perm_spch)
1483{
1484 int rc;
1485
1486 memset(sc, 0, sizeof(*sc));
1487
1488 /* Determine codec type */
1489 rc = gsm0808_chan_type_to_speech_codec(perm_spch);
1490 if (rc < 0)
1491 return -EINVAL;
1492 sc->type = (uint8_t) rc;
1493
1494 /* Depending on the speech codec type, pick a default codec
1495 * configuration that exactly matches the configuration on the
1496 * air interface. */
1497 switch (sc->type) {
1498 case GSM0808_SCT_FR3:
1499 sc->cfg = GSM0808_SC_CFG_DEFAULT_FR_AMR;
1500 break;
1501 case GSM0808_SCT_FR4:
1502 sc->cfg = GSM0808_SC_CFG_DEFAULT_OFR_AMR_WB;
1503 break;
1504 case GSM0808_SCT_FR5:
1505 sc->cfg = GSM0808_SC_CFG_DEFAULT_FR_AMR_WB;
1506 break;
1507 case GSM0808_SCT_HR3:
1508 sc->cfg = GSM0808_SC_CFG_DEFAULT_HR_AMR;
1509 break;
1510 case GSM0808_SCT_HR4:
1511 sc->cfg = GSM0808_SC_CFG_DEFAULT_OHR_AMR_WB;
1512 break;
1513 case GSM0808_SCT_HR6:
1514 sc->cfg = GSM0808_SC_CFG_DEFAULT_OHR_AMR;
1515 break;
1516 default:
1517 /* Note: Not all codec types specify a default setting,
1518 * in this case, we just set the field to zero. */
1519 sc->cfg = 0;
1520 }
1521
1522 /* Tag all codecs as "Full IP"
1523 * (see als 3GPP TS 48.008 3.2.2.103) */
1524 sc->fi = true;
1525
1526 return 0;
1527}
1528
Philipp Maier5f2eb152018-09-19 13:40:21 +02001529/*! Determine a set of AMR speech codec configuration bits (S0-S15) from a
1530 * given GSM 04.08 AMR configuration struct.
1531 * \param[in] cfg AMR configuration in GSM 04.08 format.
1532 * \param[in] hint if the resulting configuration shall be used with a FR or HR TCH.
1533 * \returns configuration bits (S0-S15) */
Philipp Maier369015c2018-09-21 09:07:20 +02001534uint16_t gsm0808_sc_cfg_from_gsm48_mr_cfg(const struct gsm48_multi_rate_conf *cfg,
Philipp Maier5f2eb152018-09-19 13:40:21 +02001535 bool fr)
1536{
1537 uint16_t s15_s0 = 0;
1538
1539 /* Check each rate bit in the AMR multirate configuration and pick the
1540 * matching default configuration as specified in 3GPP TS 28.062,
1541 * Table 7.11.3.1.3-2. */
1542 if (cfg->m4_75)
1543 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_4_75;
1544 if (cfg->m5_15)
1545 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_5_15;
1546 if (cfg->m5_90)
1547 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_5_90;
1548 if (cfg->m6_70)
1549 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_6_70;
1550 if (cfg->m7_40)
1551 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_7_40;
1552 if (cfg->m7_95)
1553 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_7_95;
1554 if (cfg->m10_2)
1555 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_10_2;
1556 if (cfg->m12_2)
1557 s15_s0 |= GSM0808_SC_CFG_DEFAULT_AMR_12_2;
1558
1559 /* Note: 3GPP TS 48.008, chapter 3GPP TS 48.008 states that for AMR
1560 * some of the configuration bits must be coded as zeros. The applied
1561 * bitmask matches the default codec settings. See also the definition
1562 * of enum gsm0808_speech_codec_defaults in gsm_08_08.h and
1563 * 3GPP TS 28.062, Table 7.11.3.1.3-2. */
1564 if (fr)
1565 s15_s0 &= GSM0808_SC_CFG_DEFAULT_FR_AMR;
1566 else
1567 s15_s0 &= GSM0808_SC_CFG_DEFAULT_HR_AMR;
1568
Philipp Maier94d79fd2019-03-01 10:40:48 +01001569 /* The mode that is encoded by S1 (Config-NB-Code = 1), takes a special
1570 * role as it does not stand for a single rate, but for up to four rates
1571 * at once (12.2, 7.4, 5.9, 4.75). We must check if the supplied cfg
1572 * covers this mode. If not, we need to make sure that the related
1573 * bit is removed. (See also 3GPP TS 28.062, Table 7.11.3.1.3-2) */
1574 if (!(cfg->m12_2 && cfg->m7_40 && cfg->m5_90 && cfg->m4_75) && fr)
1575 s15_s0 &= ~GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20;
1576 else if (!(cfg->m7_40 && cfg->m5_90 && cfg->m4_75))
1577 s15_s0 &= ~GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20;
1578
Philipp Maier5f2eb152018-09-19 13:40:21 +02001579 return s15_s0;
1580}
1581
Philipp Maier8515d032018-09-25 15:57:49 +02001582/*! Determine a GSM 04.08 AMR configuration struct from a set of speech codec
1583 * configuration bits (S0-S15)
1584 * \param[out] cfg AMR configuration in GSM 04.08 format.
Philipp Maier3713af82019-02-27 16:48:25 +01001585 * \param[in] s15_s0 configuration bits (S15-S0, non-ambiguous).
1586 * \returns zero when successful; negative on error */
1587int gsm48_mr_cfg_from_gsm0808_sc_cfg(struct gsm48_multi_rate_conf *cfg,
1588 uint16_t s15_s0)
Philipp Maier8515d032018-09-25 15:57:49 +02001589{
Philipp Maier3713af82019-02-27 16:48:25 +01001590 unsigned int count = 0;
1591
1592 /* Note: See also: 3GPP TS 28.062
1593 * Table 7.11.3.1.3-2: Preferred Configurations for the Adaptive
1594 * Multi-Rate Codec Types */
1595
1596 /* Note: The resulting multirate-configuration must not contain an
1597 * active set of more than four codec rates. The active set also
1598 * must contain at least one rate. */
1599
Philipp Maier8515d032018-09-25 15:57:49 +02001600 memset(cfg, 0, sizeof(*cfg));
Philipp Maier3713af82019-02-27 16:48:25 +01001601 cfg->ver = 1;
1602 cfg->icmi = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001603
1604 /* Strip option bits */
1605 s15_s0 &= 0x00ff;
1606
Philipp Maier3713af82019-02-27 16:48:25 +01001607 /* Rate 5,15k can never be selected (see table) */
1608 cfg->m5_15 = 0;
Philipp Maier8515d032018-09-25 15:57:49 +02001609
Neels Hofmeyra0f2b212021-04-14 22:45:13 +02001610 if (s15_s0 & GSM0808_SC_CFG_AMR_4_75_5_90_7_40_12_20) {
Philipp Maier3713af82019-02-27 16:48:25 +01001611 /* Table Table 7.11.3.1.3-2 lists one mode that selects 4
1612 * rates at once (Config-NB-Code = 1). The rates selected
1613 * are known to be compatible between GERAN and UTRAN, since
1614 * an active set must not contain more than four rates at
1615 * a time, we ignore all other settings as they are either
1616 * redundaned or excess settings (invalid) */
Philipp Maier8515d032018-09-25 15:57:49 +02001617 cfg->m4_75 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001618 cfg->m5_90 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001619 cfg->m7_40 = 1;
Philipp Maier8515d032018-09-25 15:57:49 +02001620 cfg->m12_2 = 1;
Philipp Maier3713af82019-02-27 16:48:25 +01001621 count += 4;
1622 }
Philipp Maier8515d032018-09-25 15:57:49 +02001623
Philipp Maier3713af82019-02-27 16:48:25 +01001624 /* Check the bits in s15_s0 and set the flags for the
1625 * respective rates. */
1626 if (s15_s0 & GSM0808_SC_CFG_AMR_4_75 && !cfg->m4_75) {
1627 if (count >= 4)
1628 return -EINVAL;
1629 cfg->m4_75 = 1;
1630 count++;
1631 }
1632 if (s15_s0 & GSM0808_SC_CFG_AMR_5_90 && !cfg->m5_90) {
1633 if (count >= 4)
1634 return -EINVAL;
1635 cfg->m5_90 = 1;
1636 count++;
1637 }
1638 if (s15_s0 & GSM0808_SC_CFG_AMR_6_70) {
1639 if (count >= 4)
1640 return -EINVAL;
1641 cfg->m6_70 = 1;
1642 count++;
1643 }
1644 if (s15_s0 & GSM0808_SC_CFG_AMR_7_40 && !cfg->m7_40) {
1645 if (count >= 4)
1646 return -EINVAL;
1647 cfg->m7_40 = 1;
1648 count++;
1649 }
1650 if (s15_s0 & GSM0808_SC_CFG_AMR_7_95) {
1651 if (count >= 4)
1652 return -EINVAL;
1653 cfg->m7_95 = 1;
1654 count++;
1655 }
1656 if (s15_s0 & GSM0808_SC_CFG_AMR_10_2) {
1657 if (count >= 4)
1658 return -EINVAL;
1659 cfg->m10_2 = 1;
1660 count++;
1661 }
1662 if (s15_s0 & GSM0808_SC_CFG_AMR_12_2 && !cfg->m12_2) {
1663 if (count >= 4)
1664 return -EINVAL;
1665 cfg->m12_2 = 1;
1666 count++;
1667 }
1668
1669 if (count == 0)
1670 return -EINVAL;
1671
1672 return 0;
Philipp Maier8515d032018-09-25 15:57:49 +02001673}
1674
Alexander Chemeris2ac8f912020-05-13 22:38:08 +03001675int gsm0808_get_cipher_reject_cause(const struct tlv_parsed *tp)
1676{
1677 return gsm0808_get_cause(tp);
1678}
1679
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001680/*! Print a human readable name of the cell identifier to the char buffer.
1681 * This is useful both for struct gsm0808_cell_id and struct gsm0808_cell_id_list2.
1682 * See also gsm0808_cell_id_name() and gsm0808_cell_id_list_name().
1683 * \param[out] buf Destination buffer to write string representation to.
1684 * \param[in] buflen Amount of memory available in \a buf.
1685 * \param[in] id_discr Cell Identifier type.
1686 * \param[in] u Cell Identifer value.
1687 * \returns Like snprintf(): the amount of characters (excluding terminating nul) written,
1688 * or that would have been written if the buffer were large enough.
1689 */
1690int gsm0808_cell_id_u_name(char *buf, size_t buflen,
1691 enum CELL_IDENT id_discr, const union gsm0808_cell_id_u *u)
1692{
1693 switch (id_discr) {
1694 case CELL_IDENT_LAC:
1695 return snprintf(buf, buflen, "%u", u->lac);
1696 case CELL_IDENT_CI:
1697 return snprintf(buf, buflen, "%u", u->ci);
1698 case CELL_IDENT_LAC_AND_CI:
1699 return snprintf(buf, buflen, "%u-%u", u->lac_and_ci.lac, u->lac_and_ci.ci);
1700 case CELL_IDENT_LAI_AND_LAC:
1701 return snprintf(buf, buflen, "%s", osmo_lai_name(&u->lai_and_lac));
1702 case CELL_IDENT_WHOLE_GLOBAL:
1703 return snprintf(buf, buflen, "%s", osmo_cgi_name(&u->global));
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001704 case CELL_IDENT_WHOLE_GLOBAL_PS:
1705 return snprintf(buf, buflen, "%s", osmo_cgi_ps_name(&u->global_ps));
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001706 default:
1707 /* For CELL_IDENT_BSS and CELL_IDENT_NO_CELL, just print the discriminator.
1708 * Same for kinds we have no string representation of yet. */
1709 return snprintf(buf, buflen, "%s", gsm0808_cell_id_discr_name(id_discr));
1710 }
1711}
1712
Neels Hofmeyrd01ef752018-09-21 15:57:26 +02001713/*! Return true if the common information between the two Cell Identifiers match.
1714 * For example, if a LAC+CI is compared to LAC, return true if the LAC are the same.
1715 * Note that CELL_IDENT_NO_CELL will always return false.
1716 * Also CELL_IDENT_BSS will always return false, since this function cannot possibly
1717 * know the bounds of the BSS, so the caller must handle CELL_IDENT_BSS specially.
1718 * \param[in] discr1 Cell Identifier type.
1719 * \param[in] u1 Cell Identifier value.
1720 * \param[in] discr2 Other Cell Identifier type.
1721 * \param[in] u2 Other Cell Identifier value.
1722 * \param[in] exact_match If true, return true only if the CELL_IDENT types and all values are identical.
1723 * \returns True if the common fields of the above match.
1724 */
1725static bool gsm0808_cell_id_u_match(enum CELL_IDENT discr1, const union gsm0808_cell_id_u *u1,
1726 enum CELL_IDENT discr2, const union gsm0808_cell_id_u *u2,
1727 bool exact_match)
1728{
1729 struct osmo_cell_global_id a = {};
1730 struct osmo_cell_global_id b = {};
1731
1732 if (exact_match && discr1 != discr2)
1733 return false;
1734
1735 /* First handle the odd wildcard like CELL_IDENT kinds. We can't really match any of these. */
1736 switch (discr1) {
1737 case CELL_IDENT_NO_CELL:
1738 case CELL_IDENT_BSS:
1739 return discr1 == discr2;
1740 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1741 case CELL_IDENT_UTRAN_RNC:
1742 case CELL_IDENT_UTRAN_LAC_RNC:
1743 return false;
1744 default:
1745 break;
1746 }
1747 switch (discr2) {
1748 case CELL_IDENT_NO_CELL:
1749 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1750 case CELL_IDENT_UTRAN_RNC:
1751 case CELL_IDENT_UTRAN_LAC_RNC:
1752 case CELL_IDENT_BSS:
1753 return false;
1754 default:
1755 break;
1756 }
1757
1758 /* Enrich both sides to full CGI, then compare those. First set the *other* ID's values in case
1759 * they assign more items. For example:
1760 * u1 = LAC:42
1761 * u2 = LAC+CI:23+5
1762 * 1) a <- LAC+CI:23+5
1763 * 2) a <- LAC:42 so that a = LAC+CI:42+5
1764 * Now we can compare those two and find a mismatch. If the LAC were the same, we would get
1765 * identical LAC+CI and hence a match. */
1766
1767 cell_id_to_cgi(&a, discr2, u2);
1768 cell_id_to_cgi(&a, discr1, u1);
1769
1770 cell_id_to_cgi(&b, discr1, u1);
1771 cell_id_to_cgi(&b, discr2, u2);
1772
1773 return osmo_cgi_cmp(&a, &b) == 0;
1774}
1775
1776/*! Return true if the common information between the two Cell Identifiers match.
1777 * For example, if a LAC+CI is compared to LAC, return true if the LAC are the same.
1778 * Note that CELL_IDENT_NO_CELL will always return false.
1779 * Also CELL_IDENT_BSS will always return false, since this function cannot possibly
1780 * know the bounds of the BSS, so the caller must handle CELL_IDENT_BSS specially.
1781 * \param[in] id1 Cell Identifier.
1782 * \param[in] id2 Other Cell Identifier.
1783 * \param[in] exact_match If true, return true only if the CELL_IDENT types and all values are identical.
1784 * \returns True if the common fields of the above match.
1785 */
1786bool gsm0808_cell_ids_match(const struct gsm0808_cell_id *id1, const struct gsm0808_cell_id *id2, bool exact_match)
1787{
1788 return gsm0808_cell_id_u_match(id1->id_discr, &id1->id, id2->id_discr, &id2->id, exact_match);
1789}
1790
1791/*! Find an index in a Cell Identifier list that matches a given single Cell Identifer.
1792 * Compare \a id against each entry in \a list using gsm0808_cell_ids_match(), and return the list index
1793 * if a match is found. \a match_nr allows iterating all matches in the list. A match_nr <= 0 returns the
1794 * first match in the list, match_nr == 1 the second match, etc., and if match_nr exceeds the available
1795 * matches in the list, -1 is returned.
1796 * \param[in] id Cell Identifier to match.
1797 * \param[in] list Cell Identifier list to search in.
1798 * \param[in] match_nr Ignore this many matches.
1799 * \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 +01001800 * \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
1801 * entry).
Neels Hofmeyrd01ef752018-09-21 15:57:26 +02001802 */
1803int gsm0808_cell_id_matches_list(const struct gsm0808_cell_id *id, const struct gsm0808_cell_id_list2 *list,
1804 unsigned int match_nr, bool exact_match)
1805{
1806 int i;
1807 for (i = 0; i < list->id_list_len; i++) {
1808 if (gsm0808_cell_id_u_match(id->id_discr, &id->id, list->id_discr, &list->id_list[i], exact_match)) {
1809 if (match_nr)
1810 match_nr--;
1811 else
1812 return i;
1813 }
1814 }
1815 return -1;
1816}
1817
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001818/*! Copy information from a CGI to form a Cell Identifier of the specified kind.
1819 * \param [out] cid Compose new Cell Identifier here.
1820 * \param [in] id_discr Which kind of Cell Identifier to compose.
1821 * \param [in] cgi Cell Global Identifier to form the Cell Identifier from.
1822 */
1823void gsm0808_cell_id_from_cgi(struct gsm0808_cell_id *cid, enum CELL_IDENT id_discr,
1824 const struct osmo_cell_global_id *cgi)
1825{
1826 *cid = (struct gsm0808_cell_id){
1827 .id_discr = id_discr,
1828 };
1829
1830 switch (id_discr) {
1831 case CELL_IDENT_WHOLE_GLOBAL:
1832 cid->id.global = *cgi;
1833 return;
1834
Pau Espin Pedrol20b763d2021-02-15 16:06:22 +01001835 case CELL_IDENT_WHOLE_GLOBAL_PS:
1836 cid->id.global_ps = (struct osmo_cell_global_id_ps){
1837 .rai = {
1838 .lac = cgi->lai,
1839 },
1840 .cell_identity = cgi->cell_identity,
1841 };
1842 return;
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001843 case CELL_IDENT_LAC_AND_CI:
1844 cid->id.lac_and_ci = (struct osmo_lac_and_ci_id){
1845 .lac = cgi->lai.lac,
1846 .ci = cgi->cell_identity,
1847 };
1848 return;
1849
1850 case CELL_IDENT_CI:
1851 cid->id.ci = cgi->cell_identity;
1852 return;
1853
1854 case CELL_IDENT_LAI:
1855 cid->id.lai_and_lac = cgi->lai;
1856 return;
1857
1858 case CELL_IDENT_LAC:
1859 cid->id.lac = cgi->lai.lac;
1860 return;
1861
1862 case CELL_IDENT_NO_CELL:
1863 case CELL_IDENT_BSS:
1864 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1865 case CELL_IDENT_UTRAN_RNC:
1866 case CELL_IDENT_UTRAN_LAC_RNC:
1867 default:
1868 return;
1869 };
1870}
1871
1872/*! Overwrite parts of cgi with values from a Cell Identifier.
1873 * Place only those items given in cid into cgi, leaving other values unchanged.
1874 * \param[out] cgi Cell Global Identity to write to.
1875 * \param[in] cid Cell Identity to read from.
1876 * \return a bitmask of items that were set: OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI; 0 if nothing was
1877 * written to cgi.
1878 */
1879int gsm0808_cell_id_to_cgi(struct osmo_cell_global_id *cgi, const struct gsm0808_cell_id *cid)
1880{
1881 switch (cid->id_discr) {
1882 case CELL_IDENT_WHOLE_GLOBAL:
1883 *cgi = cid->id.global;
1884 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1885
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001886 case CELL_IDENT_WHOLE_GLOBAL_PS:
1887 cgi->lai = cid->id.global_ps.rai.lac;
1888 cgi->cell_identity = cid->id.global_ps.cell_identity;
1889 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1890
Neels Hofmeyr3a504532019-02-10 22:28:27 +01001891 case CELL_IDENT_LAC_AND_CI:
1892 cgi->lai.lac = cid->id.lac_and_ci.lac;
1893 cgi->cell_identity = cid->id.lac_and_ci.ci;
1894 return OSMO_CGI_PART_LAC | OSMO_CGI_PART_CI;
1895
1896 case CELL_IDENT_CI:
1897 cgi->cell_identity = cid->id.ci;
1898 return OSMO_CGI_PART_CI;
1899
1900 case CELL_IDENT_LAI:
1901 cgi->lai = cid->id.lai_and_lac;
1902 return OSMO_CGI_PART_PLMN | OSMO_CGI_PART_LAC;
1903
1904 case CELL_IDENT_LAC:
1905 cgi->lai.lac = cid->id.lac;
1906 return OSMO_CGI_PART_LAC;
1907
1908 case CELL_IDENT_NO_CELL:
1909 case CELL_IDENT_BSS:
1910 case CELL_IDENT_UTRAN_PLMN_LAC_RNC:
1911 case CELL_IDENT_UTRAN_RNC:
1912 case CELL_IDENT_UTRAN_LAC_RNC:
1913 default:
1914 return 0;
1915 };
1916}
1917
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001918/*! value_string[] for enum CELL_IDENT. */
1919const struct value_string gsm0808_cell_id_discr_names[] = {
1920 { CELL_IDENT_WHOLE_GLOBAL, "CGI" },
1921 { CELL_IDENT_LAC_AND_CI, "LAC-CI" },
1922 { CELL_IDENT_CI, "CI" },
1923 { CELL_IDENT_NO_CELL, "NO-CELL" },
1924 { CELL_IDENT_LAI_AND_LAC, "LAI" },
1925 { CELL_IDENT_LAC, "LAC" },
1926 { CELL_IDENT_BSS, "BSS" },
1927 { CELL_IDENT_UTRAN_PLMN_LAC_RNC, "UTRAN-PLMN-LAC-RNC" },
1928 { CELL_IDENT_UTRAN_RNC, "UTRAN-RNC" },
1929 { CELL_IDENT_UTRAN_LAC_RNC, "UTRAN-LAC-RNC" },
Pau Espin Pedrolca33a712021-01-05 19:36:48 +01001930 { CELL_IDENT_WHOLE_GLOBAL_PS, "CGI-PS"},
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001931 { 0, NULL }
1932};
1933
1934#define APPEND_THING(func, args...) do { \
1935 int remain = buflen - (pos - buf); \
1936 int l = func(pos, remain, ##args); \
1937 if (l < 0 || l > remain) \
1938 pos = buf + buflen; \
1939 else \
1940 pos += l; \
1941 if (l > 0) \
1942 total_len += l; \
1943 } while(0)
1944#define APPEND_STR(fmt, args...) APPEND_THING(snprintf, fmt, ##args)
1945#define APPEND_CELL_ID_U(DISCR, U) APPEND_THING(gsm0808_cell_id_u_name, DISCR, U)
1946
Harald Welte179f3572019-03-18 18:38:47 +01001947char *gsm0808_cell_id_name_buf(char *buf, size_t buflen, const struct gsm0808_cell_id *cid)
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001948{
1949 char *pos = buf;
1950 int total_len = 0;
1951 APPEND_STR("%s:", gsm0808_cell_id_discr_name(cid->id_discr));
1952 APPEND_CELL_ID_U(cid->id_discr, &cid->id);
1953 return buf;
1954}
1955
1956/*! Return a human readable representation of a Cell Identifier, like "LAC:123"
1957 * or "CGI:001-01-42-23".
1958 * \param[in] cid Cell Identifer.
1959 * \returns String in a static buffer.
1960 */
1961const char *gsm0808_cell_id_name(const struct gsm0808_cell_id *cid)
1962{
Harald Welte171ef822019-03-28 10:49:05 +01001963 static __thread char buf[64];
Harald Welte179f3572019-03-18 18:38:47 +01001964 return gsm0808_cell_id_name_buf(buf, sizeof(buf), cid);
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001965}
1966
1967/*! Like gsm0808_cell_id_name() but uses a different static buffer.
1968 * \param[in] cid Cell Identifer.
1969 * \returns String in a static buffer.
1970 */
1971const char *gsm0808_cell_id_name2(const struct gsm0808_cell_id *cid)
1972{
Harald Welte171ef822019-03-28 10:49:05 +01001973 static __thread char buf[64];
Harald Welte179f3572019-03-18 18:38:47 +01001974 return gsm0808_cell_id_name_buf(buf, sizeof(buf), cid);
1975}
1976
1977char *gsm0808_cell_id_name_c(const void *ctx, const struct gsm0808_cell_id *cid)
1978{
1979 char *buf = talloc_size(ctx, 64);
1980 if (!buf)
1981 return NULL;
1982 return gsm0808_cell_id_name_buf(buf, 64, cid);
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001983}
1984
1985/*! Return a human readable representation of the Cell Identifier List, like
1986 * "LAC[2]:{123, 456}".
1987 * The return value semantics are like snprintf() and thus allow ensuring a complete
1988 * untruncated string by determining the required string length from the return value.
1989 * If buflen > 0, always nul-terminate the string in buf, also when it is truncated.
1990 * If buflen == 0, do not modify buf, just return the would-be length.
1991 * \param[out] buf Destination buffer to write string representation to.
1992 * \param[in] buflen Amount of memory available in \a buf.
1993 * \param[in] cil Cell Identifer List.
1994 * \returns Like snprintf(): the amount of characters (excluding terminating nul) written,
1995 * or that would have been written if the buffer were large enough.
1996 */
1997int gsm0808_cell_id_list_name_buf(char *buf, size_t buflen, const struct gsm0808_cell_id_list2 *cil)
1998{
1999 char *pos = buf;
2000 int total_len = 0;
2001 int i;
2002
2003 APPEND_STR("%s[%u]", gsm0808_cell_id_discr_name(cil->id_discr), cil->id_list_len);
2004
2005 switch (cil->id_discr) {
2006 case CELL_IDENT_BSS:
2007 case CELL_IDENT_NO_CELL:
2008 return total_len;
2009 default:
2010 break;
2011 }
2012
2013 APPEND_STR(":{");
2014
2015 for (i = 0; i < cil->id_list_len; i++) {
2016 if (i)
2017 APPEND_STR(", ");
2018 APPEND_CELL_ID_U(cil->id_discr, &cil->id_list[i]);
2019 }
2020
2021 APPEND_STR("}");
2022 return total_len;
2023}
2024
2025/*! Return a human-readable representation of \a cil in a static buffer.
2026 * If the list is too long, the output may be truncated.
2027 * See also gsm0808_cell_id_list_name_buf(). */
2028const char *gsm0808_cell_id_list_name(const struct gsm0808_cell_id_list2 *cil)
2029{
Harald Welte171ef822019-03-28 10:49:05 +01002030 static __thread char buf[1024];
Neels Hofmeyra4399c82018-04-17 02:26:10 +02002031 gsm0808_cell_id_list_name_buf(buf, sizeof(buf), cil);
2032 return buf;
2033}
2034
Harald Welte179f3572019-03-18 18:38:47 +01002035char *gsm0808_cell_id_list_name_c(const void *ctx, const struct gsm0808_cell_id_list2 *cil)
2036{
2037 char *buf = talloc_size(ctx, 1024);
2038 if (!buf)
2039 return NULL;
2040 gsm0808_cell_id_list_name_buf(buf, 1024, cil);
2041 return buf;
2042}
2043
Neels Hofmeyra4399c82018-04-17 02:26:10 +02002044#undef APPEND_STR
2045#undef APPEND_CELL_ID_U
2046
Harald Welte4a62eda2019-03-18 18:27:00 +01002047char *gsm0808_channel_type_name_buf(char *buf, size_t buf_len, const struct gsm0808_channel_type *ct)
Neels Hofmeyrafacc2b2018-04-16 22:41:51 +02002048{
Harald Welte4a62eda2019-03-18 18:27:00 +01002049 snprintf(buf, buf_len, "ch_indctr=0x%x ch_rate_type=0x%x perm_spch=%s",
Neels Hofmeyrafacc2b2018-04-16 22:41:51 +02002050 ct->ch_indctr, ct->ch_rate_type,
2051 osmo_hexdump(ct->perm_spch, ct->perm_spch_len));
2052 return buf;
2053}
2054
Harald Welte4a62eda2019-03-18 18:27:00 +01002055const char *gsm0808_channel_type_name(const struct gsm0808_channel_type *ct)
2056{
Harald Welte171ef822019-03-28 10:49:05 +01002057 static __thread char buf[128];
Harald Welte4a62eda2019-03-18 18:27:00 +01002058 return gsm0808_channel_type_name_buf(buf, sizeof(buf), ct);
2059}
2060
Harald Welte179f3572019-03-18 18:38:47 +01002061char *gsm0808_channel_type_name_c(const void *ctx, const struct gsm0808_channel_type *ct)
2062{
2063 char *buf = talloc_size(ctx, 128);
2064 if (!buf)
2065 return NULL;
2066 return gsm0808_channel_type_name_buf(buf, 128, ct);
2067}
2068
Harald Welte96e2a002017-06-12 21:44:18 +02002069/*! @} */