2013-05-23 17:58:28 +00:00
|
|
|
/*
|
|
|
|
* (C) 2013 by Pablo Neira Ayuso <pablo@gnumonks.org>
|
|
|
|
* (C) 2013 by On Waves ehf <http://www.on-waves.com>
|
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <signal.h>
|
|
|
|
#include <arpa/inet.h>
|
|
|
|
#include <sys/time.h>
|
|
|
|
|
|
|
|
#include <osmocom/core/select.h>
|
|
|
|
#include <osmocom/core/application.h>
|
|
|
|
#include <osmocom/core/logging.h>
|
|
|
|
#include <osmocom/core/msgb.h>
|
|
|
|
#include <osmocom/core/linuxlist.h>
|
|
|
|
#include <osmocom/netif/osmux.h>
|
|
|
|
#include <osmocom/netif/rtp.h>
|
|
|
|
|
|
|
|
#define DOSMUX_TEST 0
|
|
|
|
|
|
|
|
struct log_info_cat osmux_test_cat[] = {
|
|
|
|
[DOSMUX_TEST] = {
|
|
|
|
.name = "DOSMUX_TEST",
|
|
|
|
.description = "osmux test",
|
|
|
|
.color = "\033[1;35m",
|
|
|
|
.enabled = 1, .loglevel = LOGL_DEBUG,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
const struct log_info osmux_test_log_info = {
|
|
|
|
.filter_fn = NULL,
|
|
|
|
.cat = osmux_test_cat,
|
|
|
|
.num_cat = ARRAY_SIZE(osmux_test_cat),
|
|
|
|
};
|
|
|
|
|
|
|
|
/* RTP packet with AMR payload */
|
|
|
|
static uint8_t rtp_pkt[] = {
|
|
|
|
0x80, 0x62, 0x3f, 0xcc, 0x00, 0x01, 0xa7, 0x6f, /* RTP */
|
|
|
|
0x07, 0x09, 0x00, 0x62, 0x20, 0x14, 0xff, 0xd4, /* AMR */
|
|
|
|
0xf9, 0xff, 0xfb, 0xe7, 0xeb, 0xf9, 0x9f, 0xf8,
|
|
|
|
0xf2, 0x26, 0x33, 0x65, 0x54,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int rtp_pkts;
|
|
|
|
static struct timeval last;
|
|
|
|
|
|
|
|
static void tx_cb(struct msgb *msg, void *data)
|
|
|
|
{
|
|
|
|
char buf[4096];
|
|
|
|
struct timeval now, diff;
|
|
|
|
|
|
|
|
gettimeofday(&now, NULL);
|
|
|
|
timersub(&now, &last, &diff);
|
|
|
|
last = now;
|
|
|
|
|
2013-05-27 09:12:52 +00:00
|
|
|
if (diff.tv_usec > 2*17000) {
|
2013-05-23 17:58:28 +00:00
|
|
|
fprintf(stdout, "lagging to deliver reconstructed RTP\n");
|
|
|
|
exit(EXIT_FAILURE);
|
|
|
|
}
|
|
|
|
|
|
|
|
osmo_rtp_snprintf(buf, sizeof(buf), msg);
|
|
|
|
fprintf(stderr, "extracted packet: %s\n", buf);
|
|
|
|
|
|
|
|
if (memcmp(msg->data + sizeof(struct rtp_hdr),
|
|
|
|
rtp_pkt + sizeof(struct rtp_hdr),
|
|
|
|
sizeof(rtp_pkt) - sizeof(struct rtp_hdr)) != 0) {
|
|
|
|
fprintf(stdout, "payload mismatch!\n");
|
|
|
|
exit(EXIT_FAILURE);
|
|
|
|
}
|
|
|
|
|
|
|
|
rtp_pkts--;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct osmux_out_handle h_output;
|
|
|
|
|
|
|
|
static void osmux_deliver(struct msgb *batch_msg, void *data)
|
|
|
|
{
|
|
|
|
char buf[1024];
|
|
|
|
struct osmux_hdr *osmuxh;
|
|
|
|
LLIST_HEAD(list);
|
|
|
|
|
|
|
|
osmux_snprintf(buf, sizeof(buf), batch_msg);
|
|
|
|
fprintf(stderr, "OSMUX message (len=%d) %s\n", batch_msg->len, buf);
|
|
|
|
|
|
|
|
/* For each OSMUX message, extract the RTP messages and put them
|
|
|
|
* in a list. Then, reconstruct transmission timing.
|
|
|
|
*/
|
|
|
|
while((osmuxh = osmux_xfrm_output_pull(batch_msg)) != NULL) {
|
|
|
|
osmux_xfrm_output(osmuxh, &h_output, &list);
|
|
|
|
osmux_tx_sched(&list, tx_cb, NULL);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
struct osmux_in_handle h_input = {
|
|
|
|
.osmux_seq = 0, /* sequence number to start OSmux message from */
|
|
|
|
.batch_factor = 4, /* batch up to 4 RTP messages */
|
|
|
|
.deliver = osmux_deliver,
|
|
|
|
};
|
|
|
|
|
2013-05-24 09:22:41 +00:00
|
|
|
static void sigalarm_handler(int foo)
|
|
|
|
{
|
|
|
|
printf("FAIL: test did not run successfully\n");
|
|
|
|
exit(EXIT_FAILURE);
|
|
|
|
}
|
|
|
|
|
2013-05-23 17:58:28 +00:00
|
|
|
int main(void)
|
|
|
|
{
|
|
|
|
struct msgb *msg;
|
|
|
|
char buf[1024];
|
|
|
|
struct rtp_hdr *rtph = (struct rtp_hdr *)rtp_pkt;
|
|
|
|
uint16_t seq;
|
2013-05-24 11:12:14 +00:00
|
|
|
int i, j, k = 0;
|
2013-05-23 17:58:28 +00:00
|
|
|
|
2013-05-24 09:22:41 +00:00
|
|
|
if (signal(SIGALRM, sigalarm_handler) == SIG_ERR) {
|
|
|
|
perror("signal");
|
|
|
|
exit(EXIT_FAILURE);
|
|
|
|
}
|
|
|
|
|
2013-05-23 17:58:28 +00:00
|
|
|
/* This test doesn't use it, but osmux requires it internally. */
|
|
|
|
osmo_init_logging(&osmux_test_log_info);
|
|
|
|
log_set_log_level(osmo_stderr_target, LOGL_DEBUG);
|
|
|
|
|
|
|
|
osmux_xfrm_input_init(&h_input);
|
|
|
|
osmux_xfrm_output_init(&h_output, 0x7000000);
|
|
|
|
|
2013-05-24 09:22:41 +00:00
|
|
|
/* If the test takes longer than 10 seconds, abort it */
|
|
|
|
alarm(10);
|
|
|
|
|
2013-05-23 17:58:28 +00:00
|
|
|
for (i=1; i<64; i++) {
|
|
|
|
msg = msgb_alloc(1500, "test");
|
|
|
|
if (!msg)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
memcpy(msg->data, rtp_pkt, sizeof(rtp_pkt));
|
|
|
|
msgb_put(msg, sizeof(rtp_pkt));
|
|
|
|
|
|
|
|
seq = ntohs(rtph->sequence);
|
|
|
|
seq++;
|
|
|
|
rtph->sequence = htons(seq);
|
|
|
|
|
|
|
|
osmo_rtp_snprintf(buf, sizeof(buf), msg);
|
|
|
|
fprintf(stderr, "adding %s\n", buf);
|
|
|
|
rtp_pkts++;
|
|
|
|
|
2013-05-24 11:12:14 +00:00
|
|
|
/* Intentionally skip RTP message to test replay RTP */
|
|
|
|
if (i % 3 == 0)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
k++;
|
2013-05-23 17:58:28 +00:00
|
|
|
osmux_xfrm_input(&h_input, msg, 0);
|
2013-05-24 11:12:14 +00:00
|
|
|
|
2013-05-23 17:58:28 +00:00
|
|
|
if (i % 4 == 0) {
|
|
|
|
gettimeofday(&last, NULL);
|
|
|
|
|
|
|
|
/* After four RTP messages, squash them into the OSMUX
|
|
|
|
* batch and call the routine to deliver it.
|
|
|
|
*/
|
|
|
|
osmux_xfrm_input_deliver(&h_input);
|
|
|
|
|
|
|
|
/* The first RTP message that is delivered immediately,
|
|
|
|
* wait until the three RTP messages that are extracted
|
|
|
|
* from OSMUX has been delivered.
|
|
|
|
*/
|
2013-05-24 11:12:14 +00:00
|
|
|
for (j=0; j<k; j++)
|
2013-05-23 17:58:28 +00:00
|
|
|
osmo_select_main(0);
|
2013-05-24 11:12:14 +00:00
|
|
|
|
|
|
|
k = 0;
|
2013-05-23 17:58:28 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
fprintf(stdout, "OK: Test passed\n");
|
|
|
|
return EXIT_SUCCESS;
|
|
|
|
}
|