blob: f2fccf878ea0796215a200bee6d5b0f3c1dabe28 [file] [log] [blame]
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +01001/*
2 * (C) 2011 by Holger Hans Peter Freyther
3 * (C) 2011 by On-Waves
Harald Weltee08da972017-11-13 01:00:26 +09004 * (C) 2014 by sysmocom - s.f.m.c. GmbH, Author: Daniel Willmann <dwillmann@sysmocom.de>
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +01005 * All Rights Reserved
6 *
Harald Weltee08da972017-11-13 01:00:26 +09007 * SPDX-License-Identifier: GPL-2.0+
8 *
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +01009 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
18 *
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010019 */
20
Holger Hans Peter Freytheraf723a42012-12-26 10:51:00 +010021#include <osmocom/core/application.h>
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010022#include <osmocom/core/logging.h>
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +000023#include <osmocom/core/utils.h>
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010024#include <osmocom/gsm/lapdm.h>
25#include <osmocom/gsm/rsl.h>
26
27#include <errno.h>
Neels Hofmeyra829b452018-04-05 03:02:35 +020028#include <talloc.h>
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010029
30#include <string.h>
31
32#define CHECK_RC(rc) \
33 if (rc != 0) { \
34 printf("Operation failed rc=%d on %s:%d\n", rc, __FILE__, __LINE__); \
35 abort(); \
36 }
37
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010038static struct log_info info = {};
Jacob Erlbeckc893c222014-01-28 10:53:59 +010039static int dummy_l1_header_len = 0;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010040
41struct lapdm_polling_state {
42 struct lapdm_channel *bts;
43 int bts_read;
44
45 struct lapdm_channel *ms;
46 int ms_read;
47};
48
49static struct msgb *msgb_from_array(const uint8_t *data, int len)
50{
51 struct msgb *msg = msgb_alloc_headroom(4096, 128, "data");
52 msg->l3h = msgb_put(msg, len);
Harald Welte53e26722017-01-04 11:18:59 +010053 if (data && len)
54 memcpy(msg->l3h, data, len);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010055 return msg;
56}
57
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +010058/*
59 * Test data is below...
60 */
61static const uint8_t cm[] = {
62 0x05, 0x24, 0x31, 0x03, 0x50, 0x18, 0x93, 0x08,
63 0x29, 0x47, 0x80, 0x00, 0x00, 0x00, 0x00, 0x80,
64};
65
Vadim Yanitskiy9ff1c1a2020-08-27 18:29:46 +070066static const uint8_t ua_cm[] = {
Andreas Eversberg6e182082013-02-06 14:13:21 +010067 0x01, 0x73, 0x41, 0x05, 0x24, 0x31, 0x03, 0x50,
68 0x18, 0x93, 0x08, 0x29, 0x47, 0x80, 0x00, 0x00,
69 0x00, 0x00, 0x80, 0x2b, 0x2b, 0x2b, 0x2b
70};
71
Vadim Yanitskiy488989d2020-08-27 19:35:02 +070072static const uint8_t pr[] = {
73 0x06, 0x27, 0x07, 0x03, 0x50, 0x58, 0x92, 0x05,
74 0xf4, 0x44, 0x59, 0xba, 0x63,
75};
76
77static const uint8_t ua_pr[] = {
78 0x01, 0x73, 0x35, 0x06, 0x27, 0x07, 0x03, 0x50,
79 0x58, 0x92, 0x05, 0xf4, 0x44, 0x59, 0xba, 0x63,
80 0x2b, 0x2b, 0x2b, 0x2b, 0x2b, 0x2b, 0x2b,
81};
82
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +010083static const uint8_t mm[] = {
Holger Hans Peter Freyther3a5f08c2012-01-12 23:12:28 +010084 0x00, 0x0c, 0x00, 0x03, 0x01, 0x01, 0x20, 0x02,
85 0x00, 0x0b, 0x00, 0x03, 0x05, 0x04, 0x0d
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +010086};
87
88static const uint8_t dummy1[] = {
89 0xab, 0x03, 0x30, 0x60, 0x06,
90};
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +010091
Daniel Willmanne5233922012-12-25 23:15:50 +010092static const uint8_t rel_req[] = {
93 0x02, 0x07, 0x01, 0x0a, 0x02, 0x40, 0x14, 0x01
94};
95
Jacob Erlbeck90937fe2014-01-24 13:48:19 +010096static const uint8_t est_req_sdcch_sapi3[] = {
97 0x02, 0x04, 0x01, 0x20, 0x02, 0x03
98};
99
100static const uint8_t est_req_sacch_sapi3[] = {
101 0x02, 0x04, 0x01, 0x0b, 0x02, 0x43
102};
103
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100104static struct msgb *create_cm_serv_req(void)
105{
106 struct msgb *msg;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100107
108 msg = msgb_from_array(cm, sizeof(cm));
109 rsl_rll_push_l3(msg, RSL_MT_EST_REQ, 0, 0, 1);
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100110 msgb_push(msg, dummy_l1_header_len);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100111 return msg;
112}
113
114static struct msgb *create_mm_id_req(void)
115{
116 struct msgb *msg;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100117
118 msg = msgb_from_array(mm, sizeof(mm));
Holger Hans Peter Freyther3a5f08c2012-01-12 23:12:28 +0100119 msg->l2h = msg->data + 3;
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000120 OSMO_ASSERT(msgb_l2len(msg) == 12);
Holger Hans Peter Freyther3a5f08c2012-01-12 23:12:28 +0100121 msg->l3h = msg->l2h + 6;
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000122 OSMO_ASSERT(msgb_l3len(msg) == 6);
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100123 msgb_push(msg, dummy_l1_header_len);
Holger Hans Peter Freyther3a5f08c2012-01-12 23:12:28 +0100124
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100125 return msg;
126}
127
Holger Hans Peter Freyther90656db2012-01-13 05:49:29 +0800128static struct msgb *create_empty_msg(void)
129{
130 struct msgb *msg;
131
132 msg = msgb_from_array(NULL, 0);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000133 OSMO_ASSERT(msgb_l3len(msg) == 0);
Holger Hans Peter Freyther90656db2012-01-13 05:49:29 +0800134 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, 0, 0, 1);
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100135 msgb_push(msg, dummy_l1_header_len);
Holger Hans Peter Freyther90656db2012-01-13 05:49:29 +0800136 return msg;
137}
138
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100139static struct msgb *create_dummy_data_req(void)
140{
141 struct msgb *msg;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100142
143 msg = msgb_from_array(dummy1, sizeof(dummy1));
144 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, 0, 0, 1);
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100145 msgb_push(msg, dummy_l1_header_len);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100146 return msg;
147}
148
Daniel Willmanne5233922012-12-25 23:15:50 +0100149static struct msgb *create_rel_req(void)
150{
151 struct msgb *msg;
152
153 msg = msgb_from_array(rel_req, sizeof(rel_req));
154 msg->l2h = msg->data;
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100155 msgb_push(msg, dummy_l1_header_len);
Daniel Willmanne5233922012-12-25 23:15:50 +0100156 msg->l3h = msg->l2h + sizeof(struct abis_rsl_rll_hdr);
157 return msg;
158}
159
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100160static struct msgb *create_est_req(const uint8_t *est_req, size_t est_req_size)
161{
162 struct msgb *msg;
163
164 msg = msgb_from_array(est_req, est_req_size);
165 msg->l2h = msg->data;
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100166 msgb_push(msg, dummy_l1_header_len);
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100167 msg->l3h = msg->l2h + sizeof(struct abis_rsl_rll_hdr);
168 return msg;
169}
170
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100171static int send(struct msgb *in_msg, struct lapdm_channel *chan)
172{
173 struct osmo_phsap_prim pp;
174 struct msgb *msg;
175 int rc;
176
177 msg = msgb_alloc_headroom(128, 64, "PH-DATA.ind");
178 osmo_prim_init(&pp.oph, SAP_GSM_PH, PRIM_PH_DATA,
179 PRIM_OP_INDICATION, msg);
180 /* copy over actual MAC block */
181 msg->l2h = msgb_put(msg, msgb_l2len(in_msg));
182 memcpy(msg->l2h, in_msg->l2h, msgb_l2len(in_msg));
183
184 /* LAPDm requires those... */
185 pp.u.data.chan_nr = 0;
186 pp.u.data.link_id = 0;
Pau Espin Pedrol1247aa12023-08-09 17:41:25 +0200187 pp.u.data.fn = 0;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100188 /* feed into the LAPDm code of libosmogsm */
189 rc = lapdm_phsap_up(&pp.oph, &chan->lapdm_dcch);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000190 OSMO_ASSERT(rc == 0 || rc == -EBUSY);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100191 return 0;
192}
193
Daniel Willmann09129352014-03-20 18:54:57 +0100194/* Receive from L1 */
195static int send_buf(const uint8_t *buf, size_t len, struct lapdm_channel *chan)
Andreas Eversberg6e182082013-02-06 14:13:21 +0100196{
197 struct osmo_phsap_prim pp;
198 struct msgb *msg;
199 int rc;
200
Daniel Willmann09129352014-03-20 18:54:57 +0100201 msg = msgb_from_array(buf, len);
202 msg->l2h = msg->l3h;
203 msg->l3h = NULL;
204 osmo_prim_init(&pp.oph, SAP_GSM_PH, PRIM_PH_DATA,
205 PRIM_OP_INDICATION, msg);
206
207 /* LAPDm requires those... */
208 pp.u.data.chan_nr = 0;
209 pp.u.data.link_id = 0;
Pau Espin Pedrol1247aa12023-08-09 17:41:25 +0200210 pp.u.data.fn = 0;
Daniel Willmann09129352014-03-20 18:54:57 +0100211 /* feed into the LAPDm code of libosmogsm */
212 rc = lapdm_phsap_up(&pp.oph, &chan->lapdm_dcch);
213 OSMO_ASSERT(rc == 0 || rc == -EBUSY);
214 return 0;
215}
216
217/* Receive from L3 */
218static int enqueue_buf(const uint8_t *buf, size_t len, int sapi, struct lapdm_channel *chan)
219{
220 struct osmo_dlsap_prim dp;
221 struct msgb *msg;
222 int rc;
223 struct lapdm_datalink *dl;
224
225 dl = lapdm_datalink_for_sapi(&chan->lapdm_dcch, sapi);
226 OSMO_ASSERT(dl);
227
228 msg = msgb_from_array(buf, len);
229 osmo_prim_init(&dp.oph, 0, PRIM_DL_DATA, PRIM_OP_REQUEST, msg);
230
231 rc = lapd_recv_dlsap(&dp, &dl->dl.lctx);
232 OSMO_ASSERT(rc == 0 || rc == -EBUSY);
233 return 0;
234}
235
236static int send_sabm(struct lapdm_channel *chan, int sapi, const uint8_t *data, size_t len)
237{
238 struct osmo_phsap_prim pp;
239 struct msgb *msg;
240 int rc;
241
242 OSMO_ASSERT(sapi == 0 || sapi == 3);
243
Andreas Eversberg6e182082013-02-06 14:13:21 +0100244 msg = msgb_alloc_headroom(128, 64, "PH-DATA.ind");
245 osmo_prim_init(&pp.oph, SAP_GSM_PH, PRIM_PH_DATA,
246 PRIM_OP_INDICATION, msg);
247 /* copy over actual MAC block */
Daniel Willmann09129352014-03-20 18:54:57 +0100248 msg->l2h = msgb_put(msg, 3 + len);
249 msg->l2h[0] = 0x01 | (sapi << 2);
Andreas Eversberg6e182082013-02-06 14:13:21 +0100250 msg->l2h[1] = 0x3f;
Daniel Willmann09129352014-03-20 18:54:57 +0100251 msg->l2h[2] = 0x01 | (len << 2);
252
253 if (len > 0)
254 memcpy(msg->l2h + 3, data, len);
Andreas Eversberg6e182082013-02-06 14:13:21 +0100255
256 /* LAPDm requires those... */
257 pp.u.data.chan_nr = 0;
258 pp.u.data.link_id = 0;
259 /* feed into the LAPDm code of libosmogsm */
260 rc = lapdm_phsap_up(&pp.oph, &chan->lapdm_dcch);
261 OSMO_ASSERT(rc == 0 || rc == -EBUSY);
262 return 0;
263}
264
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100265/*
266 * I get called from the LAPDm code when something was sent my way...
267 */
268static int bts_to_ms_tx_cb(struct msgb *in_msg, struct lapdm_entity *le, void *_ctx)
269{
270 struct lapdm_polling_state *state = _ctx;
271
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100272
273 printf("%s: MS->BTS(us) message %d\n", __func__, msgb_length(in_msg));
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +0100274
275
276 if (state->bts_read == 0) {
277 printf("BTS: Verifying CM request.\n");
Holger Hans Peter Freytherdd34ed52013-06-19 08:16:56 +0200278 OSMO_ASSERT(msgb_l3len(in_msg) == ARRAY_SIZE(cm));
279 OSMO_ASSERT(memcmp(in_msg->l3h, cm,
280 ARRAY_SIZE(cm)) == 0);
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +0100281 } else if (state->bts_read == 1) {
282 printf("BTS: Verifying dummy message.\n");
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000283 OSMO_ASSERT(msgb_l3len(in_msg) == ARRAY_SIZE(dummy1));
284 OSMO_ASSERT(memcmp(in_msg->l3h, dummy1,
285 ARRAY_SIZE(dummy1)) == 0);
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +0100286 } else {
287 printf("BTS: Do not know to verify: %d\n", state->bts_read);
288 }
289
290 state->bts_read += 1;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100291 msgb_free(in_msg);
292
293 return 0;
294}
295
296static int ms_to_bts_l1_cb(struct osmo_prim_hdr *oph, void *_ctx)
297{
298 int rc;
299 struct lapdm_polling_state *state = _ctx;
300 printf("%s: MS(us) -> BTS prim message\n", __func__);
301
302 /* i stuff it into the LAPDm channel of the BTS */
303 rc = send(oph->msg, state->bts);
304 msgb_free(oph->msg);
Holger Hans Peter Freytheraf723a42012-12-26 10:51:00 +0100305 return rc;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100306}
307
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100308static int dequeue_prim(struct lapdm_entity *le, struct osmo_phsap_prim *pp,
309 const char *queue_name)
310{
311 int rc;
312 int l2_header_len;
313 int l3_len = 0;
314
315 /* Take message from queue */
316 rc = lapdm_phsap_dequeue_prim(le, pp);
317
Vadim Yanitskiy45a90cf2020-08-27 19:29:26 +0700318 printf("lapdm_phsap_dequeue_prim(): got rc %d: %s\n",
319 rc, rc <= 0 ? strerror(-rc) : "-");
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100320
321 if (rc < 0)
322 return rc;
323
324 l2_header_len = msgb_l2len(pp->oph.msg);
325 if (msgb_l3(pp->oph.msg)) {
326 l3_len = msgb_l3len(pp->oph.msg);
327 l2_header_len -= l3_len;
328 } else
Vadim Yanitskiy45a90cf2020-08-27 19:29:26 +0700329 printf("MSGB: L3 is undefined\n");
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100330
331 if (l2_header_len < 0 || l2_header_len > pp->oph.msg->data_len) {
Vadim Yanitskiy45a90cf2020-08-27 19:29:26 +0700332 printf("MSGB inconsistent: data = %p, l2 = %p, l3 = %p, tail = %p\n",
333 pp->oph.msg->data,
334 pp->oph.msg->l2h,
335 pp->oph.msg->l3h,
336 pp->oph.msg->tail);
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100337 l2_header_len = -1;
338 }
339
340 printf("Took message from %s queue: "
341 "L2 header size %d, L3 size %d, "
342 "SAP %#x, %d/%d, Link 0x%02x\n",
343 queue_name,
344 l2_header_len, l3_len,
345 pp->oph.sap, pp->oph.primitive, pp->oph.operation,
346 pp->u.data.link_id);
347 printf("Message: %s\n", msgb_hexdump(pp->oph.msg));
348
349 return rc;
350}
351
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100352static int ms_to_bts_tx_cb(struct msgb *msg, struct lapdm_entity *le, void *_ctx)
353{
354 struct lapdm_polling_state *state = _ctx;
355
356 printf("%s: BTS->MS(us) message %d\n", __func__, msgb_length(msg));
357
358 if (state->ms_read == 0) {
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +0100359 struct abis_rsl_rll_hdr hdr;
360
361 printf("MS: Verifying incoming primitive.\n");
Pau Espin Pedrol06da40b2023-08-23 17:40:48 +0200362 OSMO_ASSERT(msg->len == sizeof(struct abis_rsl_rll_hdr));
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +0100363
364 /* verify the header */
365 memset(&hdr, 0, sizeof(hdr));
366 rsl_init_rll_hdr(&hdr, RSL_MT_EST_CONF);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000367 OSMO_ASSERT(memcmp(msg->data, &hdr, sizeof(hdr)) == 0);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100368 } else if (state->ms_read == 1) {
Holger Hans Peter Freyther3a5f08c2012-01-12 23:12:28 +0100369 printf("MS: Verifying incoming MM message: %d\n", msgb_l3len(msg));
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000370 OSMO_ASSERT(msgb_l3len(msg) == 3);
371 OSMO_ASSERT(memcmp(msg->l3h, &mm[12], msgb_l3len(msg)) == 0);
Holger Hans Peter Freyther15f740c2011-12-12 00:29:50 +0100372 } else {
373 printf("MS: Do not know to verify: %d\n", state->ms_read);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100374 }
375
376 state->ms_read += 1;
377 msgb_free(msg);
378 return 0;
379}
380
Harald Weltee61d4592022-11-03 11:05:58 +0100381static void test_lapdm_polling(void)
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100382{
383 printf("I do some very simple LAPDm test.\n");
384
385 int rc;
386 struct lapdm_polling_state test_state;
387 struct osmo_phsap_prim pp;
388
389 /* Configure LAPDm on both sides */
390 struct lapdm_channel bts_to_ms_channel;
391 struct lapdm_channel ms_to_bts_channel;
392 memset(&bts_to_ms_channel, 0, sizeof(bts_to_ms_channel));
393 memset(&ms_to_bts_channel, 0, sizeof(ms_to_bts_channel));
394
395 memset(&test_state, 0, sizeof(test_state));
396 test_state.bts = &bts_to_ms_channel;
397 test_state.ms = &ms_to_bts_channel;
398
399 /* BTS to MS in polling mode */
400 lapdm_channel_init(&bts_to_ms_channel, LAPDM_MODE_BTS);
401 lapdm_channel_set_flags(&bts_to_ms_channel, LAPDM_ENT_F_POLLING_ONLY);
402 lapdm_channel_set_l1(&bts_to_ms_channel, NULL, &test_state);
403 lapdm_channel_set_l3(&bts_to_ms_channel, bts_to_ms_tx_cb, &test_state);
404
405 /* MS to BTS in direct mode */
406 lapdm_channel_init(&ms_to_bts_channel, LAPDM_MODE_MS);
407 lapdm_channel_set_l1(&ms_to_bts_channel, ms_to_bts_l1_cb, &test_state);
408 lapdm_channel_set_l3(&ms_to_bts_channel, ms_to_bts_tx_cb, &test_state);
409
410 /*
411 * We try to send messages from the MS to the BTS to the MS..
412 */
413 /* 1. Start with MS -> BTS, BTS should have a pending message */
414 printf("Establishing link.\n");
415 lapdm_rslms_recvmsg(create_cm_serv_req(), &ms_to_bts_channel);
416
417 /* 2. Poll on the BTS for sending out a confirmation */
418 printf("\nConfirming\n");
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000419 OSMO_ASSERT(test_state.bts_read == 1);
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100420 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100421 CHECK_RC(rc);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000422 OSMO_ASSERT(pp.oph.msg->data == pp.oph.msg->l2h);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100423 send(pp.oph.msg, &ms_to_bts_channel);
424 msgb_free(pp.oph.msg);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000425 OSMO_ASSERT(test_state.ms_read == 1);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100426
427 /* 3. Send some data to the MS */
428 printf("\nSending back to MS\n");
429 lapdm_rslms_recvmsg(create_mm_id_req(), &bts_to_ms_channel);
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100430 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100431 CHECK_RC(rc);
432 send(pp.oph.msg, &ms_to_bts_channel);
433 msgb_free(pp.oph.msg);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000434 OSMO_ASSERT(test_state.ms_read == 2);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100435
436 /* verify that there is nothing more to poll */
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100437 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000438 OSMO_ASSERT(rc < 0);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100439
440 /* 3. And back to the BTS */
441 printf("\nSending back to BTS\n");
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000442 OSMO_ASSERT(test_state.ms_read == 2);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100443 lapdm_rslms_recvmsg(create_dummy_data_req(), &ms_to_bts_channel);
444
445
Holger Hans Peter Freyther3a5f08c2012-01-12 23:12:28 +0100446 /* 4. And back to the MS, but let's move data/l2h apart */
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000447 OSMO_ASSERT(test_state.bts_read == 2);
448 OSMO_ASSERT(test_state.ms_read == 2);
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100449 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100450 CHECK_RC(rc);
451 send(pp.oph.msg, &ms_to_bts_channel);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000452 OSMO_ASSERT(test_state.ms_read == 2);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100453 msgb_free(pp.oph.msg);
454
455 /* verify that there is nothing more to poll */
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100456 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000457 OSMO_ASSERT(rc < 0);
Jacob Erlbeck7d5f17a2014-02-28 15:54:03 +0100458 rc = dequeue_prim(&bts_to_ms_channel.lapdm_acch, &pp, "ACCH");
459 OSMO_ASSERT(rc < 0);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100460
Holger Hans Peter Freyther90656db2012-01-13 05:49:29 +0800461 /* check sending an empty L3 message fails */
462 rc = lapdm_rslms_recvmsg(create_empty_msg(), &bts_to_ms_channel);
Katerina Barone-Adesi008e53b2013-03-03 10:36:52 +0000463 OSMO_ASSERT(rc == -1);
464 OSMO_ASSERT(test_state.ms_read == 2);
Holger Hans Peter Freyther90656db2012-01-13 05:49:29 +0800465
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100466 /* clean up */
467 lapdm_channel_exit(&bts_to_ms_channel);
468 lapdm_channel_exit(&ms_to_bts_channel);
Holger Hans Peter Freytherce397de2013-10-26 13:35:15 +0200469
470 /* Check if exit is idempotent */
471 lapdm_channel_exit(&bts_to_ms_channel);
472 lapdm_channel_exit(&ms_to_bts_channel);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100473}
474
Harald Weltee61d4592022-11-03 11:05:58 +0100475static void test_lapdm_contention_resolution(void)
Andreas Eversberg6e182082013-02-06 14:13:21 +0100476{
477 printf("I test contention resultion by having two mobiles collide and "
478 "first mobile repeating SABM.\n");
479
480 int rc;
481 struct lapdm_polling_state test_state;
482 struct osmo_phsap_prim pp;
Daniel Willmann09129352014-03-20 18:54:57 +0100483 uint8_t *cm2;
Andreas Eversberg6e182082013-02-06 14:13:21 +0100484
485 /* Configure LAPDm on both sides */
486 struct lapdm_channel bts_to_ms_channel;
487 memset(&bts_to_ms_channel, 0, sizeof(bts_to_ms_channel));
488
489 memset(&test_state, 0, sizeof(test_state));
490 test_state.bts = &bts_to_ms_channel;
491
492 /* BTS to MS in polling mode */
493 lapdm_channel_init(&bts_to_ms_channel, LAPDM_MODE_BTS);
494 lapdm_channel_set_flags(&bts_to_ms_channel, LAPDM_ENT_F_POLLING_ONLY);
495 lapdm_channel_set_l1(&bts_to_ms_channel, NULL, &test_state);
496 lapdm_channel_set_l3(&bts_to_ms_channel, bts_to_ms_tx_cb, &test_state);
497
498 /* Send SABM MS 1, we must get UA */
Daniel Willmann09129352014-03-20 18:54:57 +0100499 send_sabm(&bts_to_ms_channel, 0, cm, sizeof(cm));
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100500 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Andreas Eversberg6e182082013-02-06 14:13:21 +0100501 CHECK_RC(rc);
Vadim Yanitskiy9ff1c1a2020-08-27 18:29:46 +0700502 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, ua_cm, ARRAY_SIZE(ua_cm)) == 0);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100503 msgb_free(pp.oph.msg);
Andreas Eversberg6e182082013-02-06 14:13:21 +0100504
505 /* Send SABM MS 2, we must get nothing, due to collision */
Daniel Willmann09129352014-03-20 18:54:57 +0100506 cm2 = malloc(sizeof(cm));
507 memcpy(cm2, cm, sizeof(cm));
508 cm2[0] += 1;
Vadim Yanitskiy7000a252023-12-11 21:54:30 +0700509 send_sabm(&bts_to_ms_channel, 0, cm2, sizeof(cm));
Daniel Willmann09129352014-03-20 18:54:57 +0100510 free(cm2);
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100511 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Andreas Eversberg6e182082013-02-06 14:13:21 +0100512 OSMO_ASSERT(rc == -ENODEV);
513
514 /* Send SABM MS 1 again, we must get UA gain */
Daniel Willmann09129352014-03-20 18:54:57 +0100515 send_sabm(&bts_to_ms_channel, 0, cm, sizeof(cm));
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100516 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Andreas Eversberg6e182082013-02-06 14:13:21 +0100517 CHECK_RC(rc);
Vadim Yanitskiy9ff1c1a2020-08-27 18:29:46 +0700518 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, ua_cm, ARRAY_SIZE(ua_cm)) == 0);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100519 msgb_free(pp.oph.msg);
Andreas Eversberg6e182082013-02-06 14:13:21 +0100520
521 /* clean up */
522 lapdm_channel_exit(&bts_to_ms_channel);
Holger Hans Peter Freytherce397de2013-10-26 13:35:15 +0200523
524 /* idempotent */
525 lapdm_channel_exit(&bts_to_ms_channel);
Andreas Eversberg6e182082013-02-06 14:13:21 +0100526}
527
Harald Weltee61d4592022-11-03 11:05:58 +0100528static void test_lapdm_early_release(void)
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100529{
530 printf("I test RF channel release of an unestablished channel.\n");
531
532 int rc;
533 struct lapdm_polling_state test_state;
534
535 /* Configure LAPDm on both sides */
536 struct lapdm_channel bts_to_ms_channel;
537 memset(&bts_to_ms_channel, 0, sizeof(bts_to_ms_channel));
538
539 memset(&test_state, 0, sizeof(test_state));
540 test_state.bts = &bts_to_ms_channel;
541
542 /* BTS to MS in polling mode */
543 lapdm_channel_init(&bts_to_ms_channel, LAPDM_MODE_BTS);
544 lapdm_channel_set_flags(&bts_to_ms_channel, LAPDM_ENT_F_POLLING_ONLY);
545 lapdm_channel_set_l1(&bts_to_ms_channel, NULL, &test_state);
546 lapdm_channel_set_l3(&bts_to_ms_channel, bts_to_ms_tx_cb, &test_state);
547
548 /* Send the release request */
549 rc = lapdm_rslms_recvmsg(create_rel_req(), &bts_to_ms_channel);
550 OSMO_ASSERT(rc == -EINVAL);
551
552 /* clean up */
553 lapdm_channel_exit(&bts_to_ms_channel);
554
555 /* Check if exit is idempotent */
556 lapdm_channel_exit(&bts_to_ms_channel);
557}
558
559static void lapdm_establish(const uint8_t *est_req, size_t est_req_size)
560{
561 int rc;
562 struct lapdm_polling_state test_state;
563 struct osmo_phsap_prim pp;
564 struct msgb *msg;
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100565
566 /* Configure LAPDm on both sides */
567 struct lapdm_channel bts_to_ms_channel;
568 memset(&bts_to_ms_channel, 0, sizeof(bts_to_ms_channel));
569
570 memset(&test_state, 0, sizeof(test_state));
571 test_state.bts = &bts_to_ms_channel;
572
573 /* BTS to MS in polling mode */
574 lapdm_channel_init(&bts_to_ms_channel, LAPDM_MODE_BTS);
575 lapdm_channel_set_flags(&bts_to_ms_channel, LAPDM_ENT_F_POLLING_ONLY);
576 lapdm_channel_set_l1(&bts_to_ms_channel, NULL, &test_state);
577 lapdm_channel_set_l3(&bts_to_ms_channel, bts_to_ms_tx_cb, &test_state);
578
Vadim Yanitskiyd9252432020-08-27 17:42:40 +0700579 /* Send the establish request */
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100580 msg = create_est_req(est_req, est_req_size);
581 rc = lapdm_rslms_recvmsg(msg, &bts_to_ms_channel);
Vadim Yanitskiy45a90cf2020-08-27 19:29:26 +0700582 printf("lapdm_rslms_recvmsg(): got rc %d: %s\n",
583 rc, rc <= 0 ? strerror(-rc) : "???");
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100584 OSMO_ASSERT(rc == 0);
585
586 /* Take message from queue */
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100587 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
588 if (rc < 0)
589 rc = dequeue_prim(&bts_to_ms_channel.lapdm_acch, &pp, "ACCH");
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100590
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100591 CHECK_RC(rc);
592
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100593 OSMO_ASSERT(pp.oph.msg->data == msgb_l2(pp.oph.msg));
594
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100595 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100596 OSMO_ASSERT(rc < 0);
Jacob Erlbeck2462cf62014-02-25 10:49:00 +0100597 rc = dequeue_prim(&bts_to_ms_channel.lapdm_acch, &pp, "ACCH");
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100598 OSMO_ASSERT(rc < 0);
599
600 /* clean up */
601 lapdm_channel_exit(&bts_to_ms_channel);
602
603 /* idempotent */
604 lapdm_channel_exit(&bts_to_ms_channel);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100605 msgb_free(msg);
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100606}
607
Harald Weltee61d4592022-11-03 11:05:58 +0100608static void test_lapdm_establishment(void)
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100609{
610 printf("I test RF channel establishment.\n");
611 printf("Testing SAPI3/SDCCH\n");
612 lapdm_establish(est_req_sdcch_sapi3, sizeof(est_req_sdcch_sapi3));
613 printf("Testing SAPI3/SACCH\n");
614 lapdm_establish(est_req_sacch_sapi3, sizeof(est_req_sacch_sapi3));
615}
616
Daniel Willmann09129352014-03-20 18:54:57 +0100617
618const uint8_t cm_chg[] = {
619 0x01, 0x00, 0x49, 0x06, 0x16, 0x03, 0x33,
620 0x59, 0xa6, 0x20, 0x0a, 0x20, 0x04, 0x04,
621 0x2f, 0x65, 0x23, 0x02, 0x00, 0x24, 0x04
622};
623
624const uint8_t cm_chg_ack[] = {
625 0x01, 0x21, 0x01
626};
627
628const uint8_t gprs_susp[] = {
629 0x01, 0x02, 0x35, 0x06, 0x34, 0xe3, 0xd4,
630 0xd2, 0x6f, 0x09, 0xf1, 0x07, 0x00, 0x01, 0x00, 0x02
631};
632
Daniel Willmann09129352014-03-20 18:54:57 +0100633const uint8_t cipher_cmd[] = {
634 0x06, 0x35, 0x01
635};
636
Daniel Willmann3dc4e162014-03-20 19:24:48 +0100637/* The cipher command we send to the MS after updating our N(R) */
Daniel Willmann09129352014-03-20 18:54:57 +0100638const uint8_t cipher_cmd_out[] = {
Daniel Willmann3dc4e162014-03-20 19:24:48 +0100639 0x03, 0x40, 0x0d, 0x06, 0x35, 0x01
Daniel Willmann09129352014-03-20 18:54:57 +0100640};
641
642uint8_t cipher_compl[] = {
643 0x01, 0x24, 0x09, 0x06, 0x32
644};
645
646uint8_t cipher_compl_ack[] = {
647 0x01, 0x61, 0x01
648};
649
650static const uint8_t ua_sms[] = {
651 0x0d, 0x73, 0x01
652};
653
654const uint8_t cp_data_1[] = {
655 0x0d, 0x00, 0x53, 0x59, 0x01, 0x5c, 0x00,
656 0x4c, 0x00, 0x06, 0x91, 0x86, 0x77, 0x07,
657 0x00, 0xf9, 0x51, 0x11, 0x76, 0x05, 0x81, 0x29, 0x32
658};
659
660const uint8_t cp_data_1_ack[] = {
661 0x0d, 0x21, 0x01
662};
663
664static int bts_to_ms_dummy_tx_cb(struct msgb *in_msg, struct lapdm_entity *le, void *_ctx)
665{
666 printf("%s: MS->BTS(us) message %d\n", __func__, msgb_length(in_msg));
667 msgb_free(in_msg);
668
669 return 0;
670}
671
672static void dump_queue(struct llist_head *head)
673{
674 struct msgb* msg;
675
676 printf("\nDumping queue:\n");
677 llist_for_each_entry(msg, head, list)
678 printf("%s\n", msgb_hexdump(msg));
679 printf("\n");
680}
681
Harald Weltee61d4592022-11-03 11:05:58 +0100682static void test_lapdm_desync(void)
Daniel Willmann09129352014-03-20 18:54:57 +0100683{
684 printf("I test if desync problems exist in LAPDm\n");
685
686 int rc;
687 struct osmo_phsap_prim pp;
688
689 /* Configure LAPDm on both sides */
690 struct lapdm_channel bts_to_ms_channel;
691 memset(&bts_to_ms_channel, 0, sizeof(bts_to_ms_channel));
692
693 /* BTS to MS in polling mode */
694 lapdm_channel_init(&bts_to_ms_channel, LAPDM_MODE_BTS);
695 lapdm_channel_set_flags(&bts_to_ms_channel, LAPDM_ENT_F_POLLING_ONLY);
696 lapdm_channel_set_l1(&bts_to_ms_channel, NULL, NULL);
697 lapdm_channel_set_l3(&bts_to_ms_channel, bts_to_ms_dummy_tx_cb, NULL);
698 struct lapdm_datalink *dl = lapdm_datalink_for_sapi(&bts_to_ms_channel.lapdm_dcch, 0);
699 dl->mctx.dl = dl;
700 dl->dl.lctx.dl = &dl->dl;
701
702 /* Send SABM MS 1, we must get UA */
703 printf("\nEstablishing SAPI=0\n");
704 send_sabm(&bts_to_ms_channel, 0, cm, sizeof(cm));
705
706 dump_queue(&dl->dl.tx_queue);
707
708 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
709 CHECK_RC(rc);
Vadim Yanitskiy9ff1c1a2020-08-27 18:29:46 +0700710 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, ua_cm, ARRAY_SIZE(ua_cm)) == 0);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100711 msgb_free(pp.oph.msg);
Daniel Willmann09129352014-03-20 18:54:57 +0100712
713 printf("\nSending Classmark Change\n");
714 send_buf(cm_chg, sizeof(cm_chg), &bts_to_ms_channel);
715 dump_queue(&dl->dl.tx_queue);
716
717 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
718 CHECK_RC(rc);
719 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, cm_chg_ack, ARRAY_SIZE(cm_chg_ack)) == 0);
720
721 printf("\nEnqueueing Ciphering Mode Command\n");
722 enqueue_buf(cipher_cmd, sizeof(cipher_cmd), 0, &bts_to_ms_channel);
723 dump_queue(&dl->dl.tx_queue);
724
725 printf("\nSending GPRS Suspend Request\n");
726 send_buf(gprs_susp, sizeof(gprs_susp), &bts_to_ms_channel);
727 dump_queue(&dl->dl.tx_queue);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100728 msgb_free(pp.oph.msg);
Daniel Willmann09129352014-03-20 18:54:57 +0100729
730 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
731 CHECK_RC(rc);
732 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, cipher_cmd_out, ARRAY_SIZE(cipher_cmd_out)) == 0);
733
734 printf("\nSending Cipher Mode Complete\n");
735 send_buf(cipher_compl, sizeof(cipher_compl), &bts_to_ms_channel);
736 dump_queue(&dl->dl.tx_queue);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100737 msgb_free(pp.oph.msg);
Daniel Willmann09129352014-03-20 18:54:57 +0100738
739 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
740 CHECK_RC(rc);
Daniel Willmann3dc4e162014-03-20 19:24:48 +0100741 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, cipher_compl_ack, ARRAY_SIZE(cipher_compl_ack)) == 0);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100742 msgb_free(pp.oph.msg);
Daniel Willmann09129352014-03-20 18:54:57 +0100743
744 printf("\nEstablishing SAPI=3\n");
745 send_sabm(&bts_to_ms_channel, 3, NULL, 0);
746 dump_queue(&dl->dl.tx_queue);
747
748 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
749 CHECK_RC(rc);
750 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, ua_sms, ARRAY_SIZE(ua_sms)) == 0);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100751 msgb_free(pp.oph.msg);
Daniel Willmann09129352014-03-20 18:54:57 +0100752
753 printf("\nSending CP-DATA\n");
754 send_buf(cp_data_1, sizeof(cp_data_1), &bts_to_ms_channel);
755 dump_queue(&dl->dl.tx_queue);
756
757 rc = dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp, "DCCH");
758 CHECK_RC(rc);
Daniel Willmann3dc4e162014-03-20 19:24:48 +0100759 OSMO_ASSERT(memcmp(pp.oph.msg->l2h, cp_data_1_ack, ARRAY_SIZE(cp_data_1_ack)) == 0);
Neels Hofmeyrdd245602017-11-16 16:25:08 +0100760 msgb_free(pp.oph.msg);
Daniel Willmann09129352014-03-20 18:54:57 +0100761
762 /* clean up */
763 lapdm_channel_exit(&bts_to_ms_channel);
764
765 /* Check if exit is idempotent */
766 lapdm_channel_exit(&bts_to_ms_channel);
767}
768
Vadim Yanitskiy488989d2020-08-27 19:35:02 +0700769static void test_lapdm_sapi_prio(void)
770{
771 static const uint8_t dl_sabm[] = { 0x0f, 0x3f, 0x01 };
772 struct osmo_phsap_prim pp1, pp2;
773 struct lapdm_channel lc = { };
774 struct msgb *msg;
775 int rc;
776
777 printf("\n=== I test SAPI0/SAPI3 prioritization ===\n\n");
778
779 /* BTS to MS in polling mode */
780 lapdm_channel_init(&lc, LAPDM_MODE_BTS);
781 lapdm_channel_set_flags(&lc, LAPDM_ENT_F_POLLING_ONLY);
782 lapdm_channel_set_l1(&lc, NULL, NULL);
783 lapdm_channel_set_l3(&lc, bts_to_ms_dummy_tx_cb, NULL);
784
785 /* MS establishes a SAPI=0 link by sending func=SABM on SDCCH */
786 printf("MS is establishing a SAPI=0 link\n");
787 send_sabm(&lc, 0, pr, sizeof(pr));
788
789 /* BTS establishes a SAPI=3 link by sending func=SABM on SDCCH */
790 msg = create_est_req(est_req_sdcch_sapi3, sizeof(est_req_sdcch_sapi3));
791 printf("BTS is establishing a SAPI=3 link\n");
792 rc = lapdm_rslms_recvmsg(msg, &lc);
793 OSMO_ASSERT(rc == 0);
794
795 /* Make sure that we get func=UA on SDCCH from the BTS first */
796 rc = dequeue_prim(&lc.lapdm_dcch, &pp1, "DCCH");
797 CHECK_RC(rc);
798
799 /* Contention resolution is completed, we should get func=SABM now */
800 rc = dequeue_prim(&lc.lapdm_dcch, &pp2, "DCCH");
801 CHECK_RC(rc);
802
803 /* Check the actual message payload */
804 rc = memcmp(pp1.oph.msg->l2h, ua_pr, sizeof(ua_pr));
805 printf("Checking the func=UA message: %s\n", rc == 0 ? "OK" : "FAIL");
806 rc = memcmp(pp2.oph.msg->l2h, dl_sabm, sizeof(dl_sabm));
807 printf("Checking the func=SABM message: %s\n", rc == 0 ? "OK" : "FAIL");
808
809 msgb_free(pp1.oph.msg);
810 msgb_free(pp2.oph.msg);
811
812 /* Make sure that the queues are empty now */
813 printf("\nChecking whether the DCCH/SACCH queues are empty\n");
814 rc = dequeue_prim(&lc.lapdm_dcch, &pp1, "DCCH");
815 OSMO_ASSERT(rc < 0);
816 rc = dequeue_prim(&lc.lapdm_dcch, &pp2, "SACCH");
817 OSMO_ASSERT(rc < 0);
818
819 /* Clean up */
820 lapdm_channel_exit(&lc);
821
822 /* Check if exit is idempotent */
823 lapdm_channel_exit(&lc);
824}
825
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100826int main(int argc, char **argv)
827{
Neels Hofmeyra829b452018-04-05 03:02:35 +0200828 void *ctx = talloc_named_const(NULL, 0, "lapd_test");
829 osmo_init_logging2(ctx, &info);
830
831 msgb_talloc_ctx_init(ctx, 0);
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100832
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100833 /* Prevent the test from segfaulting */
834 dummy_l1_header_len = 0;
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100835 test_lapdm_polling();
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100836
837 dummy_l1_header_len = 3;
Daniel Willmanne5233922012-12-25 23:15:50 +0100838 test_lapdm_early_release();
Andreas Eversberg6e182082013-02-06 14:13:21 +0100839 test_lapdm_contention_resolution();
Jacob Erlbeck90937fe2014-01-24 13:48:19 +0100840 test_lapdm_establishment();
Daniel Willmann09129352014-03-20 18:54:57 +0100841 test_lapdm_desync();
Vadim Yanitskiy488989d2020-08-27 19:35:02 +0700842 test_lapdm_sapi_prio();
Jacob Erlbeckc893c222014-01-28 10:53:59 +0100843
Holger Hans Peter Freyther72bd4eb2011-12-11 20:25:12 +0100844 printf("Success.\n");
845
846 return 0;
847}