| // 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 <config.h> |
| #endif |
| |
| #define _GNU_SOURCE |
| #include <unistd.h> |
| #include <string.h> |
| #include <sys/socket.h> |
| #include <fcntl.h> |
| |
| #include <glib.h> |
| |
| #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, 0, 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(); |
| } |
