blob: 85e135673cd6ac5392a72128ca71bd3461cd73a1 [file] [log] [blame]
/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2014 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 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 St, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#include <unistd.h>
#include <stdlib.h>
#include <stdbool.h>
#include <inttypes.h>
#include <string.h>
#include <fcntl.h>
#include <sys/socket.h>
#include <glib.h>
#include "src/shared/uhid.h"
#include "src/shared/util.h"
struct test_pdu {
bool valid;
const uint8_t *data;
size_t size;
};
struct test_data {
char *test_name;
struct test_pdu *pdu_list;
};
struct context {
GMainLoop *main_loop;
struct bt_uhid *uhid;
guint source;
guint process;
int fd;
unsigned int pdu_offset;
const struct test_data *data;
};
#define event(args...) \
{ \
.valid = true, \
.data = (void *) args, \
.size = sizeof(*args), \
}
#define define_test(name, function, args...) \
do { \
const struct test_pdu pdus[] = { \
args, { } \
}; \
static struct test_data data; \
data.test_name = g_strdup(name); \
data.pdu_list = g_malloc(sizeof(pdus)); \
memcpy(data.pdu_list, pdus, sizeof(pdus)); \
g_test_add_data_func(name, &data, function); \
} while (0)
static void test_debug(const char *str, void *user_data)
{
const char *prefix = user_data;
g_print("%s%s\n", prefix, str);
}
static void test_free(gconstpointer user_data)
{
const struct test_data *data = user_data;
g_free(data->test_name);
g_free(data->pdu_list);
}
static gboolean context_quit(gpointer user_data)
{
struct context *context = user_data;
if (context->process > 0)
g_source_remove(context->process);
g_main_loop_quit(context->main_loop);
return FALSE;
}
static gboolean send_pdu(gpointer user_data)
{
struct context *context = user_data;
const struct test_pdu *pdu;
ssize_t len;
pdu = &context->data->pdu_list[context->pdu_offset++];
len = write(context->fd, pdu->data, pdu->size);
if (g_test_verbose())
util_hexdump('<', pdu->data, len, test_debug, "uHID: ");
g_assert_cmpint(len, ==, pdu->size);
context->process = 0;
return FALSE;
}
static void context_process(struct context *context)
{
if (!context->data->pdu_list[context->pdu_offset].valid) {
context_quit(context);
return;
}
context->process = g_idle_add(send_pdu, context);
}
static gboolean test_handler(GIOChannel *channel, GIOCondition cond,
gpointer user_data)
{
struct context *context = user_data;
const struct test_pdu *pdu;
unsigned char buf[sizeof(struct uhid_event)];
ssize_t len;
int fd;
pdu = &context->data->pdu_list[context->pdu_offset++];
if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
context->source = 0;
g_print("%s: cond %x\n", __func__, cond);
return FALSE;
}
fd = g_io_channel_unix_get_fd(channel);
len = read(fd, buf, sizeof(buf));
g_assert(len > 0);
if (g_test_verbose())
util_hexdump('>', buf, len, test_debug, "uHID: ");
g_assert_cmpint(len, ==, pdu->size);
g_assert(memcmp(buf, pdu->data, pdu->size) == 0);
context_process(context);
return TRUE;
}
static struct context *create_context(gconstpointer data)
{
struct context *context = g_new0(struct context, 1);
GIOChannel *channel;
int err, sv[2];
context->main_loop = g_main_loop_new(NULL, FALSE);
g_assert(context->main_loop);
err = socketpair(AF_UNIX, SOCK_SEQPACKET | SOCK_CLOEXEC, 0, sv);
g_assert(err == 0);
context->uhid = bt_uhid_new(sv[0]);
g_assert(context->uhid != NULL);
channel = g_io_channel_unix_new(sv[1]);
g_io_channel_set_close_on_unref(channel, TRUE);
g_io_channel_set_encoding(channel, NULL, NULL);
g_io_channel_set_buffered(channel, FALSE);
context->source = g_io_add_watch(channel,
G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
test_handler, context);
g_assert(context->source > 0);
g_io_channel_unref(channel);
context->fd = sv[1];
context->data = data;
return context;
}
static void destroy_context(struct context *context)
{
if (context->source > 0)
g_source_remove(context->source);
bt_uhid_unref(context->uhid);
g_main_loop_unref(context->main_loop);
test_free(context->data);
g_free(context);
}
static void execute_context(struct context *context)
{
g_main_loop_run(context->main_loop);
destroy_context(context);
}
static const struct uhid_event ev_create = {
.type = UHID_CREATE,
};
static const struct uhid_event ev_destroy = {
.type = UHID_DESTROY,
};
static const struct uhid_event ev_feature_answer = {
.type = UHID_FEATURE_ANSWER,
};
static const struct uhid_event ev_input = {
.type = UHID_INPUT,
};
static const struct uhid_event ev_output = {
.type = UHID_OUTPUT,
};
static const struct uhid_event ev_feature = {
.type = UHID_FEATURE,
};
static void test_client(gconstpointer data)
{
struct context *context = create_context(data);
if (g_str_equal(context->data->test_name, "/uhid/command/create"))
bt_uhid_send(context->uhid, &ev_create);
if (g_str_equal(context->data->test_name, "/uhid/command/destroy"))
bt_uhid_send(context->uhid, &ev_destroy);
if (g_str_equal(context->data->test_name,
"/uhid/command/feature_answer"))
bt_uhid_send(context->uhid, &ev_feature_answer);
if (g_str_equal(context->data->test_name, "/uhid/command/input"))
bt_uhid_send(context->uhid, &ev_input);
execute_context(context);
}
static void handle_output(struct uhid_event *ev, void *user_data)
{
g_assert_cmpint(ev->type, ==, UHID_OUTPUT);
context_quit(user_data);
}
static void handle_feature(struct uhid_event *ev, void *user_data)
{
g_assert_cmpint(ev->type, ==, UHID_FEATURE);
context_quit(user_data);
}
static void test_server(gconstpointer data)
{
struct context *context = create_context(data);
bt_uhid_register(context->uhid, UHID_OUTPUT, handle_output, context);
bt_uhid_register(context->uhid, UHID_FEATURE, handle_feature, context);
g_idle_add(send_pdu, context);
execute_context(context);
}
int main(int argc, char *argv[])
{
g_test_init(&argc, &argv, NULL);
define_test("/uhid/command/create", test_client, event(&ev_create));
define_test("/uhid/command/destroy", test_client, event(&ev_destroy));
define_test("/uhid/command/feature_answer", test_client,
event(&ev_feature_answer));
define_test("/uhid/command/input", test_client, event(&ev_input));
define_test("/uhid/event/output", test_server, event(&ev_output));
define_test("/uhid/event/feature", test_server, event(&ev_feature));
return g_test_run();
}