253 lines
6.2 KiB
C++
253 lines
6.2 KiB
C++
/*
|
|
* LlcTest.cpp
|
|
*
|
|
* Copyright (C) 2015 by Sysmocom s.f.m.c. GmbH
|
|
*
|
|
* All Rights Reserved
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU Affero General Public License as published by
|
|
* the Free Software Foundation; either version 3 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 Affero General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*
|
|
*/
|
|
|
|
extern "C" {
|
|
#include <osmocom/core/linuxlist.h>
|
|
}
|
|
|
|
#include "llc.h"
|
|
#include "gprs_debug.h"
|
|
|
|
extern "C" {
|
|
#include "pcu_vty.h"
|
|
|
|
#include <osmocom/core/application.h>
|
|
#include <osmocom/core/msgb.h>
|
|
#include <osmocom/core/talloc.h>
|
|
#include <osmocom/core/utils.h>
|
|
#include <osmocom/vty/vty.h>
|
|
}
|
|
|
|
|
|
void *tall_pcu_ctx;
|
|
int16_t spoof_mnc = 0, spoof_mcc = 0;
|
|
bool spoof_mnc_3_digits = false;
|
|
|
|
static void enqueue_data(gprs_llc_queue *queue, const uint8_t *data, size_t len,
|
|
gprs_llc_queue::MetaInfo *info = 0)
|
|
{
|
|
struct timeval *tv;
|
|
uint8_t *msg_data;
|
|
struct msgb *llc_msg = msgb_alloc(len + sizeof(*tv) * 2,
|
|
"llc_pdu_queue");
|
|
|
|
msg_data = (uint8_t *)msgb_put(llc_msg, len);
|
|
|
|
memcpy(msg_data, data, len);
|
|
|
|
queue->enqueue(llc_msg, info);
|
|
}
|
|
|
|
static void dequeue_and_check(gprs_llc_queue *queue, const uint8_t *exp_data,
|
|
size_t len, const gprs_llc_queue::MetaInfo *exp_info = 0)
|
|
{
|
|
struct msgb *llc_msg;
|
|
uint8_t *msg_data;
|
|
const gprs_llc_queue::MetaInfo *info_res;
|
|
|
|
llc_msg = queue->dequeue(&info_res);
|
|
OSMO_ASSERT(llc_msg != NULL);
|
|
|
|
fprintf(stderr, "dequeued msg, length %u (expected %zu), data %s\n",
|
|
msgb_length(llc_msg), len, msgb_hexdump(llc_msg));
|
|
|
|
OSMO_ASSERT(msgb_length(llc_msg) == len);
|
|
msg_data = msgb_data(llc_msg);
|
|
|
|
OSMO_ASSERT(memcmp(msg_data, exp_data, len) == 0);
|
|
|
|
if (exp_info)
|
|
OSMO_ASSERT(memcmp(exp_info, info_res, sizeof(*exp_info)) == 0);
|
|
|
|
msgb_free(llc_msg);
|
|
}
|
|
|
|
static void enqueue_data(gprs_llc_queue *queue, const char *message,
|
|
gprs_llc_queue::MetaInfo *info = 0)
|
|
{
|
|
enqueue_data(queue, (uint8_t *)(message), strlen(message), info);
|
|
}
|
|
|
|
static void dequeue_and_check(gprs_llc_queue *queue, const char *exp_message,
|
|
const gprs_llc_queue::MetaInfo *exp_info = 0)
|
|
{
|
|
dequeue_and_check(queue,
|
|
(uint8_t *)(exp_message), strlen(exp_message), exp_info);
|
|
}
|
|
|
|
static void test_llc_queue()
|
|
{
|
|
gprs_llc_queue queue;
|
|
|
|
printf("=== start %s ===\n", __func__);
|
|
|
|
queue.init();
|
|
OSMO_ASSERT(queue.size() == 0);
|
|
OSMO_ASSERT(queue.octets() == 0);
|
|
|
|
enqueue_data(&queue, "LLC message");
|
|
OSMO_ASSERT(queue.size() == 1);
|
|
OSMO_ASSERT(queue.octets() == 11);
|
|
|
|
enqueue_data(&queue, "other LLC message");
|
|
OSMO_ASSERT(queue.size() == 2);
|
|
OSMO_ASSERT(queue.octets() == 28);
|
|
|
|
dequeue_and_check(&queue, "LLC message");
|
|
OSMO_ASSERT(queue.size() == 1);
|
|
OSMO_ASSERT(queue.octets() == 17);
|
|
|
|
dequeue_and_check(&queue, "other LLC message");
|
|
OSMO_ASSERT(queue.size() == 0);
|
|
OSMO_ASSERT(queue.octets() == 0);
|
|
|
|
enqueue_data(&queue, "LLC");
|
|
OSMO_ASSERT(queue.size() == 1);
|
|
OSMO_ASSERT(queue.octets() == 3);
|
|
|
|
queue.clear(NULL);
|
|
OSMO_ASSERT(queue.size() == 0);
|
|
OSMO_ASSERT(queue.octets() == 0);
|
|
|
|
printf("=== end %s ===\n", __func__);
|
|
}
|
|
|
|
static void test_llc_meta()
|
|
{
|
|
gprs_llc_queue queue;
|
|
gprs_llc_queue::MetaInfo info1;
|
|
gprs_llc_queue::MetaInfo info2;
|
|
|
|
info1.recv_time.tv_sec = 123456777;
|
|
info1.recv_time.tv_usec = 123456;
|
|
info1.expire_time.tv_sec = 123456789;
|
|
info1.expire_time.tv_usec = 987654;
|
|
|
|
info2.recv_time.tv_sec = 987654321;
|
|
info2.recv_time.tv_usec = 547352;
|
|
info2.expire_time.tv_sec = 987654327;
|
|
info2.expire_time.tv_usec = 867252;
|
|
|
|
printf("=== start %s ===\n", __func__);
|
|
|
|
queue.init();
|
|
OSMO_ASSERT(queue.size() == 0);
|
|
OSMO_ASSERT(queue.octets() == 0);
|
|
|
|
enqueue_data(&queue, "LLC message 1", &info1);
|
|
enqueue_data(&queue, "LLC message 2", &info2);
|
|
|
|
dequeue_and_check(&queue, "LLC message 1", &info1);
|
|
dequeue_and_check(&queue, "LLC message 2", &info2);
|
|
|
|
queue.clear(NULL);
|
|
OSMO_ASSERT(queue.size() == 0);
|
|
OSMO_ASSERT(queue.octets() == 0);
|
|
|
|
printf("=== end %s ===\n", __func__);
|
|
}
|
|
|
|
static void test_llc_merge()
|
|
{
|
|
gprs_llc_queue queue1;
|
|
gprs_llc_queue queue2;
|
|
gprs_llc_queue::MetaInfo info = {0};
|
|
|
|
printf("=== start %s ===\n", __func__);
|
|
|
|
queue1.init();
|
|
queue2.init();
|
|
|
|
info.recv_time.tv_sec += 1;
|
|
enqueue_data(&queue1, "*A*", &info);
|
|
|
|
info.recv_time.tv_sec += 1;
|
|
enqueue_data(&queue1, "*B*", &info);
|
|
|
|
info.recv_time.tv_sec += 1;
|
|
enqueue_data(&queue2, "*C*", &info);
|
|
|
|
info.recv_time.tv_sec += 1;
|
|
enqueue_data(&queue1, "*D*", &info);
|
|
|
|
info.recv_time.tv_sec += 1;
|
|
enqueue_data(&queue2, "*E*", &info);
|
|
|
|
OSMO_ASSERT(queue1.size() == 3);
|
|
OSMO_ASSERT(queue1.octets() == 9);
|
|
OSMO_ASSERT(queue2.size() == 2);
|
|
OSMO_ASSERT(queue2.octets() == 6);
|
|
|
|
queue2.move_and_merge(&queue1);
|
|
|
|
OSMO_ASSERT(queue1.size() == 0);
|
|
OSMO_ASSERT(queue1.octets() == 0);
|
|
OSMO_ASSERT(queue2.size() == 5);
|
|
OSMO_ASSERT(queue2.octets() == 15);
|
|
|
|
dequeue_and_check(&queue2, "*A*");
|
|
dequeue_and_check(&queue2, "*B*");
|
|
dequeue_and_check(&queue2, "*C*");
|
|
dequeue_and_check(&queue2, "*D*");
|
|
dequeue_and_check(&queue2, "*E*");
|
|
|
|
OSMO_ASSERT(queue2.size() == 0);
|
|
OSMO_ASSERT(queue2.octets() == 0);
|
|
|
|
printf("=== end %s ===\n", __func__);
|
|
}
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
struct vty_app_info pcu_vty_info = {0};
|
|
|
|
tall_pcu_ctx = talloc_named_const(NULL, 1, "LlcTest context");
|
|
if (!tall_pcu_ctx)
|
|
abort();
|
|
|
|
msgb_talloc_ctx_init(tall_pcu_ctx, 0);
|
|
osmo_init_logging2(tall_pcu_ctx, &gprs_log_info);
|
|
log_set_use_color(osmo_stderr_target, 0);
|
|
log_set_print_filename(osmo_stderr_target, 0);
|
|
log_set_log_level(osmo_stderr_target, LOGL_INFO);
|
|
log_parse_category_mask(osmo_stderr_target, "DPCU,3");
|
|
|
|
vty_init(&pcu_vty_info);
|
|
pcu_vty_init(&gprs_log_info);
|
|
|
|
test_llc_queue();
|
|
test_llc_meta();
|
|
test_llc_merge();
|
|
|
|
if (getenv("TALLOC_REPORT_FULL"))
|
|
talloc_report_full(tall_pcu_ctx, stderr);
|
|
|
|
return EXIT_SUCCESS;
|
|
}
|
|
|
|
extern "C" {
|
|
void l1if_pdch_req() { abort(); }
|
|
void l1if_connect_pdch() { abort(); }
|
|
void l1if_close_pdch() { abort(); }
|
|
void l1if_open_pdch() { abort(); }
|
|
}
|