mirror of https://gerrit.osmocom.org/libosmocore
300 lines
8.1 KiB
C
300 lines
8.1 KiB
C
/*
|
|
* (C) 2011 by Holger Hans Peter Freyther
|
|
* (C) 2011 by On-Waves
|
|
* All Rights Reserved
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*
|
|
*/
|
|
|
|
#include <osmocom/core/logging.h>
|
|
#include <osmocom/gsm/lapdm.h>
|
|
#include <osmocom/gsm/rsl.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <string.h>
|
|
|
|
#define CHECK_RC(rc) \
|
|
if (rc != 0) { \
|
|
printf("Operation failed rc=%d on %s:%d\n", rc, __FILE__, __LINE__); \
|
|
abort(); \
|
|
}
|
|
|
|
#define ASSERT(exp) \
|
|
if (!(exp)) { \
|
|
printf("Assert failed %s %s:%d\n", #exp, __FILE__, __LINE__); \
|
|
abort(); \
|
|
}
|
|
|
|
|
|
static struct log_info info = {};
|
|
|
|
struct lapdm_polling_state {
|
|
struct lapdm_channel *bts;
|
|
int bts_read;
|
|
|
|
struct lapdm_channel *ms;
|
|
int ms_read;
|
|
};
|
|
|
|
static struct msgb *msgb_from_array(const uint8_t *data, int len)
|
|
{
|
|
struct msgb *msg = msgb_alloc_headroom(4096, 128, "data");
|
|
msg->l3h = msgb_put(msg, len);
|
|
memcpy(msg->l3h, data, len);
|
|
return msg;
|
|
}
|
|
|
|
/*
|
|
* Test data is below...
|
|
*/
|
|
static const uint8_t cm[] = {
|
|
0x05, 0x24, 0x31, 0x03, 0x50, 0x18, 0x93, 0x08,
|
|
0x29, 0x47, 0x80, 0x00, 0x00, 0x00, 0x00, 0x80,
|
|
};
|
|
|
|
static const uint8_t cm_padded[] = {
|
|
0x05, 0x24, 0x31, 0x03, 0x50, 0x18, 0x93, 0x08,
|
|
0x29, 0x47, 0x80, 0x00, 0x00, 0x00, 0x00, 0x80,
|
|
0x2b, 0x2b, 0x2b, 0x2b
|
|
};
|
|
|
|
static const uint8_t mm[] = {
|
|
0x05, 0x24, 0x31, 0x03, 0x50, 0x18, 0x93, 0x08,
|
|
0x29, 0x47, 0x80, 0x00,
|
|
};
|
|
|
|
static const uint8_t dummy1[] = {
|
|
0xab, 0x03, 0x30, 0x60, 0x06,
|
|
};
|
|
|
|
static struct msgb *create_cm_serv_req(void)
|
|
{
|
|
struct msgb *msg;
|
|
|
|
msg = msgb_from_array(cm, sizeof(cm));
|
|
rsl_rll_push_l3(msg, RSL_MT_EST_REQ, 0, 0, 1);
|
|
return msg;
|
|
}
|
|
|
|
static struct msgb *create_mm_id_req(void)
|
|
{
|
|
struct msgb *msg;
|
|
|
|
msg = msgb_from_array(mm, sizeof(mm));
|
|
rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, 0, 0, 1);
|
|
return msg;
|
|
}
|
|
|
|
static struct msgb *create_dummy_data_req(void)
|
|
{
|
|
struct msgb *msg;
|
|
|
|
msg = msgb_from_array(dummy1, sizeof(dummy1));
|
|
rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, 0, 0, 1);
|
|
return msg;
|
|
}
|
|
|
|
static int send(struct msgb *in_msg, struct lapdm_channel *chan)
|
|
{
|
|
struct osmo_phsap_prim pp;
|
|
struct msgb *msg;
|
|
int rc;
|
|
|
|
msg = msgb_alloc_headroom(128, 64, "PH-DATA.ind");
|
|
osmo_prim_init(&pp.oph, SAP_GSM_PH, PRIM_PH_DATA,
|
|
PRIM_OP_INDICATION, msg);
|
|
/* copy over actual MAC block */
|
|
msg->l2h = msgb_put(msg, msgb_l2len(in_msg));
|
|
memcpy(msg->l2h, in_msg->l2h, msgb_l2len(in_msg));
|
|
|
|
/* LAPDm requires those... */
|
|
pp.u.data.chan_nr = 0;
|
|
pp.u.data.link_id = 0;
|
|
/* feed into the LAPDm code of libosmogsm */
|
|
rc = lapdm_phsap_up(&pp.oph, &chan->lapdm_dcch);
|
|
ASSERT(rc == 0 || rc == -EBUSY);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* I get called from the LAPDm code when something was sent my way...
|
|
*/
|
|
static int bts_to_ms_tx_cb(struct msgb *in_msg, struct lapdm_entity *le, void *_ctx)
|
|
{
|
|
struct lapdm_polling_state *state = _ctx;
|
|
|
|
|
|
printf("%s: MS->BTS(us) message %d\n", __func__, msgb_length(in_msg));
|
|
|
|
|
|
if (state->bts_read == 0) {
|
|
printf("BTS: Verifying CM request.\n");
|
|
ASSERT(msgb_l3len(in_msg) == ARRAY_SIZE(cm_padded));
|
|
ASSERT(memcmp(in_msg->l3h, cm_padded, ARRAY_SIZE(cm_padded)) == 0);
|
|
} else if (state->bts_read == 1) {
|
|
printf("BTS: Verifying dummy message.\n");
|
|
ASSERT(msgb_l3len(in_msg) == ARRAY_SIZE(dummy1));
|
|
ASSERT(memcmp(in_msg->l3h, dummy1, ARRAY_SIZE(dummy1)) == 0);
|
|
} else {
|
|
printf("BTS: Do not know to verify: %d\n", state->bts_read);
|
|
}
|
|
|
|
state->bts_read += 1;
|
|
msgb_free(in_msg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ms_to_bts_l1_cb(struct osmo_prim_hdr *oph, void *_ctx)
|
|
{
|
|
int rc;
|
|
struct lapdm_polling_state *state = _ctx;
|
|
printf("%s: MS(us) -> BTS prim message\n", __func__);
|
|
|
|
/* i stuff it into the LAPDm channel of the BTS */
|
|
rc = send(oph->msg, state->bts);
|
|
msgb_free(oph->msg);
|
|
}
|
|
|
|
static int ms_to_bts_tx_cb(struct msgb *msg, struct lapdm_entity *le, void *_ctx)
|
|
{
|
|
struct lapdm_polling_state *state = _ctx;
|
|
|
|
printf("%s: BTS->MS(us) message %d\n", __func__, msgb_length(msg));
|
|
|
|
if (state->ms_read == 0) {
|
|
struct abis_rsl_rll_hdr hdr;
|
|
|
|
printf("MS: Verifying incoming primitive.\n");
|
|
ASSERT(msg->len == sizeof(struct abis_rsl_rll_hdr) + 3);
|
|
|
|
/* verify the header */
|
|
memset(&hdr, 0, sizeof(hdr));
|
|
rsl_init_rll_hdr(&hdr, RSL_MT_EST_CONF);
|
|
hdr.c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
|
|
ASSERT(memcmp(msg->data, &hdr, sizeof(hdr)) == 0);
|
|
|
|
/* Verify the added RSL_IE_L3_INFO but we have a bug here */
|
|
ASSERT(msg->data[6] == RSL_IE_L3_INFO);
|
|
ASSERT(msg->data[7] == 0x0 && msg->data[8] == 0x9c);
|
|
/* this should be 0x0 and 0x0... but we have a bug */
|
|
} else if (state->ms_read == 1) {
|
|
printf("MS: Verifying incoming MM message.\n");
|
|
ASSERT(msgb_l3len(msg) == ARRAY_SIZE(mm));
|
|
ASSERT(memcmp(msg->l3h, mm, msgb_l3len(msg)) == 0);
|
|
} else {
|
|
printf("MS: Do not know to verify: %d\n", state->ms_read);
|
|
}
|
|
|
|
state->ms_read += 1;
|
|
msgb_free(msg);
|
|
return 0;
|
|
}
|
|
|
|
static void test_lapdm_polling()
|
|
{
|
|
printf("I do some very simple LAPDm test.\n");
|
|
|
|
int rc;
|
|
struct lapdm_polling_state test_state;
|
|
struct osmo_phsap_prim pp;
|
|
|
|
/* Configure LAPDm on both sides */
|
|
struct lapdm_channel bts_to_ms_channel;
|
|
struct lapdm_channel ms_to_bts_channel;
|
|
memset(&bts_to_ms_channel, 0, sizeof(bts_to_ms_channel));
|
|
memset(&ms_to_bts_channel, 0, sizeof(ms_to_bts_channel));
|
|
|
|
memset(&test_state, 0, sizeof(test_state));
|
|
test_state.bts = &bts_to_ms_channel;
|
|
test_state.ms = &ms_to_bts_channel;
|
|
|
|
/* BTS to MS in polling mode */
|
|
lapdm_channel_init(&bts_to_ms_channel, LAPDM_MODE_BTS);
|
|
lapdm_channel_set_flags(&bts_to_ms_channel, LAPDM_ENT_F_POLLING_ONLY);
|
|
lapdm_channel_set_l1(&bts_to_ms_channel, NULL, &test_state);
|
|
lapdm_channel_set_l3(&bts_to_ms_channel, bts_to_ms_tx_cb, &test_state);
|
|
|
|
/* MS to BTS in direct mode */
|
|
lapdm_channel_init(&ms_to_bts_channel, LAPDM_MODE_MS);
|
|
lapdm_channel_set_l1(&ms_to_bts_channel, ms_to_bts_l1_cb, &test_state);
|
|
lapdm_channel_set_l3(&ms_to_bts_channel, ms_to_bts_tx_cb, &test_state);
|
|
|
|
/*
|
|
* We try to send messages from the MS to the BTS to the MS..
|
|
*/
|
|
/* 1. Start with MS -> BTS, BTS should have a pending message */
|
|
printf("Establishing link.\n");
|
|
lapdm_rslms_recvmsg(create_cm_serv_req(), &ms_to_bts_channel);
|
|
|
|
/* 2. Poll on the BTS for sending out a confirmation */
|
|
printf("\nConfirming\n");
|
|
ASSERT(test_state.bts_read == 1)
|
|
rc = lapdm_phsap_dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp);
|
|
CHECK_RC(rc);
|
|
ASSERT(pp.oph.msg->data == pp.oph.msg->l2h);
|
|
send(pp.oph.msg, &ms_to_bts_channel);
|
|
msgb_free(pp.oph.msg);
|
|
ASSERT(test_state.ms_read == 1);
|
|
|
|
/* 3. Send some data to the MS */
|
|
printf("\nSending back to MS\n");
|
|
lapdm_rslms_recvmsg(create_mm_id_req(), &bts_to_ms_channel);
|
|
rc = lapdm_phsap_dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp);
|
|
CHECK_RC(rc);
|
|
send(pp.oph.msg, &ms_to_bts_channel);
|
|
msgb_free(pp.oph.msg);
|
|
ASSERT(test_state.ms_read == 2);
|
|
|
|
/* verify that there is nothing more to poll */
|
|
rc = lapdm_phsap_dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp);
|
|
ASSERT(rc < 0);
|
|
|
|
/* 3. And back to the BTS */
|
|
printf("\nSending back to BTS\n");
|
|
ASSERT(test_state.ms_read == 2);
|
|
lapdm_rslms_recvmsg(create_dummy_data_req(), &ms_to_bts_channel);
|
|
|
|
|
|
/* 4. And back to the MS */
|
|
ASSERT(test_state.bts_read == 2)
|
|
ASSERT(test_state.ms_read == 2);
|
|
rc = lapdm_phsap_dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp);
|
|
CHECK_RC(rc);
|
|
send(pp.oph.msg, &ms_to_bts_channel);
|
|
ASSERT(test_state.ms_read == 2);
|
|
msgb_free(pp.oph.msg);
|
|
|
|
/* verify that there is nothing more to poll */
|
|
rc = lapdm_phsap_dequeue_prim(&bts_to_ms_channel.lapdm_dcch, &pp);
|
|
ASSERT(rc < 0);
|
|
|
|
/* clean up */
|
|
lapdm_channel_exit(&bts_to_ms_channel);
|
|
lapdm_channel_exit(&ms_to_bts_channel);
|
|
}
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
osmo_init_logging(&info);
|
|
|
|
test_lapdm_polling();
|
|
printf("Success.\n");
|
|
|
|
return 0;
|
|
}
|