blob: 63b87200d57de96ab6e07c9f97973622a77775f3 [file] [log] [blame]
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001/*
2 * (C) 2012 by Holger Hans Peter Freyther
3 * All Rights Reserved
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 */
20
21#include <osmocom/gsm/gsm0808.h>
Philipp Maier22401432017-03-24 17:59:26 +010022#include <osmocom/gsm/gsm0808_utils.h>
23#include <osmocom/gsm/protocol/gsm_08_08.h>
Philipp Maier3d48ec02017-03-29 17:37:55 +020024#include <osmocom/gsm/protocol/gsm_08_58.h>
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +010025
26#include <stdio.h>
27#include <stdlib.h>
Philipp Maier22401432017-03-24 17:59:26 +010028#include <sys/socket.h>
29#include <netinet/in.h>
30#include <arpa/inet.h>
Neels Hofmeyr74663d92018-03-23 01:46:42 +010031#include <errno.h>
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +010032
Philipp Maier4f4905f2018-11-30 13:36:12 +010033#define EXPECT_ENCODED(hexstr) do { \
34 const char *enc_str = msgb_hexdump(msg); \
35 printf("%s: encoded: %s(rc = %u)\n", __func__, enc_str, rc_enc); \
36 OSMO_ASSERT(strcmp(enc_str, hexstr " ") == 0); \
37 OSMO_ASSERT(rc_enc == msg->len); \
38 } while(0)
39
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +010040#define VERIFY(msg, data, len) \
41 if (msgb_l3len(msg) != len) { \
42 printf("%s:%d Length don't match: %d vs. %d. %s\n", \
Holger Hans Peter Freytherfdb46672015-11-09 16:32:43 +000043 __func__, __LINE__, msgb_l3len(msg), (int) len, \
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +010044 osmo_hexdump(msg->l3h, msgb_l3len(msg))); \
45 abort(); \
46 } else if (memcmp(msg->l3h, data, len) != 0) { \
47 printf("%s:%d didn't match: got: %s\n", \
48 __func__, __LINE__, \
49 osmo_hexdump(msg->l3h, msgb_l3len(msg))); \
50 abort(); \
51 }
52
Philipp Maierfa896ab2017-03-27 16:55:32 +020053/* Setup a fake codec list for testing */
54static void setup_codec_list(struct gsm0808_speech_codec_list *scl)
55{
56 memset(scl, 0, sizeof(*scl));
57
58 scl->codec[0].pi = true;
59 scl->codec[0].tf = true;
Philipp Maierbb839662017-06-01 17:11:19 +020060 scl->codec[0].type = GSM0808_SCT_FR3;
Philipp Maierfa896ab2017-03-27 16:55:32 +020061 scl->codec[0].cfg = 0xcdef;
62
63 scl->codec[1].fi = true;
64 scl->codec[1].pt = true;
Philipp Maierbb839662017-06-01 17:11:19 +020065 scl->codec[1].type = GSM0808_SCT_FR2;
Philipp Maierfa896ab2017-03-27 16:55:32 +020066
67 scl->codec[2].fi = true;
68 scl->codec[2].tf = true;
Philipp Maierbb839662017-06-01 17:11:19 +020069 scl->codec[2].type = GSM0808_SCT_CSD;
70 scl->codec[2].cfg = 0xc0;
Philipp Maierfa896ab2017-03-27 16:55:32 +020071
72 scl->len = 3;
73}
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +010074
Philipp Maier4f4905f2018-11-30 13:36:12 +010075void test_gsm0808_enc_cause(void)
76{
77 /* NOTE: This must be tested early because many of the following tests
78 * rely on the generation of a proper cause code. */
79
80 uint8_t rc_enc;
81 struct msgb *msg;
82
83 /* Test with a single byte cause code */
84 msg = msgb_alloc(1024, "output buffer");
85 rc_enc = gsm0808_enc_cause(msg, 0x41);
86 EXPECT_ENCODED("04 01 41");
87 msgb_free(msg);
88
89 /* Test with an extended (two byte) cause code */
90 msg = msgb_alloc(1024, "output buffer");
91 rc_enc = gsm0808_enc_cause(msg, 0x8041);
92 EXPECT_ENCODED("04 02 80 41");
93 msgb_free(msg);
94}
95
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +010096static void test_create_layer3(void)
97{
98 static const uint8_t res[] = {
99 0x00, 0x0e, 0x57, 0x05, 0x08, 0x00, 0x77, 0x62,
100 0x83, 0x33, 0x66, 0x44, 0x88, 0x17, 0x01, 0x23 };
101 struct msgb *msg, *in_msg;
Neels Hofmeyr178bf7a2018-04-20 12:23:45 +0200102 struct osmo_cell_global_id cgi = {
103 .lai = {
104 .plmn = {
105 .mcc = 0x2244,
106 .mnc = 0x1122,
107 },
108 .lac = 0x3366,
109 },
110 .cell_identity = 0x4488,
111 };
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100112 printf("Testing creating Layer3\n");
113
114 in_msg = msgb_alloc_headroom(512, 128, "foo");
115 in_msg->l3h = in_msg->data;
116 msgb_v_put(in_msg, 0x23);
117
Neels Hofmeyr178bf7a2018-04-20 12:23:45 +0200118 msg = gsm0808_create_layer3_2(in_msg, &cgi, NULL);
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100119 VERIFY(msg, res, ARRAY_SIZE(res));
120 msgb_free(msg);
121 msgb_free(in_msg);
122}
123
Philipp Maierfa896ab2017-03-27 16:55:32 +0200124static void test_create_layer3_aoip()
125{
126 static const uint8_t res[] = {
127 0x00, 0x17, 0x57, 0x05, 0x08, 0x00, 0x77, 0x62,
128 0x83, 0x33, 0x66, 0x44, 0x88, 0x17, 0x01, 0x23,
Philipp Maierbb839662017-06-01 17:11:19 +0200129 GSM0808_IE_SPEECH_CODEC_LIST, 0x07, GSM0808_SCT_FR3 | 0x50,
Philipp Maier7e27b142018-03-22 17:26:46 +0100130 0xef, 0xcd, GSM0808_SCT_FR2 | 0xa0, 0x9f,
Philipp Maierbb839662017-06-01 17:11:19 +0200131 GSM0808_SCT_CSD | 0x90, 0xc0
Philipp Maierfa896ab2017-03-27 16:55:32 +0200132 };
Maxfa3b4822018-11-05 14:59:54 +0100133 struct osmo_cell_global_id cgi = {
134 .lai = {
135 .plmn = {
136 .mcc = 0x2244,
137 .mnc = 0x1122,
138 },
139 .lac = 0x3366,
140 },
141 .cell_identity = 0x4488,
142 };
Philipp Maierfa896ab2017-03-27 16:55:32 +0200143 struct msgb *msg, *in_msg;
144 struct gsm0808_speech_codec_list sc_list;
145 printf("Testing creating Layer3 (AoIP)\n");
146
147 setup_codec_list(&sc_list);
148
149 in_msg = msgb_alloc_headroom(512, 128, "foo");
150 in_msg->l3h = in_msg->data;
151 msgb_v_put(in_msg, 0x23);
152
Maxfa3b4822018-11-05 14:59:54 +0100153 msg = gsm0808_create_layer3_2(in_msg, &cgi, &sc_list);
154
Philipp Maierfa896ab2017-03-27 16:55:32 +0200155 VERIFY(msg, res, ARRAY_SIZE(res));
156
157 msgb_free(msg);
158 msgb_free(in_msg);
159}
160
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100161static void test_create_reset()
162{
163 static const uint8_t res[] = { 0x00, 0x04, 0x30, 0x04, 0x01, 0x20 };
164 struct msgb *msg;
165
166 printf("Testing creating Reset\n");
167 msg = gsm0808_create_reset();
168 VERIFY(msg, res, ARRAY_SIZE(res));
169 msgb_free(msg);
170}
171
Philipp Maier15596e22017-04-05 17:55:27 +0200172static void test_create_reset_ack()
173{
174 static const uint8_t res[] = { 0x00, 0x01, 0x31 };
175 struct msgb *msg;
176
177 printf("Testing creating Reset Ack\n");
178 msg = gsm0808_create_reset_ack();
179 VERIFY(msg, res, ARRAY_SIZE(res));
180 msgb_free(msg);
181}
182
183
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100184static void test_create_clear_command()
185{
186 static const uint8_t res[] = { 0x20, 0x04, 0x01, 0x23 };
187 struct msgb *msg;
188
189 printf("Testing creating Clear Command\n");
190 msg = gsm0808_create_clear_command(0x23);
191 VERIFY(msg, res, ARRAY_SIZE(res));
192 msgb_free(msg);
193}
194
195static void test_create_clear_complete()
196{
197 static const uint8_t res[] = { 0x00, 0x01, 0x21 };
198 struct msgb *msg;
199
200 printf("Testing creating Clear Complete\n");
201 msg = gsm0808_create_clear_complete();
202 VERIFY(msg, res, ARRAY_SIZE(res));
203 msgb_free(msg);
204}
205
Philipp Maierb478dd32017-03-29 15:50:05 +0200206static void test_create_cipher()
207{
208 static const uint8_t res[] =
209 { 0x00, 0x0c, 0x53, 0x0a, 0x09, 0x03, 0xaa,
210 0xbb, 0xcc, 0xdd, 0xee, 0xff, 0x23, 0x42 };
211 static const uint8_t res2[] =
212 { 0x00, 0x0e, 0x53, 0x0a, 0x09, 0x03, 0xaa,
213 0xbb, 0xcc, 0xdd, 0xee, 0xff, 0x23, 0x42,
214 GSM0808_IE_CIPHER_RESPONSE_MODE, 0x01 };
215 struct msgb *msg;
216 struct gsm0808_encrypt_info ei;
217 uint8_t include_imeisv;
218
219 memset(&ei, 0, sizeof(ei));
220 ei.perm_algo[0] = GSM0808_ALG_ID_A5_0;
221 ei.perm_algo[1] = GSM0808_ALG_ID_A5_1;
222 ei.perm_algo_len = 2;
223 ei.key[0] = 0xaa;
224 ei.key[1] = 0xbb;
225 ei.key[2] = 0xcc;
226 ei.key[3] = 0xdd;
227 ei.key[4] = 0xee;
228 ei.key[5] = 0xff;
229 ei.key[6] = 0x23;
230 ei.key[7] = 0x42;
231 ei.key_len = 8;
232 include_imeisv = 1;
233
234 printf("Testing creating Chipher Mode Command\n");
235 msg = gsm0808_create_cipher(&ei, NULL);
236 OSMO_ASSERT(msg);
237 VERIFY(msg, res, ARRAY_SIZE(res));
238 msgb_free(msg);
239
240 msg = gsm0808_create_cipher(&ei, &include_imeisv);
241 OSMO_ASSERT(msg);
242 VERIFY(msg, res2, ARRAY_SIZE(res2));
243 msgb_free(msg);
244}
245
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100246static void test_create_cipher_complete()
247{
248 static const uint8_t res1[] = {
249 0x00, 0x08, 0x55, 0x20, 0x03, 0x23, 0x42, 0x21, 0x2c, 0x04 };
250 static const uint8_t res2[] = { 0x00, 0x03, 0x55, 0x2c, 0x04};
251 struct msgb *l3, *msg;
252
253 printf("Testing creating Cipher Complete\n");
254 l3 = msgb_alloc_headroom(512, 128, "l3h");
255 l3->l3h = l3->data;
256 msgb_v_put(l3, 0x23);
257 msgb_v_put(l3, 0x42);
258 msgb_v_put(l3, 0x21);
259
260 /* with l3 data */
261 msg = gsm0808_create_cipher_complete(l3, 4);
262 VERIFY(msg, res1, ARRAY_SIZE(res1));
263 msgb_free(msg);
264
265 /* with l3 data but short */
266 l3->len -= 1;
267 l3->tail -= 1;
268 msg = gsm0808_create_cipher_complete(l3, 4);
269 VERIFY(msg, res2, ARRAY_SIZE(res2));
270 msgb_free(msg);
271
272 /* without l3 data */
273 msg = gsm0808_create_cipher_complete(NULL, 4);
274 VERIFY(msg, res2, ARRAY_SIZE(res2));
275 msgb_free(msg);
276
277
278 msgb_free(l3);
279}
280
Maxed651d22018-11-07 15:25:05 +0100281static inline void parse_cipher_reject(struct msgb *msg, uint8_t exp)
282{
283 struct tlv_parsed tp;
284 int rc;
285
286 /* skip header and message type so we can parse Cause IE directly */
287 msg->l2h = msgb_data(msg) + sizeof(struct bssmap_header) + 1;
288
289 rc = osmo_bssap_tlv_parse(&tp, msg->l2h, msgb_l2len(msg));
290 if (rc < 0)
291 printf("FIXME: failed (%d) to parse created message %s\n", rc, msgb_hexdump(msg));
292
293 rc = gsm0808_get_cipher_reject_cause(&tp);
294 if (rc < 0)
295 printf("FIXME: failed (%s) to extract Cause from created message %s\n",
296 strerror(-rc), msgb_hexdump(msg));
297
298 if (exp != (enum gsm0808_cause)rc)
299 printf("FIXME: wrong Cause %d != %u (" OSMO_BIN_SPEC ") extracted from created message %s\n",
300 rc, exp, OSMO_BIT_PRINT(exp), msgb_hexdump(msg));
301}
302
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100303static void test_create_cipher_reject()
304{
Harald Welte62e40852017-12-17 20:50:34 +0100305 static const uint8_t res[] = { 0x00, 0x04, 0x59, 0x04, 0x01, 0x23 };
Maxed651d22018-11-07 15:25:05 +0100306 enum gsm0808_cause cause = GSM0808_CAUSE_CCCH_OVERLOAD;
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100307 struct msgb *msg;
308
309 printf("Testing creating Cipher Reject\n");
Maxed651d22018-11-07 15:25:05 +0100310 msg = gsm0808_create_cipher_reject(cause);
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100311 VERIFY(msg, res, ARRAY_SIZE(res));
Maxed651d22018-11-07 15:25:05 +0100312
313 parse_cipher_reject(msg, cause);
314
315 msgb_free(msg);
316}
317
318static void test_create_cipher_reject_ext()
319{
320 static const uint8_t res[] = { 0x00, 0x05, 0x59, 0x04, 0x02, 0xd0, 0xFA };
321 uint8_t cause = 0xFA;
322 struct msgb *msg;
323
324 printf("Testing creating Cipher Reject (extended)\n");
325 msg = gsm0808_create_cipher_reject_ext(GSM0808_CAUSE_CLASS_INVAL, cause);
326 VERIFY(msg, res, ARRAY_SIZE(res));
327
328 parse_cipher_reject(msg, cause);
329
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100330 msgb_free(msg);
331}
332
333static void test_create_cm_u()
334{
Harald Welte07b625d2012-01-23 10:02:58 +0100335 static const uint8_t res[] = {
336 0x00, 0x07, 0x54, 0x12, 0x01, 0x23, 0x13, 0x01, 0x42 };
337 static const uint8_t res2o[] = {
338 0x00, 0x04, 0x54, 0x12, 0x01, 0x23 };
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100339 struct msgb *msg;
Harald Welte07b625d2012-01-23 10:02:58 +0100340 const uint8_t cm2 = 0x23;
341 const uint8_t cm3 = 0x42;
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100342
343 printf("Testing creating CM U\n");
Harald Welte07b625d2012-01-23 10:02:58 +0100344 msg = gsm0808_create_classmark_update(&cm2, 1, &cm3, 1);
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100345 VERIFY(msg, res, ARRAY_SIZE(res));
Harald Welte07b625d2012-01-23 10:02:58 +0100346
Neels Hofmeyr9a938ae2017-11-16 17:34:07 +0100347 msgb_free(msg);
348
Harald Welte07b625d2012-01-23 10:02:58 +0100349 msg = gsm0808_create_classmark_update(&cm2, 1, NULL, 0);
350 VERIFY(msg, res2o, ARRAY_SIZE(res2o));
351
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100352 msgb_free(msg);
353}
354
355static void test_create_sapi_reject()
356{
357 static const uint8_t res[] = { 0x00, 0x03, 0x25, 0x03, 0x25 };
358 struct msgb *msg;
359
360 printf("Testing creating SAPI Reject\n");
361 msg = gsm0808_create_sapi_reject(3);
362 VERIFY(msg, res, ARRAY_SIZE(res));
363 msgb_free(msg);
364}
365
Philipp Maierc6144a22017-03-29 17:53:43 +0200366static void test_create_ass()
367{
368 static const uint8_t res1[] =
369 { 0x00, 0x0a, 0x01, 0x0b, 0x04, 0x01, 0x0b, 0xa1, 0x25, 0x01, 0x00,
370 0x04 };
371 static const uint8_t res2[] =
372 { 0x00, 0x20, 0x01, 0x0b, 0x04, 0x01, 0x0b, 0xa1, 0x25, 0x01, 0x00,
373 0x04, GSM0808_IE_AOIP_TRASP_ADDR, 0x06, 0xc0, 0xa8, 0x64, 0x17,
Philipp Maierbb839662017-06-01 17:11:19 +0200374 0x04, 0xd2, GSM0808_IE_SPEECH_CODEC_LIST, 0x07,
Philipp Maier7e27b142018-03-22 17:26:46 +0100375 GSM0808_SCT_FR3 | 0x50, 0xef, 0xcd, GSM0808_SCT_FR2 | 0xa0, 0x9f,
Philipp Maierbb839662017-06-01 17:11:19 +0200376 GSM0808_SCT_CSD | 0x90, 0xc0, GSM0808_IE_CALL_ID, 0xaa, 0xbb,
377 0xcc, 0xdd };
Philipp Maierc6144a22017-03-29 17:53:43 +0200378
379 struct msgb *msg;
380 struct gsm0808_channel_type ct;
381 uint16_t cic = 0004;
382 struct sockaddr_storage ss;
383 struct sockaddr_in sin;
384 struct gsm0808_speech_codec_list sc_list;
385 uint32_t call_id = 0xAABBCCDD;
386
387 memset(&ct, 0, sizeof(ct));
388 ct.ch_indctr = GSM0808_CHAN_SPEECH;
389 ct.ch_rate_type = GSM0808_SPEECH_HALF_PREF;
390 ct.perm_spch[0] = GSM0808_PERM_FR3;
391 ct.perm_spch[1] = GSM0808_PERM_HR3;
392 ct.perm_spch_len = 2;
393
394 memset(&sin, 0, sizeof(sin));
395 sin.sin_family = AF_INET;
396 sin.sin_port = htons(1234);
397 inet_aton("192.168.100.23", &sin.sin_addr);
398
399 memset(&ss, 0, sizeof(ss));
400 memcpy(&ss, &sin, sizeof(sin));
401
402 setup_codec_list(&sc_list);
403
404 printf("Testing creating Assignment Request\n");
405 msg = gsm0808_create_ass(&ct, &cic, NULL, NULL, NULL);
406 OSMO_ASSERT(msg);
407 VERIFY(msg, res1, ARRAY_SIZE(res1));
408 msgb_free(msg);
409
410 msg = gsm0808_create_ass(&ct, &cic, &ss, &sc_list, &call_id);
411 OSMO_ASSERT(msg);
412 VERIFY(msg, res2, ARRAY_SIZE(res2));
413 msgb_free(msg);
414}
415
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100416static void test_create_ass_compl()
417{
418 static const uint8_t res1[] = {
419 0x00, 0x09, 0x02, 0x15, 0x23, 0x21, 0x42, 0x2c,
420 0x11, 0x40, 0x22 };
421 static const uint8_t res2[] = {
422 0x00, 0x07, 0x02, 0x15, 0x23, 0x21, 0x42, 0x2c, 0x11};
423 struct msgb *msg;
424
425 printf("Testing creating Assignment Complete\n");
426 msg = gsm0808_create_assignment_completed(0x23, 0x42, 0x11, 0x22);
427 VERIFY(msg, res1, ARRAY_SIZE(res1));
428 msgb_free(msg);
429
430 msg = gsm0808_create_assignment_completed(0x23, 0x42, 0x11, 0);
431 VERIFY(msg, res2, ARRAY_SIZE(res2));
432 msgb_free(msg);
433}
434
Philipp Maierfa896ab2017-03-27 16:55:32 +0200435static void test_create_ass_compl_aoip()
436{
437 struct sockaddr_storage ss;
438 struct sockaddr_in sin;
439 struct gsm0808_speech_codec sc;
440 struct gsm0808_speech_codec_list sc_list;
441 static const uint8_t res[] =
442 { 0x00, 0x1d, 0x02, 0x15, 0x23, 0x21, 0x42, 0x2c, 0x11, 0x40, 0x22,
443 GSM0808_IE_AOIP_TRASP_ADDR, 0x06, 0xc0, 0xa8, 0x64, 0x17, 0x04,
Philipp Maierbb839662017-06-01 17:11:19 +0200444 0xd2, GSM0808_IE_SPEECH_CODEC, 0x01, GSM0808_SCT_HR1 | 0x90,
Philipp Maier7e27b142018-03-22 17:26:46 +0100445 GSM0808_IE_SPEECH_CODEC_LIST, 0x07, GSM0808_SCT_FR3 | 0x50, 0xef,
446 0xcd, GSM0808_SCT_FR2 | 0xa0, 0x9f, GSM0808_SCT_CSD | 0x90, 0xc0 };
Philipp Maierfa896ab2017-03-27 16:55:32 +0200447 struct msgb *msg;
448
449 memset(&sin, 0, sizeof(sin));
450 sin.sin_family = AF_INET;
451 sin.sin_port = htons(1234);
452 inet_aton("192.168.100.23", &sin.sin_addr);
453
454 memset(&ss, 0, sizeof(ss));
455 memcpy(&ss, &sin, sizeof(sin));
456
457 memset(&sc, 0, sizeof(sc));
458 sc.fi = true;
459 sc.tf = true;
Philipp Maierbb839662017-06-01 17:11:19 +0200460 sc.type = GSM0808_SCT_HR1;
Philipp Maierfa896ab2017-03-27 16:55:32 +0200461
462 setup_codec_list(&sc_list);
463
464 printf("Testing creating Assignment Complete (AoIP)\n");
465 msg = gsm0808_create_ass_compl(0x23, 0x42, 0x11, 0x22,
466 &ss, &sc, &sc_list);
467 VERIFY(msg, res, ARRAY_SIZE(res));
468 msgb_free(msg);
469}
470
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100471static void test_create_ass_fail()
472{
473 static const uint8_t res1[] = { 0x00, 0x04, 0x03, 0x04, 0x01, 0x23 };
474 static const uint8_t res2[] = {
475 0x00, 0x06, 0x03, 0x04, 0x01, 0x23, 0x15, 0x02};
476 uint8_t rr_res = 2;
477 struct msgb *msg;
478
479 printf("Testing creating Assignment Failure\n");
480 msg = gsm0808_create_assignment_failure(0x23, NULL);
481 VERIFY(msg, res1, ARRAY_SIZE(res1));
482 msgb_free(msg);
483
484 msg = gsm0808_create_assignment_failure(0x23, &rr_res);
485 VERIFY(msg, res2, ARRAY_SIZE(res2));
486 msgb_free(msg);
487}
488
Philipp Maierfa896ab2017-03-27 16:55:32 +0200489static void test_create_ass_fail_aoip()
490{
491 static const uint8_t res1[] =
492 { 0x00, 0x0d, 0x03, 0x04, 0x01, 0x23, GSM0808_IE_SPEECH_CODEC_LIST,
Philipp Maier7e27b142018-03-22 17:26:46 +0100493 0x07, GSM0808_SCT_FR3 | 0x50, 0xef, 0xcd, GSM0808_SCT_FR2 | 0xa0,
Philipp Maierbb839662017-06-01 17:11:19 +0200494 0x9f, GSM0808_SCT_CSD | 0x90, 0xc0 };
Philipp Maierfa896ab2017-03-27 16:55:32 +0200495 static const uint8_t res2[] =
496 { 0x00, 0x0f, 0x03, 0x04, 0x01, 0x23, 0x15, 0x02,
Philipp Maier7e27b142018-03-22 17:26:46 +0100497 GSM0808_IE_SPEECH_CODEC_LIST, 0x07, GSM0808_SCT_FR3 | 0x50, 0xef,
498 0xcd, GSM0808_SCT_FR2 | 0xa0, 0x9f, GSM0808_SCT_CSD | 0x90, 0xc0 };
Philipp Maierfa896ab2017-03-27 16:55:32 +0200499 uint8_t rr_res = 2;
500 struct msgb *msg;
501 struct gsm0808_speech_codec_list sc_list;
502
503 setup_codec_list(&sc_list);
504
505 printf("Testing creating Assignment Failure (AoIP)\n");
506 msg = gsm0808_create_ass_fail(0x23, NULL, &sc_list);
507 VERIFY(msg, res1, ARRAY_SIZE(res1));
508 msgb_free(msg);
509
510 msg = gsm0808_create_ass_fail(0x23, &rr_res, &sc_list);
511 VERIFY(msg, res2, ARRAY_SIZE(res2));
512 msgb_free(msg);
513}
514
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100515static void test_create_clear_rqst()
516{
517 static const uint8_t res[] = { 0x00, 0x04, 0x22, 0x04, 0x01, 0x23 };
518 struct msgb *msg;
519
520 printf("Testing creating Clear Request\n");
521 msg = gsm0808_create_clear_rqst(0x23);
522 VERIFY(msg, res, ARRAY_SIZE(res));
523 msgb_free(msg);
524}
525
Philipp Maier3d48ec02017-03-29 17:37:55 +0200526static void test_create_paging()
527{
528 static const uint8_t res[] =
529 { 0x00, 0x10, 0x52, 0x08, 0x08, 0x09, 0x10, 0x10, 0x00, 0x00, 0x00,
530 0x21, 0x43, 0x1a, 0x03, 0x05, 0x23, 0x42 };
531 static const uint8_t res2[] =
532 { 0x00, 0x16, 0x52, 0x08, 0x08, 0x09, 0x10, 0x10, 0x00, 0x00, 0x00,
533 0x21, 0x43, GSM0808_IE_TMSI, 0x04, 0x12, 0x34, 0x56, 0x78, 0x1a,
534 0x03, 0x05, 0x23, 0x42 };
535 static const uint8_t res3[] =
536 { 0x00, 0x18, 0x52, 0x08, 0x08, 0x09, 0x10, 0x10, 0x00, 0x00, 0x00,
537 0x21, 0x43, GSM0808_IE_TMSI, 0x04, 0x12, 0x34, 0x56, 0x78, 0x1a,
538 0x03, 0x05, 0x23, 0x42, GSM0808_IE_CHANNEL_NEEDED,
539 RSL_CHANNEED_TCH_ForH };
540
541 struct msgb *msg;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100542 struct gsm0808_cell_id_list2 cil;
Philipp Maier3d48ec02017-03-29 17:37:55 +0200543 uint32_t tmsi = 0x12345678;
544 uint8_t chan_needed = RSL_CHANNEED_TCH_ForH;
545
546 char imsi[] = "001010000001234";
547
548 cil.id_discr = CELL_IDENT_LAC;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100549 cil.id_list[0].lac = 0x2342;
Philipp Maier3d48ec02017-03-29 17:37:55 +0200550 cil.id_list_len = 1;
551
552 printf("Testing creating Paging Request\n");
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100553 msg = gsm0808_create_paging2(imsi, NULL, &cil, NULL);
Philipp Maier3d48ec02017-03-29 17:37:55 +0200554 VERIFY(msg, res, ARRAY_SIZE(res));
555 msgb_free(msg);
556
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100557 msg = gsm0808_create_paging2(imsi, &tmsi, &cil, NULL);
Philipp Maier3d48ec02017-03-29 17:37:55 +0200558 VERIFY(msg, res2, ARRAY_SIZE(res2));
559 msgb_free(msg);
560
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100561 msg = gsm0808_create_paging2(imsi, &tmsi, &cil, &chan_needed);
Philipp Maier3d48ec02017-03-29 17:37:55 +0200562 VERIFY(msg, res3, ARRAY_SIZE(res3));
563 msgb_free(msg);
564}
565
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +0100566static void test_create_dtap()
567{
568 static const uint8_t res[] = { 0x01, 0x03, 0x02, 0x23, 0x42 };
569 struct msgb *msg, *l3;
570
571 printf("Testing creating DTAP\n");
572 l3 = msgb_alloc_headroom(512, 128, "test");
573 l3->l3h = l3->data;
574 msgb_v_put(l3, 0x23);
575 msgb_v_put(l3, 0x42);
576
577 msg = gsm0808_create_dtap(l3, 0x3);
578 VERIFY(msg, res, ARRAY_SIZE(res));
579 msgb_free(msg);
580 msgb_free(l3);
581}
582
583static void test_prepend_dtap()
584{
585 static const uint8_t res[] = { 0x01, 0x03, 0x02, 0x23, 0x42 };
586 struct msgb *in_msg;
587
588 printf("Testing prepend DTAP\n");
589
590 in_msg = msgb_alloc_headroom(512, 128, "test");
591 msgb_v_put(in_msg, 0x23);
592 msgb_v_put(in_msg, 0x42);
593
594 gsm0808_prepend_dtap_header(in_msg, 0x3);
595 in_msg->l3h = in_msg->data;
596 VERIFY(in_msg, res, ARRAY_SIZE(res));
597 msgb_free(in_msg);
598}
599
Philipp Maier22401432017-03-24 17:59:26 +0100600static void test_enc_dec_aoip_trasp_addr_v4()
601{
602 struct sockaddr_storage enc_addr;
603 struct sockaddr_storage dec_addr;
604 struct sockaddr_in enc_addr_in;
605 struct msgb *msg;
606 uint8_t rc_enc;
607 int rc_dec;
608
609 memset(&enc_addr_in, 0, sizeof(enc_addr_in));
610 enc_addr_in.sin_family = AF_INET;
611 enc_addr_in.sin_port = htons(1234);
612 inet_aton("255.0.255.255", &enc_addr_in.sin_addr);
613
614 memset(&enc_addr, 0, sizeof(enc_addr));
615 memcpy(&enc_addr, &enc_addr_in, sizeof(enc_addr_in));
616
617 msg = msgb_alloc(1024, "output buffer");
618 rc_enc = gsm0808_enc_aoip_trasp_addr(msg, &enc_addr);
619 OSMO_ASSERT(rc_enc == 8);
620 rc_dec =
621 gsm0808_dec_aoip_trasp_addr(&dec_addr, msg->data + 2, msg->len - 2);
622 OSMO_ASSERT(rc_dec == 6);
623 OSMO_ASSERT(memcmp(&enc_addr, &dec_addr, sizeof(enc_addr)) == 0);
624
625 msgb_free(msg);
626}
627
628static void test_enc_dec_aoip_trasp_addr_v6()
629{
630 struct sockaddr_storage enc_addr;
631 struct sockaddr_storage dec_addr;
632 struct sockaddr_in6 enc_addr_in;
633 struct msgb *msg;
634 uint8_t rc_enc;
635 int rc_dec;
636
637 memset(&enc_addr_in, 0, sizeof(enc_addr_in));
638 enc_addr_in.sin6_family = AF_INET6;
639 enc_addr_in.sin6_port = htons(4567);
640 inet_pton(AF_INET6, "2001:0db8:85a3:08d3:1319:8a2e:0370:7344",
641 &enc_addr_in.sin6_addr);
642
643 memset(&enc_addr, 0, sizeof(enc_addr));
644 memcpy(&enc_addr, &enc_addr_in, sizeof(enc_addr_in));
645
646 msg = msgb_alloc(1024, "output buffer");
647 rc_enc = gsm0808_enc_aoip_trasp_addr(msg, &enc_addr);
648 OSMO_ASSERT(rc_enc == 20);
649 rc_dec =
650 gsm0808_dec_aoip_trasp_addr(&dec_addr, msg->data + 2, msg->len - 2);
651 OSMO_ASSERT(rc_dec == 18);
652 OSMO_ASSERT(memcmp(&enc_addr, &dec_addr, sizeof(enc_addr)) == 0);
653
654 msgb_free(msg);
655}
656
Philipp Maier6f725d62017-03-24 18:03:17 +0100657static void test_gsm0808_enc_dec_speech_codec()
658{
Neels Hofmeyr9a4286b2018-04-20 12:27:52 +0200659 struct gsm0808_speech_codec enc_sc = {
660 .pi = true,
661 .tf = true,
662 .type = GSM0808_SCT_FR2,
663 };
664 struct gsm0808_speech_codec dec_sc = {};
Philipp Maier6f725d62017-03-24 18:03:17 +0100665 struct msgb *msg;
666 uint8_t rc_enc;
667 int rc_dec;
668
Philipp Maier6f725d62017-03-24 18:03:17 +0100669 msg = msgb_alloc(1024, "output buffer");
670 rc_enc = gsm0808_enc_speech_codec(msg, &enc_sc);
671 OSMO_ASSERT(rc_enc == 3);
672
673 rc_dec = gsm0808_dec_speech_codec(&dec_sc, msg->data + 2, msg->len - 2);
674 OSMO_ASSERT(rc_dec == 1);
675
676 OSMO_ASSERT(memcmp(&enc_sc, &dec_sc, sizeof(enc_sc)) == 0);
677
678 msgb_free(msg);
679}
680
681
Philipp Maierbb839662017-06-01 17:11:19 +0200682static void test_gsm0808_enc_dec_speech_codec_with_cfg()
683{
Neels Hofmeyrc62c9342018-04-15 23:31:47 +0200684 struct gsm0808_speech_codec enc_sc = {
685 .pi = true,
686 .tf = true,
687 .type = GSM0808_SCT_FR3,
688 .cfg = 0xabcd,
689 };
690 struct gsm0808_speech_codec dec_sc = {};
Philipp Maierbb839662017-06-01 17:11:19 +0200691 struct msgb *msg;
692 uint8_t rc_enc;
693 int rc_dec;
694
Philipp Maierbb839662017-06-01 17:11:19 +0200695 msg = msgb_alloc(1024, "output buffer");
696 rc_enc = gsm0808_enc_speech_codec(msg, &enc_sc);
697 OSMO_ASSERT(rc_enc == 5);
698
699 rc_dec = gsm0808_dec_speech_codec(&dec_sc, msg->data + 2, msg->len - 2);
700 OSMO_ASSERT(rc_dec == 3);
701
702 OSMO_ASSERT(memcmp(&enc_sc, &dec_sc, sizeof(enc_sc)) == 0);
703
704 msgb_free(msg);
705}
706
Philipp Maier6f725d62017-03-24 18:03:17 +0100707static void test_gsm0808_enc_dec_speech_codec_ext_with_cfg()
708{
Neels Hofmeyr9a4286b2018-04-20 12:27:52 +0200709 struct gsm0808_speech_codec enc_sc = {
710 .pi = true,
711 .tf = true,
712 .type = GSM0808_SCT_CSD,
713 .cfg = 0xc0,
714 };
715 struct gsm0808_speech_codec dec_sc = {};
Philipp Maier6f725d62017-03-24 18:03:17 +0100716 struct msgb *msg;
717 uint8_t rc_enc;
718 int rc_dec;
719
Philipp Maier6f725d62017-03-24 18:03:17 +0100720 msg = msgb_alloc(1024, "output buffer");
721 rc_enc = gsm0808_enc_speech_codec(msg, &enc_sc);
Philipp Maierbb839662017-06-01 17:11:19 +0200722 OSMO_ASSERT(rc_enc == 5);
Philipp Maier6f725d62017-03-24 18:03:17 +0100723
724 rc_dec = gsm0808_dec_speech_codec(&dec_sc, msg->data + 2, msg->len - 2);
Philipp Maierbb839662017-06-01 17:11:19 +0200725 OSMO_ASSERT(rc_dec == 3);
Philipp Maier6f725d62017-03-24 18:03:17 +0100726
727 OSMO_ASSERT(memcmp(&enc_sc, &dec_sc, sizeof(enc_sc)) == 0);
728
729 msgb_free(msg);
730}
731
732static void test_gsm0808_enc_dec_speech_codec_list()
733{
Neels Hofmeyr9a4286b2018-04-20 12:27:52 +0200734 struct gsm0808_speech_codec_list enc_scl = {
735 .codec = {
736 {
737 .pi = true,
738 .tf = true,
739 .type = GSM0808_SCT_FR3,
740 .cfg = 0xcdef,
741 },
742
743 {
744 .fi = true,
745 .pt = true,
746 .type = GSM0808_SCT_FR2,
747 },
748
749 {
750 .fi = true,
751 .tf = true,
752 .type = GSM0808_SCT_CSD,
753 .cfg = 0xc0,
754 },
755 },
756 .len = 3,
757 };
758 struct gsm0808_speech_codec_list dec_scl = {};
Philipp Maier6f725d62017-03-24 18:03:17 +0100759 struct msgb *msg;
760 uint8_t rc_enc;
761 int rc_dec;
762
Philipp Maier6f725d62017-03-24 18:03:17 +0100763 msg = msgb_alloc(1024, "output buffer");
764 rc_enc = gsm0808_enc_speech_codec_list(msg, &enc_scl);
765 OSMO_ASSERT(rc_enc == 9);
766
767 rc_dec = gsm0808_dec_speech_codec_list(&dec_scl, msg->data + 2, msg->len - 2);
768 OSMO_ASSERT(rc_dec == 7);
769
770 OSMO_ASSERT(memcmp(&enc_scl, &dec_scl, sizeof(enc_scl)) == 0);
771
772 msgb_free(msg);
773}
774
Philipp Maierf6c369f2018-10-16 15:24:47 +0200775static void test_gsm0808_enc_dec_empty_speech_codec_list()
776{
777 struct gsm0808_speech_codec_list enc_scl = {
778 .len = 0,
779 };
780 struct gsm0808_speech_codec_list dec_scl = {};
781 struct msgb *msg;
782 uint8_t rc_enc;
783 int rc_dec;
784
785 msg = msgb_alloc(1024, "output buffer");
786 rc_enc = gsm0808_enc_speech_codec_list(msg, &enc_scl);
787 OSMO_ASSERT(rc_enc == 2);
788
789 rc_dec = gsm0808_dec_speech_codec_list(&dec_scl, msg->data + 2, msg->len - 2);
790 OSMO_ASSERT(rc_dec == 0);
791
792 OSMO_ASSERT(memcmp(&enc_scl, &dec_scl, sizeof(enc_scl)) == 0);
793
794 msgb_free(msg);
795}
796
Philipp Maiere0c65302017-03-28 17:05:40 +0200797static void test_gsm0808_enc_dec_channel_type()
798{
Neels Hofmeyr9a4286b2018-04-20 12:27:52 +0200799 struct gsm0808_channel_type enc_ct = {
800 .ch_indctr = GSM0808_CHAN_SPEECH,
801 .ch_rate_type = GSM0808_SPEECH_HALF_PREF,
802 .perm_spch = { GSM0808_PERM_FR3, GSM0808_PERM_HR3 },
803 .perm_spch_len = 2,
804 };
805 struct gsm0808_channel_type dec_ct = {};
Philipp Maiere0c65302017-03-28 17:05:40 +0200806 struct msgb *msg;
807 uint8_t ct_enc_expected[] = { GSM0808_IE_CHANNEL_TYPE,
808 0x04, 0x01, 0x0b, 0xa1, 0x25
809 };
810 uint8_t rc_enc;
811 int rc_dec;
812
Philipp Maiere0c65302017-03-28 17:05:40 +0200813 msg = msgb_alloc(1024, "output buffer");
814 rc_enc = gsm0808_enc_channel_type(msg, &enc_ct);
815 OSMO_ASSERT(rc_enc == 6);
816 OSMO_ASSERT(memcmp(ct_enc_expected, msg->data, msg->len) == 0);
817
818 rc_dec = gsm0808_dec_channel_type(&dec_ct, msg->data + 2, msg->len - 2);
819 OSMO_ASSERT(rc_dec == 4);
820 OSMO_ASSERT(memcmp(&enc_ct, &dec_ct, sizeof(enc_ct)) == 0);
821
822 msgb_free(msg);
823}
824
Philipp Maier14e76b92017-03-28 18:36:52 +0200825static void test_gsm0808_enc_dec_encrypt_info()
826{
Neels Hofmeyr9a4286b2018-04-20 12:27:52 +0200827 struct gsm0808_encrypt_info enc_ei = {
828 .perm_algo = { GSM0808_ALG_ID_A5_0, GSM0808_ALG_ID_A5_1 },
829 .perm_algo_len = 2,
830 .key = { 0xaa, 0xbb, 0xcc, 0xdd, 0xee, 0xff, 0x23, 0x42, },
831 .key_len = 8,
832 };
833 struct gsm0808_encrypt_info dec_ei = {};
Philipp Maier14e76b92017-03-28 18:36:52 +0200834 struct msgb *msg;
835 uint8_t ei_enc_expected[] =
836 { GSM0808_IE_ENCRYPTION_INFORMATION, 0x09, 0x03, 0xaa, 0xbb,
837 0xcc, 0xdd, 0xee, 0xff, 0x23, 0x42
838 };
839 uint8_t rc_enc;
840 int rc_dec;
841
Philipp Maier14e76b92017-03-28 18:36:52 +0200842 msg = msgb_alloc(1024, "output buffer");
843 rc_enc = gsm0808_enc_encrypt_info(msg, &enc_ei);
844 OSMO_ASSERT(rc_enc == 11);
845 OSMO_ASSERT(memcmp(ei_enc_expected, msg->data, msg->len) == 0);
846
847 rc_dec = gsm0808_dec_encrypt_info(&dec_ei, msg->data + 2, msg->len - 2);
848 OSMO_ASSERT(rc_dec == 9);
849
850 OSMO_ASSERT(memcmp(&enc_ei, &dec_ei, sizeof(enc_ei)) == 0);
851
852 msgb_free(msg);
853}
854
Philipp Maier783047e2017-03-29 11:35:50 +0200855static void test_gsm0808_enc_dec_cell_id_list_lac()
856{
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100857 struct gsm0808_cell_id_list2 enc_cil;
858 struct gsm0808_cell_id_list2 dec_cil;
Philipp Maier783047e2017-03-29 11:35:50 +0200859 struct msgb *msg;
860 uint8_t rc_enc;
861 int rc_dec;
862
863 memset(&enc_cil, 0, sizeof(enc_cil));
864 enc_cil.id_discr = CELL_IDENT_LAC;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100865 enc_cil.id_list[0].lac = 0x0124;
Neels Hofmeyrdb2fa4e2018-04-13 04:11:20 +0200866 enc_cil.id_list[1].lac = 0xABCD;
867 enc_cil.id_list[2].lac = 0x5678;
Philipp Maier783047e2017-03-29 11:35:50 +0200868 enc_cil.id_list_len = 3;
869
870 msg = msgb_alloc(1024, "output buffer");
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100871 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
Neels Hofmeyrdb2fa4e2018-04-13 04:11:20 +0200872 EXPECT_ENCODED("1a 07 05 01 24 ab cd 56 78");
Philipp Maier783047e2017-03-29 11:35:50 +0200873
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100874 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
Philipp Maier783047e2017-03-29 11:35:50 +0200875 OSMO_ASSERT(rc_dec == 7);
876
877 OSMO_ASSERT(memcmp(&enc_cil, &dec_cil, sizeof(enc_cil)) == 0);
878
879 msgb_free(msg);
880}
881
882static void test_gsm0808_enc_dec_cell_id_list_single_lac()
883{
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100884 struct gsm0808_cell_id_list2 enc_cil;
885 struct gsm0808_cell_id_list2 dec_cil;
Philipp Maier783047e2017-03-29 11:35:50 +0200886 struct msgb *msg;
887 uint8_t cil_enc_expected[] = { GSM0808_IE_CELL_IDENTIFIER_LIST, 0x03,
888 0x05, 0x23, 0x42
889 };
890 uint8_t rc_enc;
891 int rc_dec;
892
893 memset(&enc_cil, 0, sizeof(enc_cil));
894 enc_cil.id_discr = CELL_IDENT_LAC;
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100895 enc_cil.id_list[0].lac = 0x2342;
Philipp Maier783047e2017-03-29 11:35:50 +0200896 enc_cil.id_list_len = 1;
897
898 msg = msgb_alloc(1024, "output buffer");
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100899 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
Philipp Maier783047e2017-03-29 11:35:50 +0200900 OSMO_ASSERT(rc_enc == 5);
901 OSMO_ASSERT(memcmp(cil_enc_expected, msg->data, msg->len) == 0);
902
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100903 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
Philipp Maier783047e2017-03-29 11:35:50 +0200904 OSMO_ASSERT(rc_dec == 3);
905
906 OSMO_ASSERT(memcmp(&enc_cil, &dec_cil, sizeof(enc_cil)) == 0);
907
908 msgb_free(msg);
909}
910
Stefan Sperlinge1a86742018-03-15 18:05:02 +0100911static void test_gsm0808_enc_dec_cell_id_list_multi_lac()
912{
913 struct gsm0808_cell_id_list2 enc_cil;
914 struct gsm0808_cell_id_list2 dec_cil;
915 struct msgb *msg;
916 uint8_t cil_enc_expected[] = { GSM0808_IE_CELL_IDENTIFIER_LIST, 0x0b, 0x05,
917 0x23, 0x42,
918 0x24, 0x43,
919 0x25, 0x44,
920 0x26, 0x45,
921 0x27, 0x46
922 };
923 uint8_t rc_enc;
924 int rc_dec;
925
926 memset(&enc_cil, 0, sizeof(enc_cil));
927 enc_cil.id_discr = CELL_IDENT_LAC;
928 enc_cil.id_list[0].lac = 0x2342;
929 enc_cil.id_list[1].lac = 0x2443;
930 enc_cil.id_list[2].lac = 0x2544;
931 enc_cil.id_list[3].lac = 0x2645;
932 enc_cil.id_list[4].lac = 0x2746;
933 enc_cil.id_list_len = 5;
934
935 msg = msgb_alloc(1024, "output buffer");
936 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
937 OSMO_ASSERT(rc_enc == sizeof(cil_enc_expected));
938 OSMO_ASSERT(memcmp(cil_enc_expected, msg->data, msg->len) == 0);
939
940 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
941 OSMO_ASSERT(rc_dec == msg->len - 2);
942 OSMO_ASSERT(memcmp(&enc_cil, &dec_cil, sizeof(enc_cil)) == 0);
943
944 msgb_free(msg);
945}
946
Philipp Maier783047e2017-03-29 11:35:50 +0200947static void test_gsm0808_enc_dec_cell_id_list_bss()
948{
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100949 struct gsm0808_cell_id_list2 enc_cil;
950 struct gsm0808_cell_id_list2 dec_cil;
Philipp Maier783047e2017-03-29 11:35:50 +0200951 struct msgb *msg;
952 uint8_t rc_enc;
953 int rc_dec;
954
955 memset(&enc_cil, 0, sizeof(enc_cil));
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100956 enc_cil.id_discr = CELL_IDENT_BSS;
Philipp Maier783047e2017-03-29 11:35:50 +0200957
958 msg = msgb_alloc(1024, "output buffer");
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100959 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
Philipp Maier783047e2017-03-29 11:35:50 +0200960 OSMO_ASSERT(rc_enc == 3);
961
Stefan Sperling11a4d9d2018-02-15 18:28:04 +0100962 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
Philipp Maier783047e2017-03-29 11:35:50 +0200963 OSMO_ASSERT(rc_dec == 1);
964
965 OSMO_ASSERT(memcmp(&enc_cil, &dec_cil, sizeof(enc_cil)) == 0);
966
967 msgb_free(msg);
968}
969
Stefan Sperling23381452018-03-15 19:38:15 +0100970static void test_gsm0808_enc_dec_cell_id_list_multi_lai_and_lac()
971{
972 struct gsm0808_cell_id_list2 enc_cil;
973 struct gsm0808_cell_id_list2 dec_cil;
974 struct osmo_location_area_id id;
975 struct msgb *msg;
976 uint8_t cil_enc_expected[] = { GSM0808_IE_CELL_IDENTIFIER_LIST, 0x10, 0x04,
977 0x92, 0x61, 0x54, 0x23, 0x42,
978 0x92, 0x72, 0x54, 0x24, 0x43,
979 0x92, 0x83, 0x54, 0x25, 0x44
980 };
981 uint8_t rc_enc;
982 int rc_dec, i;
983
984 memset(&enc_cil, 0, sizeof(enc_cil));
985 enc_cil.id_discr = CELL_IDENT_LAI_AND_LAC;
986
987 id.plmn.mcc = 0x123;
988 osmo_mnc_from_str("456", &id.plmn.mnc, &id.plmn.mnc_3_digits);
989 id.lac = 0x2342;
990 memcpy(&enc_cil.id_list[0].lai_and_lac, &id, sizeof(id));
991
992 id.plmn.mcc = 0x124;
993 osmo_mnc_from_str("457", &id.plmn.mnc, &id.plmn.mnc_3_digits);
994 id.lac = 0x2443;
995 memcpy(&enc_cil.id_list[1].lai_and_lac, &id, sizeof(id));
996
997 id.plmn.mcc = 0x125;
998 osmo_mnc_from_str("458", &id.plmn.mnc, &id.plmn.mnc_3_digits);
999 id.lac = 0x2544;
1000 memcpy(&enc_cil.id_list[2].lai_and_lac, &id, sizeof(id));
1001
1002 enc_cil.id_list_len = 3;
1003
1004 msg = msgb_alloc(1024, "output buffer");
1005 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
1006 OSMO_ASSERT(rc_enc == sizeof(cil_enc_expected));
1007 OSMO_ASSERT(memcmp(cil_enc_expected, msg->data, msg->len) == 0);
1008
1009 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
1010 OSMO_ASSERT(rc_dec == msg->len - 2);
1011
1012 OSMO_ASSERT(dec_cil.id_list_len == 3);
1013 /* Check MAXLEN elements to ensure everything has been initialized. */
1014 for (i = 0; i < GSM0808_CELL_ID_LIST2_MAXLEN; i++) {
1015 struct osmo_location_area_id *enc_id;
1016 struct osmo_location_area_id *dec_id;
1017 enc_id = &enc_cil.id_list[i].lai_and_lac;
1018 dec_id = &dec_cil.id_list[i].lai_and_lac;
1019 OSMO_ASSERT(osmo_plmn_cmp(&enc_id->plmn, &dec_id->plmn) == 0);
1020 OSMO_ASSERT(enc_id->lac == dec_id->lac);
1021 }
1022
1023 msgb_free(msg);
1024}
1025
Stefan Sperling9c62fc62018-03-16 10:23:34 +01001026static void test_gsm0808_enc_dec_cell_id_list_multi_ci()
1027{
1028 struct gsm0808_cell_id_list2 enc_cil;
1029 struct gsm0808_cell_id_list2 dec_cil;
1030 struct msgb *msg;
1031 uint8_t cil_enc_expected[] = { GSM0808_IE_CELL_IDENTIFIER_LIST, 0x09, 0x02,
1032 0x00, 0x01,
1033 0x00, 0x02,
1034 0x00, 0x77,
1035 0x01, 0xff,
1036 };
1037 uint8_t rc_enc;
1038 int rc_dec;
1039
1040 memset(&enc_cil, 0, sizeof(enc_cil));
1041 enc_cil.id_discr = CELL_IDENT_CI;
1042 enc_cil.id_list[0].ci = 1;
1043 enc_cil.id_list[1].ci = 2;
1044 enc_cil.id_list[2].ci = 119;
1045 enc_cil.id_list[3].ci = 511;
1046 enc_cil.id_list_len = 4;
1047
1048 msg = msgb_alloc(1024, "output buffer");
1049 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
1050 OSMO_ASSERT(rc_enc == sizeof(cil_enc_expected));
1051 OSMO_ASSERT(memcmp(cil_enc_expected, msg->data, msg->len) == 0);
1052
1053 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
1054 OSMO_ASSERT(rc_dec == msg->len - 2);
1055 OSMO_ASSERT(memcmp(&enc_cil, &dec_cil, sizeof(enc_cil)) == 0);
1056
1057 msgb_free(msg);
1058}
1059
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001060static void test_gsm0808_enc_dec_cell_id_list_multi_lac_and_ci()
1061{
1062 struct gsm0808_cell_id_list2 enc_cil;
1063 struct gsm0808_cell_id_list2 dec_cil;
1064 struct msgb *msg;
1065 uint8_t cil_enc_expected[] = { GSM0808_IE_CELL_IDENTIFIER_LIST, 0x15, 0x01,
1066 0x23, 0x42, 0x00, 0x01,
1067 0x24, 0x43, 0x00, 0x02,
1068 0x25, 0x44, 0x00, 0x77,
1069 0x26, 0x45, 0x01, 0xff,
1070 0x27, 0x46, 0x02, 0xfe,
1071 };
1072 uint8_t rc_enc;
1073 int rc_dec;
1074
1075 memset(&enc_cil, 0, sizeof(enc_cil));
1076 enc_cil.id_discr = CELL_IDENT_LAC_AND_CI;
1077 enc_cil.id_list[0].lac_and_ci.lac = 0x2342;
1078 enc_cil.id_list[0].lac_and_ci.ci = 1;
1079 enc_cil.id_list[1].lac_and_ci.lac = 0x2443;
1080 enc_cil.id_list[1].lac_and_ci.ci = 2;
1081 enc_cil.id_list[2].lac_and_ci.lac = 0x2544;
1082 enc_cil.id_list[2].lac_and_ci.ci = 119;
1083 enc_cil.id_list[3].lac_and_ci.lac = 0x2645;
1084 enc_cil.id_list[3].lac_and_ci.ci = 511;
1085 enc_cil.id_list[4].lac_and_ci.lac = 0x2746;
1086 enc_cil.id_list[4].lac_and_ci.ci = 766;
1087 enc_cil.id_list_len = 5;
1088
1089 msg = msgb_alloc(1024, "output buffer");
1090 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
1091 OSMO_ASSERT(rc_enc == sizeof(cil_enc_expected));
1092 OSMO_ASSERT(memcmp(cil_enc_expected, msg->data, msg->len) == 0);
1093
1094 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
1095 OSMO_ASSERT(rc_dec == msg->len - 2);
1096 OSMO_ASSERT(memcmp(&enc_cil, &dec_cil, sizeof(enc_cil)) == 0);
1097
1098 msgb_free(msg);
1099}
1100
Stefan Sperling483f3862018-03-16 12:21:26 +01001101static void test_gsm0808_enc_dec_cell_id_list_multi_global()
1102{
1103 struct gsm0808_cell_id_list2 enc_cil;
1104 struct gsm0808_cell_id_list2 dec_cil;
1105 struct msgb *msg;
1106 uint8_t cil_enc_expected[] = { GSM0808_IE_CELL_IDENTIFIER_LIST, 0x16, 0x00,
Neels Hofmeyr473485c2018-03-23 02:04:18 +01001107 0x21, 0x63, 0x54, 0x23, 0x42, 0x00, 0x1,
Neels Hofmeyrc44fc232018-03-23 02:15:12 +01001108 0x21, 0xf4, 0x75, 0x24, 0x43, 0x00, 0x2,
Neels Hofmeyr8b8cd932018-03-23 01:47:37 +01001109 0x21, 0x75, 0x00, 0x25, 0x44, 0x00, 0x77
Stefan Sperling483f3862018-03-16 12:21:26 +01001110 };
Stefan Sperling483f3862018-03-16 12:21:26 +01001111 uint8_t rc_enc;
1112 int rc_dec, i;
1113
Neels Hofmeyrc1991df2018-03-23 02:00:00 +01001114 enc_cil = (struct gsm0808_cell_id_list2){
1115 .id_discr = CELL_IDENT_WHOLE_GLOBAL,
1116 .id_list_len = 3,
1117 .id_list = {
1118 {
1119 .global = {
Neels Hofmeyr473485c2018-03-23 02:04:18 +01001120 .lai = { .plmn = { .mcc = 123, .mnc = 456 },
Neels Hofmeyrc1991df2018-03-23 02:00:00 +01001121 .lac = 0x2342 },
1122 .cell_identity = 1,
1123 }
1124 },
1125 {
1126 .global = {
Neels Hofmeyrc44fc232018-03-23 02:15:12 +01001127 .lai = { .plmn = { .mcc = 124, .mnc = 57 },
Neels Hofmeyrc1991df2018-03-23 02:00:00 +01001128 .lac = 0x2443 },
1129 .cell_identity = 2,
1130 }
1131 },
1132 {
1133 .global = {
Neels Hofmeyrc44fc232018-03-23 02:15:12 +01001134 .lai = { .plmn = { .mcc = 125, .mnc = 7,
1135 .mnc_3_digits = true },
Neels Hofmeyrc1991df2018-03-23 02:00:00 +01001136 .lac = 0x2544 },
1137 .cell_identity = 119,
1138 }
1139 },
1140 }
1141 };
Stefan Sperling483f3862018-03-16 12:21:26 +01001142
1143 msg = msgb_alloc(1024, "output buffer");
1144 rc_enc = gsm0808_enc_cell_id_list2(msg, &enc_cil);
1145 OSMO_ASSERT(rc_enc == sizeof(cil_enc_expected));
Neels Hofmeyrc1991df2018-03-23 02:00:00 +01001146 if (memcmp(cil_enc_expected, msg->data, msg->len)) {
1147 printf(" got: %s\n", osmo_hexdump(msg->data, msg->len));
1148 printf("expect: %s\n", osmo_hexdump(cil_enc_expected, sizeof(cil_enc_expected)));
1149 OSMO_ASSERT(false);
1150 }
Stefan Sperling483f3862018-03-16 12:21:26 +01001151
1152 rc_dec = gsm0808_dec_cell_id_list2(&dec_cil, msg->data + 2, msg->len - 2);
1153 OSMO_ASSERT(rc_dec == msg->len - 2);
1154
1155 /* Check MAXLEN elements to ensure everything has been initialized. */
1156 for (i = 0; i < GSM0808_CELL_ID_LIST2_MAXLEN; i++) {
1157 struct osmo_cell_global_id *enc_id;
1158 struct osmo_cell_global_id *dec_id;
1159 enc_id = &enc_cil.id_list[i].global;
1160 dec_id = &dec_cil.id_list[i].global;
1161 OSMO_ASSERT(osmo_plmn_cmp(&enc_id->lai.plmn, &dec_id->lai.plmn) == 0);
1162 OSMO_ASSERT(enc_id->lai.lac == dec_id->lai.lac);
1163 OSMO_ASSERT(enc_id->cell_identity == dec_id->cell_identity);
1164 }
1165
1166 msgb_free(msg);
1167}
1168
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001169static void print_cil(const struct gsm0808_cell_id_list2 *cil)
1170{
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001171 printf(" cell_id_list == %s\n", gsm0808_cell_id_list_name(cil));
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001172}
1173
1174void test_cell_id_list_add() {
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001175 size_t zu;
1176
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001177 const struct gsm0808_cell_id_list2 cgi1 = {
1178 .id_discr = CELL_IDENT_WHOLE_GLOBAL,
1179 .id_list_len = 1,
1180 .id_list = {
1181 {
1182 .global = {
1183 .lai = {
1184 .plmn = { .mcc = 1, .mnc = 2, .mnc_3_digits = false },
1185 .lac = 3,
1186 },
1187 .cell_identity = 4,
1188 }
1189 },
1190 },
1191 };
1192
1193 const struct gsm0808_cell_id_list2 cgi2 = {
1194 .id_discr = CELL_IDENT_WHOLE_GLOBAL,
1195 .id_list_len = 2,
1196 .id_list = {
1197 {
1198 .global = {
1199 .lai = {
1200 .plmn = { .mcc = 1, .mnc = 2, .mnc_3_digits = true },
1201 .lac = 3,
1202 },
1203 .cell_identity = 4,
1204 }
1205 },
1206 {
1207 .global = {
1208 .lai = {
1209 .plmn = { .mcc = 5, .mnc = 6, .mnc_3_digits = true },
1210 .lac = 7,
1211 },
1212 .cell_identity = 8,
1213 }
1214 },
1215 },
1216 };
1217
1218 const struct gsm0808_cell_id_list2 cgi2a = {
1219 .id_discr = CELL_IDENT_WHOLE_GLOBAL,
1220 .id_list_len = 2,
1221 .id_list = {
1222 {
1223 .global = cgi2.id_list[0].global
1224 },
1225 {
1226 .global = {
1227 .lai = {
1228 .plmn = { .mcc = 9, .mnc = 10, .mnc_3_digits = true },
1229 .lac = 11,
1230 },
1231 .cell_identity = 12,
1232 }
1233 },
1234 },
1235 };
1236
1237 const struct gsm0808_cell_id_list2 cgi3 = {
1238 .id_discr = CELL_IDENT_WHOLE_GLOBAL,
1239 .id_list_len = 2,
1240 .id_list = {
1241 {
1242 .global = {
1243 .lai = {
1244 .plmn = { .mcc = 13, .mnc = 14, .mnc_3_digits = true },
1245 .lac = 15,
1246 },
1247 .cell_identity = 16,
1248 }
1249 },
1250 {
1251 .global = {
1252 .lai = {
1253 .plmn = { .mcc = 16, .mnc = 17, .mnc_3_digits = true },
1254 .lac = 18,
1255 },
1256 .cell_identity = 19,
1257 }
1258 },
1259 },
1260 };
1261
1262
1263 const struct gsm0808_cell_id_list2 lac1 = {
1264 .id_discr = CELL_IDENT_LAC,
1265 .id_list_len = 1,
1266 .id_list = {
1267 {
1268 .lac = 123
1269 },
1270 },
1271 };
1272
1273 const struct gsm0808_cell_id_list2 lac2 = {
1274 .id_discr = CELL_IDENT_LAC,
1275 .id_list_len = 2,
1276 .id_list = {
1277 {
1278 .lac = 456
1279 },
1280 {
1281 .lac = 789
1282 },
1283 },
1284 };
1285
1286 struct gsm0808_cell_id_list2 cil = {};
1287
1288 printf("------- %s\n", __func__);
1289
1290 print_cil(&cil);
1291
1292#define ADD_QUIET(other_cil, expect_rc) do { \
1293 int rc = gsm0808_cell_id_list_add(&cil, &other_cil); \
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001294 printf("gsm0808_cell_id_list_add(&cil, &" #other_cil ") --> rc = %d\n", rc); \
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001295 OSMO_ASSERT(rc == expect_rc); \
1296 } while(0)
1297
1298#define ADD(other_cil, expect_rc) ADD_QUIET(other_cil, expect_rc); print_cil(&cil)
1299
1300 ADD(lac1, 1);
1301 ADD(lac1, 0);
1302 ADD(lac2, 2);
1303 ADD(lac2, 0);
1304 ADD(cil, 0);
1305 ADD(cgi1, -EINVAL);
1306
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001307 printf("* can't add to BSS list\n");
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001308 cil.id_list_len = 0;
1309 cil.id_discr = CELL_IDENT_BSS;
1310 print_cil(&cil);
1311 ADD(lac1, -EINVAL);
1312
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001313 printf("* other types (including NO_CELL) take on new type iff empty\n");
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001314 cil.id_list_len = 0;
1315 cil.id_discr = CELL_IDENT_NO_CELL;
1316 print_cil(&cil);
1317 ADD(cgi1, 1);
1318 ADD(cgi1, 0);
1319 ADD(cgi2, 2);
1320 ADD(cgi2, 0);
1321
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001322 printf("* test gsm0808_cell_id_list_name_buf()'s return val\n");
1323 zu = strlen(gsm0808_cell_id_list_name(&cil));
1324 printf(" strlen(gsm0808_cell_id_list_name(cil)) == %zu\n", zu);
1325 zu ++;
1326 while (1) {
1327 char buf[128] = "?";
1328 int rc;
1329 OSMO_ASSERT(zu < sizeof(buf));
1330 buf[zu] = '#';
1331 rc = gsm0808_cell_id_list_name_buf(buf, zu, &cil);
1332 printf(" gsm0808_cell_id_list_name_buf(buf, %zu, cil)) == %d \"%s\"\n",
1333 zu, rc, buf);
1334 OSMO_ASSERT(buf[zu] == '#');
1335 if (!zu)
1336 break;
1337 zu /= 2;
1338 }
1339
1340 printf("* list-full behavior\n");
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001341 cil.id_list_len = GSM0808_CELL_ID_LIST2_MAXLEN - 1;
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001342 printf("cil.id_list_len = %u\n", cil.id_list_len);
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001343 ADD_QUIET(cgi2a, 1);
1344 printf("cil.id_list_len = %u\n", cil.id_list_len);
1345
1346 cil.id_list_len = GSM0808_CELL_ID_LIST2_MAXLEN - 1;
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001347 printf("cil.id_list_len = %u\n", cil.id_list_len);
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001348 ADD_QUIET(cgi3, -ENOSPC);
Neels Hofmeyra4399c82018-04-17 02:26:10 +02001349 printf("cil.id_list_len = %u\n", cil.id_list_len);
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001350 ADD_QUIET(cgi2a, -ENOSPC);
1351 printf("cil.id_list_len = %u\n", cil.id_list_len);
1352
1353 printf("------- %s done\n", __func__);
1354}
1355
Neels Hofmeyr250e7f72018-04-13 03:30:14 +02001356static void test_gsm0808_enc_dec_cell_id_lac()
1357{
1358 struct gsm0808_cell_id enc_ci = {
1359 .id_discr = CELL_IDENT_LAC,
1360 .id.lac = 0x0124,
1361 };
1362 struct gsm0808_cell_id dec_ci;
1363 struct msgb *msg;
1364 uint8_t rc_enc;
1365 int rc_dec;
1366
1367 memset(&dec_ci, 0xa5, sizeof(dec_ci));
1368
1369 msg = msgb_alloc(1024, "output buffer");
1370 rc_enc = gsm0808_enc_cell_id(msg, &enc_ci);
1371 EXPECT_ENCODED("05 03 05 01 24");
1372
1373 rc_dec = gsm0808_dec_cell_id(&dec_ci, msg->data + 2, msg->len - 2);
1374 OSMO_ASSERT(rc_dec == 3);
1375
1376 OSMO_ASSERT(enc_ci.id_discr == dec_ci.id_discr
1377 && enc_ci.id.lac == dec_ci.id.lac);
1378
1379 msgb_free(msg);
1380}
1381
1382static void test_gsm0808_enc_dec_cell_id_bss()
1383{
1384 struct gsm0808_cell_id enc_ci = {
1385 .id_discr = CELL_IDENT_BSS,
1386 };
1387 struct gsm0808_cell_id dec_ci;
1388 struct msgb *msg;
1389 uint8_t rc_enc;
1390 int rc_dec;
1391
1392 msg = msgb_alloc(1024, "output buffer");
1393 rc_enc = gsm0808_enc_cell_id(msg, &enc_ci);
1394 EXPECT_ENCODED("05 01 06");
1395
1396 rc_dec = gsm0808_dec_cell_id(&dec_ci, msg->data + 2, msg->len - 2);
1397 OSMO_ASSERT(rc_dec == 1);
1398
1399 OSMO_ASSERT(enc_ci.id_discr == dec_ci.id_discr);
1400
1401 msgb_free(msg);
1402}
1403
1404static void test_gsm0808_enc_dec_cell_id_no_cell()
1405{
1406 struct gsm0808_cell_id enc_ci = {
1407 .id_discr = CELL_IDENT_NO_CELL,
1408 };
1409 struct gsm0808_cell_id dec_ci;
1410 struct msgb *msg;
1411 uint8_t rc_enc;
1412 int rc_dec;
1413
1414 msg = msgb_alloc(1024, "output buffer");
1415 rc_enc = gsm0808_enc_cell_id(msg, &enc_ci);
1416 EXPECT_ENCODED("05 01 03");
1417
1418 rc_dec = gsm0808_dec_cell_id(&dec_ci, msg->data + 2, msg->len - 2);
1419 OSMO_ASSERT(rc_dec == 1);
1420
1421 OSMO_ASSERT(enc_ci.id_discr == dec_ci.id_discr);
1422
1423 msgb_free(msg);
1424}
1425
1426static void test_gsm0808_enc_dec_cell_id_lai_and_lac()
1427{
1428 struct gsm0808_cell_id enc_ci = {
1429 .id_discr = CELL_IDENT_LAI_AND_LAC,
1430 .id.lai_and_lac = {
1431 .plmn = {
1432 .mcc = 123,
1433 .mnc = 456,
1434 },
1435 .lac = 0x2342,
1436 },
1437 };
1438 struct gsm0808_cell_id dec_ci;
1439 struct msgb *msg;
1440 uint8_t rc_enc;
1441 int rc_dec;
1442
1443 msg = msgb_alloc(1024, "output buffer");
1444 rc_enc = gsm0808_enc_cell_id(msg, &enc_ci);
1445 EXPECT_ENCODED("05 06 04 21 63 54 23 42");
1446
1447 memset(&dec_ci, 0xa5, sizeof(dec_ci));
1448 rc_dec = gsm0808_dec_cell_id(&dec_ci, msg->data + 2, msg->len - 2);
1449 OSMO_ASSERT(rc_dec == msg->len - 2);
1450
1451 OSMO_ASSERT(enc_ci.id_discr == dec_ci.id_discr
1452 && osmo_plmn_cmp(&enc_ci.id.lai_and_lac.plmn, &dec_ci.id.lai_and_lac.plmn) == 0
1453 && enc_ci.id.lai_and_lac.lac == dec_ci.id.lai_and_lac.lac);
1454 msgb_free(msg);
1455}
1456
1457static void test_gsm0808_enc_dec_cell_id_ci()
1458{
1459 struct gsm0808_cell_id enc_ci = {
1460 .id_discr = CELL_IDENT_CI,
1461 .id.ci = 0x423,
1462 };
1463 struct gsm0808_cell_id dec_ci;
1464 struct msgb *msg;
1465 uint8_t rc_enc;
1466 int rc_dec;
1467
1468 msg = msgb_alloc(1024, "output buffer");
1469 rc_enc = gsm0808_enc_cell_id(msg, &enc_ci);
1470 EXPECT_ENCODED("05 03 02 04 23");
1471
1472 rc_dec = gsm0808_dec_cell_id(&dec_ci, msg->data + 2, msg->len - 2);
1473 OSMO_ASSERT(rc_dec == msg->len - 2);
1474 OSMO_ASSERT(enc_ci.id_discr == dec_ci.id_discr
1475 && enc_ci.id.ci == dec_ci.id.ci);
1476
1477 msgb_free(msg);
1478}
1479
1480static void test_gsm0808_enc_dec_cell_id_lac_and_ci()
1481{
1482 struct gsm0808_cell_id enc_ci = {
1483 .id_discr = CELL_IDENT_LAC_AND_CI,
1484 .id.lac_and_ci = {
1485 .lac = 0x423,
1486 .ci = 0x235,
1487 },
1488 };
1489 struct gsm0808_cell_id dec_ci;
1490 struct msgb *msg;
1491 uint8_t rc_enc;
1492 int rc_dec;
1493
1494 msg = msgb_alloc(1024, "output buffer");
1495 rc_enc = gsm0808_enc_cell_id(msg, &enc_ci);
1496 EXPECT_ENCODED("05 05 01 04 23 02 35");
1497
1498 rc_dec = gsm0808_dec_cell_id(&dec_ci, msg->data + 2, msg->len - 2);
1499 OSMO_ASSERT(rc_dec == msg->len - 2);
1500 OSMO_ASSERT(enc_ci.id_discr == dec_ci.id_discr
1501 && enc_ci.id.lac_and_ci.lac == dec_ci.id.lac_and_ci.lac
1502 && enc_ci.id.lac_and_ci.ci == dec_ci.id.lac_and_ci.ci);
1503
1504 msgb_free(msg);
1505}
1506
1507static void test_gsm0808_enc_dec_cell_id_global()
1508{
1509 struct gsm0808_cell_id enc_ci = {
1510 .id_discr = CELL_IDENT_WHOLE_GLOBAL,
1511 .id.global = {
1512 .lai = {
1513 .plmn = { .mcc = 123, .mnc = 456 },
1514 .lac = 0x2342
1515 },
1516 .cell_identity = 0x423,
1517 }
1518 };
1519 struct gsm0808_cell_id dec_ci;
1520 struct msgb *msg;
1521 uint8_t rc_enc;
1522 int rc_dec;
1523
1524 msg = msgb_alloc(1024, "output buffer");
1525 rc_enc = gsm0808_enc_cell_id(msg, &enc_ci);
1526 EXPECT_ENCODED("05 08 00 21 63 54 23 42 04 23");
1527
1528 rc_dec = gsm0808_dec_cell_id(&dec_ci, msg->data + 2, msg->len - 2);
1529 OSMO_ASSERT(rc_dec == msg->len - 2);
1530
1531 OSMO_ASSERT(enc_ci.id_discr == dec_ci.id_discr
1532 && osmo_plmn_cmp(&enc_ci.id.global.lai.plmn,
1533 &dec_ci.id.global.lai.plmn) == 0
1534 && enc_ci.id.global.lai.lac == dec_ci.id.global.lai.lac
1535 && enc_ci.id.global.cell_identity == dec_ci.id.global.cell_identity);
1536 msgb_free(msg);
1537}
1538
Philipp Maier5f2eb152018-09-19 13:40:21 +02001539static void test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(struct gsm48_multi_rate_conf *cfg)
1540{
1541 uint16_t s15_s0;
1542
1543 printf("Input:\n");
1544 printf(" m4_75= %u smod= %u\n", cfg->m4_75, cfg->smod);
1545 printf(" m5_15= %u spare= %u\n", cfg->m5_15, cfg->spare);
1546 printf(" m5_90= %u icmi= %u\n", cfg->m5_90, cfg->icmi);
1547 printf(" m6_70= %u nscb= %u\n", cfg->m6_70, cfg->nscb);
1548 printf(" m7_40= %u ver= %u\n", cfg->m7_40, cfg->ver);
1549 printf(" m7_95= %u\n", cfg->m7_95);
1550 printf(" m10_2= %u\n", cfg->m10_2);
1551 printf(" m12_2= %u\n", cfg->m12_2);
1552
1553 s15_s0 = gsm0808_sc_cfg_from_gsm48_mr_cfg(cfg, true);
1554 printf("Result (fr):\n");
1555 printf(" S15-S0 = %04x = 0b" OSMO_BIN_SPEC OSMO_BIN_SPEC "\n", s15_s0,
1556 OSMO_BIN_PRINT(s15_s0 >> 8), OSMO_BIN_PRINT(s15_s0));
1557
1558 s15_s0 = gsm0808_sc_cfg_from_gsm48_mr_cfg(cfg, false);
1559 printf("Result (hr):\n");
1560 printf(" S15-S0 = %04x = 0b" OSMO_BIN_SPEC OSMO_BIN_SPEC "\n", s15_s0,
1561 OSMO_BIN_PRINT(s15_s0 >> 8), OSMO_BIN_PRINT(s15_s0));
1562
1563 printf("\n");
1564}
1565
1566static void test_gsm0808_sc_cfg_from_gsm48_mr_cfg(void)
1567{
1568 struct gsm48_multi_rate_conf cfg;
1569
1570 printf("Testing gsm0808_sc_cfg_from_gsm48_mr_cfg():\n");
1571
1572 memset(&cfg, 0, sizeof(cfg));
1573
1574 cfg.m4_75 = 0;
1575 cfg.m5_15 = 0;
1576 cfg.m5_90 = 0;
1577 cfg.m6_70 = 0;
1578 cfg.m7_40 = 0;
1579 cfg.m7_95 = 0;
1580 cfg.m10_2 = 0;
1581 cfg.m12_2 = 0;
1582 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1583
1584 cfg.m4_75 = 1;
1585 cfg.m5_15 = 0;
1586 cfg.m5_90 = 0;
1587 cfg.m6_70 = 0;
1588 cfg.m7_40 = 0;
1589 cfg.m7_95 = 0;
1590 cfg.m10_2 = 0;
1591 cfg.m12_2 = 0;
1592 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1593
1594 cfg.m4_75 = 0;
1595 cfg.m5_15 = 1;
1596 cfg.m5_90 = 0;
1597 cfg.m6_70 = 0;
1598 cfg.m7_40 = 0;
1599 cfg.m7_95 = 0;
1600 cfg.m10_2 = 0;
1601 cfg.m12_2 = 0;
1602 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1603
1604 cfg.m4_75 = 0;
1605 cfg.m5_15 = 0;
1606 cfg.m5_90 = 1;
1607 cfg.m6_70 = 0;
1608 cfg.m7_40 = 0;
1609 cfg.m7_95 = 0;
1610 cfg.m10_2 = 0;
1611 cfg.m12_2 = 0;
1612 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1613
1614 cfg.m4_75 = 0;
1615 cfg.m5_15 = 0;
1616 cfg.m5_90 = 0;
1617 cfg.m6_70 = 1;
1618 cfg.m7_40 = 0;
1619 cfg.m7_95 = 0;
1620 cfg.m10_2 = 0;
1621 cfg.m12_2 = 0;
1622 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1623
1624 cfg.m4_75 = 0;
1625 cfg.m5_15 = 0;
1626 cfg.m5_90 = 0;
1627 cfg.m6_70 = 0;
1628 cfg.m7_40 = 1;
1629 cfg.m7_95 = 0;
1630 cfg.m10_2 = 0;
1631 cfg.m12_2 = 0;
1632 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1633
1634 cfg.m4_75 = 0;
1635 cfg.m5_15 = 0;
1636 cfg.m5_90 = 0;
1637 cfg.m6_70 = 0;
1638 cfg.m7_40 = 0;
1639 cfg.m7_95 = 1;
1640 cfg.m10_2 = 0;
1641 cfg.m12_2 = 0;
1642 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1643
1644 cfg.m4_75 = 0;
1645 cfg.m5_15 = 0;
1646 cfg.m5_90 = 0;
1647 cfg.m6_70 = 0;
1648 cfg.m7_40 = 0;
1649 cfg.m7_95 = 0;
1650 cfg.m10_2 = 1;
1651 cfg.m12_2 = 0;
1652 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1653
1654 cfg.m4_75 = 0;
1655 cfg.m5_15 = 0;
1656 cfg.m5_90 = 0;
1657 cfg.m6_70 = 0;
1658 cfg.m7_40 = 0;
1659 cfg.m7_95 = 0;
1660 cfg.m10_2 = 0;
1661 cfg.m12_2 = 1;
1662 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1663
1664 cfg.m4_75 = 1;
1665 cfg.m5_15 = 1;
1666 cfg.m5_90 = 1;
1667 cfg.m6_70 = 1;
1668 cfg.m7_40 = 0;
1669 cfg.m7_95 = 0;
1670 cfg.m10_2 = 0;
1671 cfg.m12_2 = 0;
1672 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1673
1674 cfg.m4_75 = 0;
1675 cfg.m5_15 = 0;
1676 cfg.m5_90 = 0;
1677 cfg.m6_70 = 0;
1678 cfg.m7_40 = 1;
1679 cfg.m7_95 = 1;
1680 cfg.m10_2 = 1;
1681 cfg.m12_2 = 1;
1682 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1683
1684 cfg.m4_75 = 0;
1685 cfg.m5_15 = 0;
1686 cfg.m5_90 = 1;
1687 cfg.m6_70 = 1;
1688 cfg.m7_40 = 0;
1689 cfg.m7_95 = 0;
1690 cfg.m10_2 = 1;
1691 cfg.m12_2 = 1;
1692 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1693
1694 cfg.m4_75 = 1;
1695 cfg.m5_15 = 1;
1696 cfg.m5_90 = 0;
1697 cfg.m6_70 = 0;
1698 cfg.m7_40 = 1;
1699 cfg.m7_95 = 1;
1700 cfg.m10_2 = 0;
1701 cfg.m12_2 = 0;
1702 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1703
1704 cfg.m4_75 = 0;
1705 cfg.m5_15 = 1;
1706 cfg.m5_90 = 0;
1707 cfg.m6_70 = 1;
1708 cfg.m7_40 = 0;
1709 cfg.m7_95 = 1;
1710 cfg.m10_2 = 0;
1711 cfg.m12_2 = 1;
1712 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1713
1714 cfg.m4_75 = 1;
1715 cfg.m5_15 = 0;
1716 cfg.m5_90 = 1;
1717 cfg.m6_70 = 0;
1718 cfg.m7_40 = 1;
1719 cfg.m7_95 = 0;
1720 cfg.m10_2 = 1;
1721 cfg.m12_2 = 0;
1722 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1723
1724 cfg.m4_75 = 1;
1725 cfg.m5_15 = 1;
1726 cfg.m5_90 = 1;
1727 cfg.m6_70 = 1;
1728 cfg.m7_40 = 1;
1729 cfg.m7_95 = 1;
1730 cfg.m10_2 = 1;
1731 cfg.m12_2 = 1;
1732 test_gsm0808_sc_cfg_from_gsm48_mr_cfg_single(&cfg);
1733}
1734
Philipp Maier8515d032018-09-25 15:57:49 +02001735static void test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single(uint16_t s15_s0)
1736{
1737 struct gsm48_multi_rate_conf cfg;
1738
1739 printf("Input:\n");
1740 printf(" S15-S0 = %04x = 0b" OSMO_BIN_SPEC OSMO_BIN_SPEC "\n", s15_s0,
1741 OSMO_BIN_PRINT(s15_s0 >> 8), OSMO_BIN_PRINT(s15_s0));
1742
1743 gsm48_mr_cfg_from_gsm0808_sc_cfg(&cfg, s15_s0);
1744
1745 printf("Output:\n");
1746 printf(" m4_75= %u smod= %u\n", cfg.m4_75, cfg.smod);
1747 printf(" m5_15= %u spare= %u\n", cfg.m5_15, cfg.spare);
1748 printf(" m5_90= %u icmi= %u\n", cfg.m5_90, cfg.icmi);
1749 printf(" m6_70= %u nscb= %u\n", cfg.m6_70, cfg.nscb);
1750 printf(" m7_40= %u ver= %u\n", cfg.m7_40, cfg.ver);
1751 printf(" m7_95= %u\n", cfg.m7_95);
1752 printf(" m10_2= %u\n", cfg.m10_2);
1753 printf(" m12_2= %u\n", cfg.m12_2);
1754
1755 printf("\n");
1756}
1757
1758void test_gsm48_mr_cfg_from_gsm0808_sc_cfg()
1759{
1760 printf("Testing gsm48_mr_cfg_from_gsm0808_sc_cfg():\n");
1761
1762 /* Only one codec per setting */
1763 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1764 (GSM0808_SC_CFG_DEFAULT_AMR_4_75);
1765 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1766 (GSM0808_SC_CFG_DEFAULT_AMR_5_15);
1767 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1768 (GSM0808_SC_CFG_DEFAULT_AMR_5_90);
1769 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1770 (GSM0808_SC_CFG_DEFAULT_AMR_6_70);
1771 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1772 (GSM0808_SC_CFG_DEFAULT_AMR_7_40);
1773 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1774 (GSM0808_SC_CFG_DEFAULT_AMR_7_95);
1775 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1776 (GSM0808_SC_CFG_DEFAULT_AMR_10_2);
1777 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1778 (GSM0808_SC_CFG_DEFAULT_AMR_12_2);
1779
1780 /* Combinations */
1781 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1782 (GSM0808_SC_CFG_DEFAULT_AMR_4_75 | GSM0808_SC_CFG_DEFAULT_AMR_6_70 |
1783 GSM0808_SC_CFG_DEFAULT_AMR_10_2);
1784 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1785 (GSM0808_SC_CFG_DEFAULT_AMR_10_2 | GSM0808_SC_CFG_DEFAULT_AMR_12_2 |
1786 GSM0808_SC_CFG_DEFAULT_AMR_7_40);
1787 test_gsm48_mr_cfg_from_gsm0808_sc_cfg_single
1788 (GSM0808_SC_CFG_DEFAULT_AMR_7_95 | GSM0808_SC_CFG_DEFAULT_AMR_12_2);
1789}
1790
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001791int main(int argc, char **argv)
1792{
1793 printf("Testing generation of GSM0808 messages\n");
Philipp Maier4f4905f2018-11-30 13:36:12 +01001794 test_gsm0808_enc_cause();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001795 test_create_layer3();
Philipp Maierfa896ab2017-03-27 16:55:32 +02001796 test_create_layer3_aoip();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001797 test_create_reset();
Philipp Maier15596e22017-04-05 17:55:27 +02001798 test_create_reset_ack();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001799 test_create_clear_command();
1800 test_create_clear_complete();
Philipp Maierb478dd32017-03-29 15:50:05 +02001801 test_create_cipher();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001802 test_create_cipher_complete();
1803 test_create_cipher_reject();
Maxed651d22018-11-07 15:25:05 +01001804 test_create_cipher_reject_ext();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001805 test_create_cm_u();
1806 test_create_sapi_reject();
Philipp Maierc6144a22017-03-29 17:53:43 +02001807 test_create_ass();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001808 test_create_ass_compl();
Philipp Maierfa896ab2017-03-27 16:55:32 +02001809 test_create_ass_compl_aoip();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001810 test_create_ass_fail();
Philipp Maierfa896ab2017-03-27 16:55:32 +02001811 test_create_ass_fail_aoip();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001812 test_create_clear_rqst();
Philipp Maier3d48ec02017-03-29 17:37:55 +02001813 test_create_paging();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001814 test_create_dtap();
1815 test_prepend_dtap();
Philipp Maier22401432017-03-24 17:59:26 +01001816 test_enc_dec_aoip_trasp_addr_v4();
1817 test_enc_dec_aoip_trasp_addr_v6();
Philipp Maier6f725d62017-03-24 18:03:17 +01001818 test_gsm0808_enc_dec_speech_codec();
Philipp Maier6f725d62017-03-24 18:03:17 +01001819 test_gsm0808_enc_dec_speech_codec_ext_with_cfg();
Philipp Maierbb839662017-06-01 17:11:19 +02001820 test_gsm0808_enc_dec_speech_codec_with_cfg();
Philipp Maier6f725d62017-03-24 18:03:17 +01001821 test_gsm0808_enc_dec_speech_codec_list();
Philipp Maierf6c369f2018-10-16 15:24:47 +02001822 test_gsm0808_enc_dec_empty_speech_codec_list();
Philipp Maiere0c65302017-03-28 17:05:40 +02001823 test_gsm0808_enc_dec_channel_type();
Philipp Maier14e76b92017-03-28 18:36:52 +02001824 test_gsm0808_enc_dec_encrypt_info();
Neels Hofmeyr250e7f72018-04-13 03:30:14 +02001825
Philipp Maier783047e2017-03-29 11:35:50 +02001826 test_gsm0808_enc_dec_cell_id_list_lac();
1827 test_gsm0808_enc_dec_cell_id_list_single_lac();
Stefan Sperlinge1a86742018-03-15 18:05:02 +01001828 test_gsm0808_enc_dec_cell_id_list_multi_lac();
Philipp Maier783047e2017-03-29 11:35:50 +02001829 test_gsm0808_enc_dec_cell_id_list_bss();
Stefan Sperling23381452018-03-15 19:38:15 +01001830 test_gsm0808_enc_dec_cell_id_list_multi_lai_and_lac();
Stefan Sperling9c62fc62018-03-16 10:23:34 +01001831 test_gsm0808_enc_dec_cell_id_list_multi_ci();
Stefan Sperlinged4327c2018-03-16 11:02:59 +01001832 test_gsm0808_enc_dec_cell_id_list_multi_lac_and_ci();
Stefan Sperling483f3862018-03-16 12:21:26 +01001833 test_gsm0808_enc_dec_cell_id_list_multi_global();
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001834
Neels Hofmeyr74663d92018-03-23 01:46:42 +01001835 test_cell_id_list_add();
1836
Neels Hofmeyr250e7f72018-04-13 03:30:14 +02001837 test_gsm0808_enc_dec_cell_id_lac();
1838 test_gsm0808_enc_dec_cell_id_bss();
1839 test_gsm0808_enc_dec_cell_id_no_cell();
1840 test_gsm0808_enc_dec_cell_id_lai_and_lac();
1841 test_gsm0808_enc_dec_cell_id_ci();
1842 test_gsm0808_enc_dec_cell_id_lac_and_ci();
1843 test_gsm0808_enc_dec_cell_id_global();
1844
Philipp Maier5f2eb152018-09-19 13:40:21 +02001845 test_gsm0808_sc_cfg_from_gsm48_mr_cfg();
Philipp Maier8515d032018-09-25 15:57:49 +02001846 test_gsm48_mr_cfg_from_gsm0808_sc_cfg();
Philipp Maier5f2eb152018-09-19 13:40:21 +02001847
Holger Hans Peter Freyther97510812012-01-22 13:36:52 +01001848 printf("Done\n");
1849 return EXIT_SUCCESS;
1850}