// SPDX-License-Identifier: GPL-2.0-or-later /* * * BlueZ - Bluetooth protocol stack for Linux * * Copyright (C) 2015 Intel Corporation. All rights reserved. * * */ #ifdef HAVE_CONFIG_H #include #endif #define _GNU_SOURCE #include #include #include #include #include #include "lib/bluetooth.h" #include "lib/uuid.h" #include "src/shared/util.h" #include "src/shared/tester.h" #include "src/shared/queue.h" #include "src/shared/att.h" #include "src/shared/gatt-db.h" #include "attrib/gattrib.h" #include "profiles/input/hog-lib.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 { GAttrib *attrib; struct bt_hog *hog; guint source; guint process; int fd; unsigned int pdu_offset; const struct test_data *data; }; #define data(args...) ((const unsigned char[]) { args }) #define raw_pdu(args...) \ { \ .valid = true, \ .data = util_memdup(data(args), sizeof(data(args))), \ .size = sizeof(data(args)), \ } #define false_pdu() \ { \ .valid = false, \ } #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 = util_memdup(pdus, sizeof(pdus));\ tester_add(name, &data, NULL, function, NULL); \ } while (0) static gboolean context_quit(gpointer user_data) { struct context *context = user_data; if (context->process > 0) g_source_remove(context->process); if (context->source > 0) g_source_remove(context->source); bt_hog_unref(context->hog); g_attrib_unref(context->attrib); g_free(context); tester_test_passed(); 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); tester_monitor('<', 0x0004, 0x0000, pdu->data, len); g_assert_cmpint(len, ==, pdu->size); context->process = 0; if (!context->data->pdu_list[context->pdu_offset].valid) context_quit(context); return FALSE; } static gboolean test_handler(GIOChannel *channel, GIOCondition cond, gpointer user_data) { struct context *context = user_data; unsigned char buf[512]; const struct test_pdu *pdu; 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); tester_monitor('>', 0x0004, 0x0000, buf, len); g_assert_cmpint(len, ==, pdu->size); g_assert(memcmp(buf, pdu->data, pdu->size) == 0); context->process = g_idle_add(send_pdu, context); return TRUE; } static struct context *create_context(gconstpointer data) { struct context *context; GIOChannel *channel, *att_io; int err, sv[2], fd; char name[] = "bluez-hog"; uint16_t vendor = 0x0002; uint16_t product = 0x0001; uint16_t version = 0x0001; context = g_new0(struct context, 1); err = socketpair(AF_UNIX, SOCK_SEQPACKET | SOCK_CLOEXEC, 0, sv); g_assert(err == 0); att_io = g_io_channel_unix_new(sv[0]); g_io_channel_set_close_on_unref(att_io, TRUE); context->attrib = g_attrib_new(att_io, 23, false); g_assert(context->attrib); g_io_channel_unref(att_io); fd = open("/dev/null", O_WRONLY | O_CLOEXEC); g_assert(fd > 0); context->hog = bt_hog_new(fd, name, vendor, product, version, NULL); g_assert(context->hog); 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 test_hog(gconstpointer data) { struct context *context = create_context(data); g_assert(bt_hog_attach(context->hog, context->attrib)); } int main(int argc, char *argv[]) { tester_init(&argc, &argv); define_test("/TP/HGRF/RH/BV-01-I", test_hog, raw_pdu(0x10, 0x01, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x11, 0x06, 0x01, 0x00, 0x04, 0x00, 0x12, 0x18, 0x05, 0x00, 0x08, 0x00, 0x12, 0x18), raw_pdu(0x10, 0x09, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x01, 0x10, 0x09, 0x00, 0x0a), raw_pdu(0x08, 0x01, 0x00, 0x04, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x03, 0x00, 0x02, 0x04, 0x00, 0x4b, 0x2a), raw_pdu(0x08, 0x01, 0x00, 0x04, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x01, 0x00, 0x0a), raw_pdu(0x08, 0x05, 0x00, 0x08, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x05, 0x00, 0x0a), raw_pdu(0x08, 0x05, 0x00, 0x08, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x07, 0x00, 0x02, 0x08, 0x00, 0x4b, 0x2a), raw_pdu(0x0a, 0x04, 0x00), raw_pdu(0x0b, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16), raw_pdu(0x0c, 0x04, 0x00, 0x16, 0x00), raw_pdu(0x0d, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16), raw_pdu(0x0c, 0x04, 0x00, 0x2c, 0x00), raw_pdu(0x0d, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13), raw_pdu(0x0a, 0x08, 0x00), raw_pdu(0x0b, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16), raw_pdu(0x0c, 0x08, 0x00, 0x16, 0x00), raw_pdu(0x0d, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16), raw_pdu(0x0c, 0x08, 0x00, 0x2c, 0x00), raw_pdu(0x0d, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13)); define_test("/TP/HGRF/RH/BV-08-I", test_hog, raw_pdu(0x10, 0x01, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x11, 0x06, 0x01, 0x00, 0x05, 0x00, 0x12, 0x18, 0x06, 0x00, 0x0a, 0x00, 0x12, 0x18), raw_pdu(0x10, 0x0b, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x01, 0x10, 0x0b, 0x00, 0x0a), raw_pdu(0x08, 0x01, 0x00, 0x05, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x03, 0x00, 0x0a, 0x04, 0x00, 0x4d, 0x2a), raw_pdu(0x08, 0x01, 0x00, 0x05, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x01, 0x00, 0x0a), raw_pdu(0x08, 0x06, 0x00, 0x0a, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x06, 0x00, 0x0a), raw_pdu(0x08, 0x06, 0x00, 0x0a, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x08, 0x00, 0x0a, 0x09, 0x00, 0x4d, 0x2a), raw_pdu(0x08, 0x04, 0x00, 0x05, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x04, 0x00, 0x0a), raw_pdu(0x08, 0x09, 0x00, 0x0a, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x09, 0x00, 0x0a), raw_pdu(0x0a, 0x04, 0x00), raw_pdu(0x0b, 0xee, 0xee, 0xff, 0xff), raw_pdu(0x04, 0x05, 0x00, 0x05, 0x00), raw_pdu(0x05, 0x01, 0x05, 0x00, 0x08, 0x29), raw_pdu(0x0a, 0x09, 0x00), raw_pdu(0x0b, 0xff, 0xff, 0xee, 0xee), raw_pdu(0x04, 0x0a, 0x00, 0x0a, 0x00), raw_pdu(0x05, 0x01, 0x0a, 0x00, 0x08, 0x29), raw_pdu(0x0a, 0x05, 0x00), raw_pdu(0x0b, 0x01, 0x03), raw_pdu(0x0a, 0x0a, 0x00), raw_pdu(0x0b, 0x02, 0x03)); define_test("/TP/HGRF/RH/BV-09-I", test_hog, raw_pdu(0x10, 0x01, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x11, 0x06, 0x01, 0x00, 0x04, 0x00, 0x12, 0x18, 0x05, 0x00, 0x08, 0x00, 0x12, 0x18), raw_pdu(0x10, 0x09, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x01, 0x10, 0x09, 0x00, 0x0a), raw_pdu(0x08, 0x01, 0x00, 0x04, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x03, 0x00, 0x02, 0x04, 0x00, 0x4a, 0x2a), raw_pdu(0x08, 0x01, 0x00, 0x04, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x01, 0x00, 0x0a), raw_pdu(0x08, 0x05, 0x00, 0x08, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x05, 0x00, 0x0a), raw_pdu(0x08, 0x05, 0x00, 0x08, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x07, 0x00, 0x02, 0x08, 0x00, 0x4a, 0x2a), raw_pdu(0x0a, 0x04, 0x00), raw_pdu(0x0b, 0x01, 0x11, 0x00, 0x01), raw_pdu(0x0a, 0x08, 0x00), raw_pdu(0x0b, 0x01, 0x11, 0x00, 0x01)); define_test("/TP/HGRF/RH/BV-06-I", test_hog, raw_pdu(0x10, 0x01, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x11, 0x06, 0x01, 0x00, 0x05, 0x00, 0x12, 0x18, 0x06, 0x00, 0x0a, 0x00, 0x12, 0x18), raw_pdu(0x10, 0x0b, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x01, 0x10, 0x0b, 0x00, 0x0a), raw_pdu(0x08, 0x01, 0x00, 0x05, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x03, 0x00, 0x0a, 0x04, 0x00, 0x4d, 0x2a), raw_pdu(0x08, 0x01, 0x00, 0x05, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x01, 0x00, 0x0a), raw_pdu(0x08, 0x06, 0x00, 0x0a, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x06, 0x00, 0x0a), raw_pdu(0x08, 0x06, 0x00, 0x0a, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x08, 0x00, 0x0a, 0x09, 0x00, 0x4d, 0x2a), raw_pdu(0x08, 0x04, 0x00, 0x05, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x05, 0x00, 0x0a), raw_pdu(0x08, 0x09, 0x00, 0x0a, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x09, 0x00, 0x0a), raw_pdu(0x0a, 0x04, 0x00), raw_pdu(0x0b, 0xee, 0xee, 0xff, 0xff), raw_pdu(0x04, 0x05, 0x00, 0x05, 0x00), raw_pdu(0x05, 0x01, 0x05, 0x00, 0x08, 0x29), raw_pdu(0x0a, 0x09, 0x00), raw_pdu(0x0b, 0xff, 0xff, 0xee, 0xee), raw_pdu(0x04, 0x0a, 0x00, 0x0a, 0x00), raw_pdu(0x05, 0x01, 0x0a, 0x00, 0x08, 0x29), raw_pdu(0x0a, 0x05, 0x00), raw_pdu(0x0b, 0x01, 0x02), raw_pdu(0x0a, 0x0a, 0x00), raw_pdu(0x0b, 0x02, 0x02)); define_test("/TP/HGCF/RH/BV-01-I", test_hog, raw_pdu(0x10, 0x01, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x11, 0x06, 0x01, 0x00, 0x06, 0x00, 0x12, 0x18, 0x07, 0x00, 0x0c, 0x00, 0x12, 0x18), raw_pdu(0x10, 0x0d, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x01, 0x10, 0x0d, 0x00, 0x0a), raw_pdu(0x08, 0x01, 0x00, 0x06, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x03, 0x00, 0x1a, 0x04, 0x00, 0x4d, 0x2a), raw_pdu(0x08, 0x01, 0x00, 0x06, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x01, 0x00, 0x0a), raw_pdu(0x08, 0x07, 0x00, 0x0c, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x07, 0x00, 0x0a), raw_pdu(0x08, 0x07, 0x00, 0x0c, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x09, 0x00, 0x1a, 0x0a, 0x00, 0x4d, 0x2a), raw_pdu(0x08, 0x04, 0x00, 0x06, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x04, 0x00, 0x0a), raw_pdu(0x08, 0x0a, 0x00, 0x0c, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x0a, 0x00, 0x0a), raw_pdu(0x0a, 0x04, 0x00), raw_pdu(0x0b, 0xed, 0x00), raw_pdu(0x04, 0x05, 0x00, 0x06, 0x00), raw_pdu(0x05, 0x01, 0x05, 0x00, 0x02, 0x29, 0x06, 0x00, 0x08, 0x29), raw_pdu(0x0a, 0x0a, 0x00), raw_pdu(0x0b, 0xed, 0x00), raw_pdu(0x04, 0x0b, 0x00, 0x0c, 0x00), raw_pdu(0x05, 0x01, 0x0b, 0x00, 0x02, 0x29, 0x0c, 0x00, 0x08, 0x29), raw_pdu(0x0a, 0x06, 0x00), raw_pdu(0x0b, 0x01, 0x01), raw_pdu(0x0a, 0x0c, 0x00), raw_pdu(0x0b, 0x02, 0x01), raw_pdu(0x0a, 0x05, 0x00), raw_pdu(0x0b, 0x00, 0x00), raw_pdu(0x0a, 0x0b, 0x00), raw_pdu(0x0b, 0x00, 0x00), raw_pdu(0x12, 0x05, 0x00, 0x01, 0x00), raw_pdu(0x13), raw_pdu(0x12, 0x0b, 0x00, 0x01, 0x00), raw_pdu(0x13)); define_test("/TP/HGRF/RH/BV-02-I", test_hog, raw_pdu(0x10, 0x01, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x11, 0x06, 0x01, 0x00, 0x05, 0x00, 0x12, 0x18, 0x06, 0x00, 0x0a, 0x00, 0x12, 0x18), raw_pdu(0x10, 0x0b, 0x00, 0xff, 0xff, 0x00, 0x28), raw_pdu(0x01, 0x10, 0x0b, 0x00, 0x0a), raw_pdu(0x08, 0x01, 0x00, 0x05, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x03, 0x00, 0x02, 0x04, 0x00, 0x4b, 0x2a), raw_pdu(0x08, 0x01, 0x00, 0x05, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x01, 0x00, 0x0a), raw_pdu(0x08, 0x06, 0x00, 0x0a, 0x00, 0x02, 0x28), raw_pdu(0x01, 0x08, 0x06, 0x00, 0x0a), raw_pdu(0x08, 0x06, 0x00, 0x0a, 0x00, 0x03, 0x28), raw_pdu(0x09, 0x07, 0x08, 0x00, 0x02, 0x09, 0x00, 0x4b, 0x2a), raw_pdu(0x08, 0x04, 0x00, 0x05, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x04, 0x00, 0x0a), raw_pdu(0x08, 0x09, 0x00, 0x0a, 0x00, 0x03, 0x28), raw_pdu(0x01, 0x08, 0x09, 0x00, 0x0a), raw_pdu(0x0a, 0x04, 0x00), raw_pdu(0x0b, 0x01, 0x02, 0x03), raw_pdu(0x04, 0x05, 0x00, 0x05, 0x00), raw_pdu(0x05, 0x01, 0x05, 0x00, 0x07, 0x29), raw_pdu(0x0a, 0x09, 0x00), raw_pdu(0x0b, 0x01, 0x02, 0x03), raw_pdu(0x04, 0x0a, 0x00, 0x0a, 0x00), raw_pdu(0x05, 0x01, 0x0a, 0x00, 0x07, 0x29), raw_pdu(0x0a, 0x05, 0x00), raw_pdu(0x0b, 0x19, 0x2a), raw_pdu(0x0a, 0x0a, 0x00), raw_pdu(0x0b, 0x19, 0x2a)); return tester_run(); }