mirror of git://git.sysmocom.de/ofono
571 lines
15 KiB
C
571 lines
15 KiB
C
/*
|
|
*
|
|
* oFono - Open Source Telephony
|
|
*
|
|
* Copyright (C) 2008-2011 Intel Corporation. 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 version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* 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 St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include <config.h>
|
|
#endif
|
|
|
|
#include <unistd.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sys/socket.h>
|
|
#include <netinet/in.h>
|
|
#include <arpa/inet.h>
|
|
|
|
#pragma GCC diagnostic ignored "-Wdeprecated-declarations"
|
|
|
|
#include <glib.h>
|
|
#include <glib/gprintf.h>
|
|
|
|
#include "gatmux.h"
|
|
#include "gsm0710.h"
|
|
|
|
static int do_connect(const char *address, unsigned short port)
|
|
{
|
|
struct sockaddr_in addr;
|
|
int sk, err;
|
|
|
|
sk = socket(PF_INET, SOCK_STREAM, 0);
|
|
if (sk < 0)
|
|
return sk;
|
|
|
|
memset(&addr, 0, sizeof(addr));
|
|
addr.sin_family = AF_INET;
|
|
addr.sin_addr.s_addr = inet_addr(address);
|
|
addr.sin_port = htons(port);
|
|
|
|
err = connect(sk, (struct sockaddr *) &addr, sizeof(addr));
|
|
if (err < 0) {
|
|
close(sk);
|
|
return err;
|
|
}
|
|
|
|
return sk;
|
|
}
|
|
|
|
static GMainLoop *mainloop;
|
|
static GAtMux *mux;
|
|
|
|
static gboolean cleanup_callback(gpointer data)
|
|
{
|
|
g_at_mux_unref(mux);
|
|
|
|
g_main_loop_quit(mainloop);
|
|
|
|
return FALSE;
|
|
}
|
|
|
|
static gboolean chat_cleanup(gpointer data)
|
|
{
|
|
GAtChat *chat = data;
|
|
|
|
g_at_chat_unref(chat);
|
|
|
|
return FALSE;
|
|
}
|
|
|
|
static void chat_callback(gboolean ok, GAtResult *result, gpointer user_data)
|
|
{
|
|
GAtResultIter iter;
|
|
|
|
g_at_result_iter_init(&iter, result);
|
|
|
|
g_print("chat: callback [ok %d]\n", ok);
|
|
|
|
g_print("%s\n", g_at_result_final_response(result));
|
|
|
|
g_idle_add(chat_cleanup, user_data);
|
|
}
|
|
|
|
static void mux_debug(const char *str, void *data)
|
|
{
|
|
g_print("%s: %s\n", (char *) data, str);
|
|
}
|
|
|
|
static void mux_setup(GAtMux *m, gpointer data)
|
|
{
|
|
GAtChat *chat = data;
|
|
GIOChannel *io;
|
|
GAtSyntax *syntax;
|
|
|
|
mux = m;
|
|
|
|
g_print("mux_setup: %p\n", mux);
|
|
|
|
if (mux == NULL) {
|
|
g_at_chat_unref(chat);
|
|
g_main_loop_quit(mainloop);
|
|
return;
|
|
}
|
|
|
|
g_at_mux_start(mux);
|
|
|
|
io = g_at_mux_create_channel(mux);
|
|
syntax = g_at_syntax_new_gsm_permissive();
|
|
chat = g_at_chat_new(io, syntax);
|
|
g_at_syntax_unref(syntax);
|
|
g_io_channel_unref(io);
|
|
|
|
g_at_chat_set_debug(chat, mux_debug, "CHAT1");
|
|
g_at_chat_set_wakeup_command(chat, "\r", 1000, 5000);
|
|
g_at_chat_send(chat, "AT+CGMI", NULL, NULL, NULL, NULL);
|
|
g_at_chat_send(chat, "AT+CGMR", NULL, chat_callback, chat, NULL);
|
|
|
|
io = g_at_mux_create_channel(mux);
|
|
syntax = g_at_syntax_new_gsm_permissive();
|
|
chat = g_at_chat_new(io, syntax);
|
|
g_at_syntax_unref(syntax);
|
|
g_io_channel_unref(io);
|
|
|
|
g_at_chat_set_debug(chat, mux_debug, "CHAT2");
|
|
g_at_chat_set_wakeup_command(chat, "\r", 1000, 5000);
|
|
g_at_chat_send(chat, "AT+CGMI", NULL, NULL, NULL, NULL);
|
|
g_at_chat_send(chat, "AT+CGMR", NULL, chat_callback, chat, NULL);
|
|
|
|
io = g_at_mux_create_channel(mux);
|
|
syntax = g_at_syntax_new_gsm_permissive();
|
|
chat = g_at_chat_new(io, syntax);
|
|
g_at_syntax_unref(syntax);
|
|
g_io_channel_unref(io);
|
|
|
|
g_at_chat_set_debug(chat, mux_debug, "CHAT3");
|
|
g_at_chat_set_wakeup_command(chat, "\r", 1000, 5000);
|
|
g_at_chat_send(chat, "AT+CGMI", NULL, NULL, NULL, NULL);
|
|
g_at_chat_send(chat, "AT+CGMR", NULL, chat_callback, chat, NULL);
|
|
|
|
io = g_at_mux_create_channel(mux);
|
|
syntax = g_at_syntax_new_gsm_permissive();
|
|
chat = g_at_chat_new(io, syntax);
|
|
g_at_syntax_unref(syntax);
|
|
g_io_channel_unref(io);
|
|
|
|
g_at_chat_set_debug(chat, mux_debug, "CHAT4");
|
|
g_at_chat_set_wakeup_command(chat, "\r", 1000, 5000);
|
|
g_at_chat_send(chat, "AT+CGMI", NULL, NULL, NULL, NULL);
|
|
g_at_chat_send(chat, "AT+CGMR", NULL, chat_callback, chat, NULL);
|
|
|
|
g_timeout_add_seconds(7, cleanup_callback, NULL);
|
|
}
|
|
|
|
static void mux_init(gboolean ok, GAtResult *result, gpointer data)
|
|
{
|
|
GAtChat *chat = data;
|
|
|
|
g_print("mux_init: %d\n", ok);
|
|
|
|
if (ok == FALSE) {
|
|
g_at_chat_unref(chat);
|
|
g_main_loop_quit(mainloop);
|
|
return;
|
|
}
|
|
|
|
g_at_mux_setup_gsm0710(chat, mux_setup, chat, NULL);
|
|
}
|
|
|
|
static void test_mux(void)
|
|
{
|
|
GIOChannel *io;
|
|
GAtChat *chat;
|
|
GAtSyntax *syntax;
|
|
int sk;
|
|
|
|
sk = do_connect("192.168.0.202", 2000);
|
|
if (sk < 0) {
|
|
g_printerr("connect failed\n");
|
|
return;
|
|
}
|
|
|
|
mux = NULL;
|
|
io = g_io_channel_unix_new(sk);
|
|
g_io_channel_set_close_on_unref(io, TRUE);
|
|
|
|
syntax = g_at_syntax_new_gsm_permissive();
|
|
chat = g_at_chat_new(io, syntax);
|
|
g_at_syntax_unref(syntax);
|
|
|
|
g_io_channel_unref(io);
|
|
|
|
if (chat == NULL) {
|
|
g_printerr("Chat creation failed\n");
|
|
return;
|
|
}
|
|
|
|
g_at_chat_set_debug(chat, mux_debug, "MUX");
|
|
g_at_chat_set_wakeup_command(chat, "\r", 1000, 5000);
|
|
g_at_chat_send(chat, "ATE0", NULL, mux_init, chat, NULL);
|
|
|
|
mainloop = g_main_loop_new(NULL, FALSE);
|
|
|
|
g_main_loop_run(mainloop);
|
|
g_main_loop_unref(mainloop);
|
|
}
|
|
|
|
static void test_basic(void)
|
|
{
|
|
if (g_test_trap_fork(60 * 1000 * 1000, 0) == TRUE) {
|
|
test_mux();
|
|
exit(0);
|
|
}
|
|
|
|
g_test_trap_assert_passed();
|
|
//g_test_trap_assert_stderr("failed");
|
|
}
|
|
|
|
/* DLC 1, Open Channel */
|
|
static const guint8 basic_open[] = { 0xF9, 0x07, 0x3F, 0x01, 0xDE, 0xF9 };
|
|
|
|
/* DLC 1, Close Channel */
|
|
static char const basic_close[] = { 0xF9, 0x07, 0x53, 0x01, 0x3F, 0xF9 };
|
|
|
|
/* DLC 1, Data */
|
|
static const guint8 basic_data[] = { 0x12, 0x34, 0x56 };
|
|
static const guint8 basic_data_result[] =
|
|
{ 0xF9, 0x07, 0xEF, 0x07, 0x12, 0x34, 0x56, 0xD3, 0xF9 };
|
|
|
|
/* DLC 1, Long Data */
|
|
static const guint8 basic_long_frame[] =
|
|
{ 0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0,
|
|
};
|
|
|
|
static const guint8 basic_long_frame_result[] =
|
|
{ 0xF9, 0x07, 0xEF, 0x10, 0x01, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x12, 0x34, 0x56,
|
|
0x78, 0x9A, 0xBC, 0xDE, 0xF0, 0x88, 0xF9
|
|
};
|
|
|
|
static void test_fill_basic(void)
|
|
{
|
|
guint8 control_frame[6];
|
|
guint8 data_frame[128];
|
|
guint8 long_frame[256];
|
|
int s;
|
|
|
|
s = gsm0710_basic_fill_frame(control_frame, 1, GSM0710_OPEN_CHANNEL,
|
|
NULL, 0);
|
|
g_assert(s == sizeof(basic_open));
|
|
g_assert(memcmp(basic_open, control_frame, s) == 0);
|
|
|
|
s = gsm0710_basic_fill_frame(control_frame, 1, GSM0710_CLOSE_CHANNEL,
|
|
NULL, 0);
|
|
g_assert(s == sizeof(basic_close));
|
|
g_assert(memcmp(basic_close, control_frame, s) == 0);
|
|
|
|
s = gsm0710_basic_fill_frame(data_frame, 1, GSM0710_DATA,
|
|
basic_data, sizeof(basic_data));
|
|
g_assert(s == sizeof(basic_data_result));
|
|
g_assert(memcmp(basic_data_result, data_frame, s) == 0);
|
|
|
|
s = gsm0710_basic_fill_frame(long_frame, 1, GSM0710_DATA,
|
|
basic_long_frame,
|
|
sizeof(basic_long_frame));
|
|
g_assert(s == sizeof(basic_long_frame_result));
|
|
g_assert(memcmp(basic_long_frame_result, long_frame, s) == 0);
|
|
}
|
|
|
|
/* DLC 1, Open Channel */
|
|
static const guint8 advanced_open[] = { 0x7E, 0x07, 0x3F, 0x89, 0x7E };
|
|
|
|
/* DLC 1, Close Channel */
|
|
static const guint8 advanced_close[] = { 0x7E, 0x07, 0x53, 0xC8, 0x7E };
|
|
|
|
/* DLC 1, Data */
|
|
static const guint8 advanced_data[] = { 0x12, 0x34, 0x56 };
|
|
static const guint8 advanced_data_result[] =
|
|
{ 0x7E, 0x07, 0xEF, 0x12, 0x34, 0x56, 0x05, 0x7E };
|
|
|
|
/* DLC 1, Quoted data */
|
|
static const guint8 advanced_quoted_data[] =
|
|
{ 0x12, 0x34, 0x56, 0x7E, 0x78, 0x7D };
|
|
static const guint8 advanced_quoted_data_result[] =
|
|
{ 0x7E, 0x07, 0xEF, 0x12, 0x34, 0x56, 0x7D, 0x5E, 0x78,
|
|
0x7D, 0x5D, 0x05, 0x7E };
|
|
|
|
static void test_fill_advanced(void)
|
|
{
|
|
guint8 control_frame[8];
|
|
guint8 data_frame[128];
|
|
int s;
|
|
|
|
s = gsm0710_advanced_fill_frame(control_frame, 1, GSM0710_OPEN_CHANNEL,
|
|
NULL, 0);
|
|
g_assert(s == sizeof(advanced_open));
|
|
g_assert(memcmp(advanced_open, control_frame, s) == 0);
|
|
|
|
s = gsm0710_advanced_fill_frame(control_frame, 1, GSM0710_CLOSE_CHANNEL,
|
|
NULL, 0);
|
|
g_assert(s == sizeof(advanced_close));
|
|
g_assert(memcmp(advanced_close, control_frame, s) == 0);
|
|
|
|
s = gsm0710_advanced_fill_frame(data_frame, 1, GSM0710_DATA,
|
|
advanced_data, sizeof(advanced_data));
|
|
g_assert(s == sizeof(advanced_data_result));
|
|
g_assert(memcmp(advanced_data_result, data_frame, s) == 0);
|
|
|
|
s = gsm0710_advanced_fill_frame(data_frame, 1, GSM0710_DATA,
|
|
advanced_quoted_data,
|
|
sizeof(advanced_quoted_data));
|
|
g_assert(s == sizeof(advanced_quoted_data_result));
|
|
g_assert(memcmp(advanced_quoted_data_result, data_frame, s) == 0);
|
|
}
|
|
|
|
static guint8 basic_input[] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xF9, 0x07, 0xEF,
|
|
0x07, 0x12, 0x34, 0x56, 0xD3, 0xF9, 0x07, 0xEF, 0x07, 0x12, 0x34, 0x56,
|
|
0xD3, 0xF9 };
|
|
|
|
static guint8 basic_input2[] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xF9, 0x07, 0xEF,
|
|
0x07, 0x12, 0x34, 0x56, 0xD3, 0xF9, 0xF9, 0x07, 0xEF, 0x07, 0x12,
|
|
0x34, 0x56, 0xD3, 0xF9 };
|
|
|
|
static int basic_garbage_size = 4;
|
|
static int basic_frame_size = 7;
|
|
|
|
static const guint8 basic_output[] = { 0x12, 0x34, 0x56 };
|
|
|
|
static void test_extract_basic(void)
|
|
{
|
|
int total = 0;
|
|
int nread;
|
|
guint8 dlc;
|
|
guint8 ctrl;
|
|
guint8 *frame;
|
|
int frame_size;
|
|
|
|
frame = NULL;
|
|
frame_size = 0;
|
|
|
|
nread = gsm0710_basic_extract_frame(basic_input + total,
|
|
basic_garbage_size, &dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(frame == NULL);
|
|
g_assert(frame_size == 0);
|
|
|
|
total += nread;
|
|
|
|
/* Try to read with just the open flag */
|
|
nread = gsm0710_basic_extract_frame(basic_input + total,
|
|
basic_frame_size + 1,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(nread == 0);
|
|
g_assert(frame == NULL);
|
|
|
|
/* Now read with the close flag as well */
|
|
nread = gsm0710_basic_extract_frame(basic_input + total,
|
|
basic_frame_size + 2,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
/* Extracted the open flag + frame */
|
|
g_assert(nread == basic_frame_size + 1);
|
|
g_assert(frame_size == sizeof(basic_output));
|
|
g_assert(memcmp(basic_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
nread = gsm0710_basic_extract_frame(basic_input + total,
|
|
sizeof(basic_input) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(nread == (int)(sizeof(basic_input) - total - 1));
|
|
g_assert(frame_size == sizeof(basic_output));
|
|
g_assert(memcmp(basic_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
nread = gsm0710_basic_extract_frame(basic_input + total,
|
|
sizeof(basic_input) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
g_assert(nread == 0);
|
|
|
|
total = 0;
|
|
|
|
nread = gsm0710_basic_extract_frame(basic_input2 + total,
|
|
sizeof(basic_input2) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(nread == basic_garbage_size + basic_frame_size + 1);
|
|
g_assert(frame_size == sizeof(basic_output));
|
|
g_assert(memcmp(basic_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
nread = gsm0710_basic_extract_frame(basic_input2 + total,
|
|
sizeof(basic_input2) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(frame_size == sizeof(basic_output));
|
|
g_assert(memcmp(basic_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
g_assert(total == sizeof(basic_input2) - 1);
|
|
}
|
|
|
|
static guint8 advanced_input[] =
|
|
{ 0xFF, 0xFF, 0xFF, 0x7E, 0x07, 0xEF, 0x12, 0x34, 0x56, 0x05, 0x7E,
|
|
0x07, 0xEF, 0x12, 0x34, 0x56, 0x05, 0x7E };
|
|
|
|
static guint8 advanced_input2[] =
|
|
{ 0xFF, 0xFF, 0xFF, 0x7E, 0x07, 0xEF, 0x12, 0x34, 0x56, 0x05, 0x7E,
|
|
0x07, 0xEF, 0x12, 0x34, 0x56, 0x05, 0x7E };
|
|
|
|
static int advanced_garbage_size = 3;
|
|
static int advanced_frame_size = 6;
|
|
|
|
static const guint8 advanced_output[] = { 0x12, 0x34, 0x56 };
|
|
|
|
static void test_extract_advanced(void)
|
|
{
|
|
int total = 0;
|
|
int nread;
|
|
guint8 dlc;
|
|
guint8 ctrl;
|
|
guint8 *frame;
|
|
int frame_size;
|
|
|
|
frame = NULL;
|
|
frame_size = 0;
|
|
|
|
nread = gsm0710_advanced_extract_frame(advanced_input + total,
|
|
advanced_garbage_size,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(frame == NULL);
|
|
g_assert(frame_size == 0);
|
|
|
|
total += nread;
|
|
|
|
/* Try to read with just the open flag */
|
|
nread = gsm0710_advanced_extract_frame(advanced_input + total,
|
|
advanced_frame_size + 1,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(nread == 0);
|
|
g_assert(frame == NULL);
|
|
|
|
/* Now read with the close flag as well */
|
|
nread = gsm0710_advanced_extract_frame(advanced_input + total,
|
|
advanced_frame_size + 2,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
/* Extracted the open flag + frame */
|
|
g_assert(nread == advanced_frame_size + 1);
|
|
g_assert(frame_size == sizeof(advanced_output));
|
|
g_assert(memcmp(advanced_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
nread = gsm0710_advanced_extract_frame(advanced_input + total,
|
|
sizeof(advanced_input) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(nread == (int)(sizeof(advanced_input) - total - 1));
|
|
g_assert(frame_size == sizeof(advanced_output));
|
|
g_assert(memcmp(advanced_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
nread = gsm0710_advanced_extract_frame(advanced_input + total,
|
|
sizeof(advanced_input) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
g_assert(nread == 0);
|
|
|
|
total = 0;
|
|
|
|
nread = gsm0710_advanced_extract_frame(advanced_input2 + total,
|
|
sizeof(advanced_input2) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(nread == advanced_garbage_size + advanced_frame_size + 1);
|
|
g_assert(frame_size == sizeof(advanced_output));
|
|
g_assert(memcmp(advanced_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
nread = gsm0710_advanced_extract_frame(advanced_input2 + total,
|
|
sizeof(advanced_input2) - total,
|
|
&dlc, &ctrl,
|
|
&frame, &frame_size);
|
|
|
|
g_assert(frame_size == sizeof(advanced_output));
|
|
g_assert(memcmp(advanced_output, frame, frame_size) == 0);
|
|
|
|
total += nread;
|
|
|
|
g_assert(total == sizeof(advanced_input2) - 1);
|
|
}
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
g_test_init(&argc, &argv, NULL);
|
|
|
|
g_test_add_func("/testmux/fill_basic", test_fill_basic);
|
|
g_test_add_func("/testmux/fill_advanced", test_fill_advanced);
|
|
g_test_add_func("/testmux/extract_basic", test_extract_basic);
|
|
g_test_add_func("/testmux/extract_advanced", test_extract_advanced);
|
|
g_test_add_func("/testmux/basic", test_basic);
|
|
|
|
return g_test_run();
|
|
}
|