From 5d0980820108d7d4a598ab540986039bd2847044 Mon Sep 17 00:00:00 2001 From: Johan Hedberg Date: Tue, 5 Nov 2013 11:33:27 +0200 Subject: [PATCH] tools: Add smp-tester for automated LE SMP end-to-end tests --- Makefile.tools | 12 +- tools/smp-tester.c | 352 +++++++++++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 363 insertions(+), 1 deletion(-) create mode 100644 tools/smp-tester.c diff --git a/Makefile.tools b/Makefile.tools index 840b95cbe..78034f5a5 100644 --- a/Makefile.tools +++ b/Makefile.tools @@ -33,7 +33,8 @@ endif if EXPERIMENTAL noinst_PROGRAMS += emulator/btvirt emulator/b1ee \ tools/mgmt-tester tools/gap-tester \ - tools/l2cap-tester tools/sco-tester + tools/l2cap-tester tools/sco-tester \ + tools/smp-tester emulator_btvirt_SOURCES = emulator/main.c monitor/bt.h \ monitor/mainloop.h monitor/mainloop.c \ @@ -63,6 +64,15 @@ tools_l2cap_tester_SOURCES = tools/l2cap-tester.c monitor/bt.h \ src/shared/tester.h src/shared/tester.c tools_l2cap_tester_LDADD = lib/libbluetooth-internal.la @GLIB_LIBS@ +tools_smp_tester_SOURCES = tools/smp-tester.c monitor/bt.h \ + emulator/btdev.h emulator/btdev.c \ + emulator/bthost.h emulator/bthost.c \ + src/shared/util.h src/shared/util.c \ + src/shared/mgmt.h src/shared/mgmt.c \ + src/shared/hciemu.h src/shared/hciemu.c \ + src/shared/tester.h src/shared/tester.c +tools_smp_tester_LDADD = lib/libbluetooth-internal.la @GLIB_LIBS@ + tools_gap_tester_SOURCES = tools/gap-tester.c monitor/bt.h \ emulator/btdev.h emulator/btdev.c \ emulator/bthost.h emulator/bthost.c \ diff --git a/tools/smp-tester.c b/tools/smp-tester.c new file mode 100644 index 000000000..8a4fb448c --- /dev/null +++ b/tools/smp-tester.c @@ -0,0 +1,352 @@ +/* + * + * BlueZ - Bluetooth protocol stack for Linux + * + * Copyright (C) 2013 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 +#endif + +#include +#include +#include +#include + +#include + +#include "lib/bluetooth.h" +#include "lib/mgmt.h" + +#include "monitor/bt.h" +#include "emulator/bthost.h" + +#include "src/shared/tester.h" +#include "src/shared/mgmt.h" +#include "src/shared/hciemu.h" + +#define SMP_CID 0x0006 + +struct test_data { + const void *test_data; + struct mgmt *mgmt; + uint16_t mgmt_index; + struct hciemu *hciemu; + enum hciemu_type hciemu_type; + unsigned int io_id; +}; + +struct smp_server_data { + const void *send_req; + uint16_t send_req_len; + const void *expect_rsp; + uint16_t expect_rsp_len; +}; + +static void mgmt_debug(const char *str, void *user_data) +{ + const char *prefix = user_data; + + tester_print("%s%s", prefix, str); +} + +static void read_info_callback(uint8_t status, uint16_t length, + const void *param, void *user_data) +{ + struct test_data *data = tester_get_data(); + const struct mgmt_rp_read_info *rp = param; + char addr[18]; + uint16_t manufacturer; + uint32_t supported_settings, current_settings; + + tester_print("Read Info callback"); + tester_print(" Status: 0x%02x", status); + + if (status || !param) { + tester_pre_setup_failed(); + return; + } + + ba2str(&rp->bdaddr, addr); + manufacturer = btohs(rp->manufacturer); + supported_settings = btohl(rp->supported_settings); + current_settings = btohl(rp->current_settings); + + tester_print(" Address: %s", addr); + tester_print(" Version: 0x%02x", rp->version); + tester_print(" Manufacturer: 0x%04x", manufacturer); + tester_print(" Supported settings: 0x%08x", supported_settings); + tester_print(" Current settings: 0x%08x", current_settings); + tester_print(" Class: 0x%02x%02x%02x", + rp->dev_class[2], rp->dev_class[1], rp->dev_class[0]); + tester_print(" Name: %s", rp->name); + tester_print(" Short name: %s", rp->short_name); + + if (strcmp(hciemu_get_address(data->hciemu), addr)) { + tester_pre_setup_failed(); + return; + } + + tester_pre_setup_complete(); +} + +static void index_added_callback(uint16_t index, uint16_t length, + const void *param, void *user_data) +{ + struct test_data *data = tester_get_data(); + + tester_print("Index Added callback"); + tester_print(" Index: 0x%04x", index); + + data->mgmt_index = index; + + mgmt_send(data->mgmt, MGMT_OP_READ_INFO, data->mgmt_index, 0, NULL, + read_info_callback, NULL, NULL); +} + +static void index_removed_callback(uint16_t index, uint16_t length, + const void *param, void *user_data) +{ + struct test_data *data = tester_get_data(); + + tester_print("Index Removed callback"); + tester_print(" Index: 0x%04x", index); + + if (index != data->mgmt_index) + return; + + mgmt_unregister_index(data->mgmt, data->mgmt_index); + + mgmt_unref(data->mgmt); + data->mgmt = NULL; + + tester_post_teardown_complete(); +} + +static void read_index_list_callback(uint8_t status, uint16_t length, + const void *param, void *user_data) +{ + struct test_data *data = tester_get_data(); + + tester_print("Read Index List callback"); + tester_print(" Status: 0x%02x", status); + + if (status || !param) { + tester_pre_setup_failed(); + return; + } + + mgmt_register(data->mgmt, MGMT_EV_INDEX_ADDED, MGMT_INDEX_NONE, + index_added_callback, NULL, NULL); + + mgmt_register(data->mgmt, MGMT_EV_INDEX_REMOVED, MGMT_INDEX_NONE, + index_removed_callback, NULL, NULL); + + data->hciemu = hciemu_new(data->hciemu_type); + if (!data->hciemu) { + tester_warn("Failed to setup HCI emulation"); + tester_pre_setup_failed(); + } + + tester_print("New hciemu instance created"); +} + +static void test_pre_setup(const void *test_data) +{ + struct test_data *data = tester_get_data(); + + data->mgmt = mgmt_new_default(); + if (!data->mgmt) { + tester_warn("Failed to setup management interface"); + tester_pre_setup_failed(); + return; + } + + if (tester_use_debug()) + mgmt_set_debug(data->mgmt, mgmt_debug, "mgmt: ", NULL); + + mgmt_send(data->mgmt, MGMT_OP_READ_INDEX_LIST, MGMT_INDEX_NONE, 0, NULL, + read_index_list_callback, NULL, NULL); +} + +static void test_post_teardown(const void *test_data) +{ + struct test_data *data = tester_get_data(); + + if (data->io_id > 0) { + g_source_remove(data->io_id); + data->io_id = 0; + } + + hciemu_unref(data->hciemu); + data->hciemu = NULL; +} + +static void test_data_free(void *test_data) +{ + struct test_data *data = test_data; + + free(data); +} + +#define test_smp(name, data, setup, func) \ + do { \ + struct test_data *user; \ + user = malloc(sizeof(struct test_data)); \ + if (!user) \ + break; \ + user->hciemu_type = HCIEMU_TYPE_LE; \ + user->io_id = 0; \ + user->test_data = data; \ + tester_add_full(name, data, \ + test_pre_setup, setup, func, NULL, \ + test_post_teardown, 2, user, test_data_free); \ + } while (0) + +static const uint8_t smp_nval_req_1[] = { 0x0b, 0x00 }; +static const uint8_t smp_nval_req_1_rsp[] = { 0x05, 0x07 }; + +static const struct smp_server_data smp_server_nval_req_1_test = { + .send_req = smp_nval_req_1, + .send_req_len = sizeof(smp_nval_req_1), + .expect_rsp = smp_nval_req_1_rsp, + .expect_rsp_len = sizeof(smp_nval_req_1_rsp), +}; + +static const uint8_t smp_nval_req_2[7] = { 0x01 }; +static const uint8_t smp_nval_req_2_rsp[] = { 0x05, 0x06 }; + +static const struct smp_server_data smp_server_nval_req_2_test = { + .send_req = smp_nval_req_2, + .send_req_len = sizeof(smp_nval_req_2), + .expect_rsp = smp_nval_req_2_rsp, + .expect_rsp_len = sizeof(smp_nval_req_2_rsp), +}; + +static void setup_powered_server_callback(uint8_t status, uint16_t length, + const void *param, void *user_data) +{ + if (status != MGMT_STATUS_SUCCESS) { + tester_setup_failed(); + return; + } + + tester_print("Controller powered on"); + + tester_setup_complete(); +} + +static void setup_powered_server(const void *test_data) +{ + struct test_data *data = tester_get_data(); + unsigned char param[] = { 0x01 }; + + tester_print("Powering on controller"); + + mgmt_send(data->mgmt, MGMT_OP_SET_LE, data->mgmt_index, + sizeof(param), param, NULL, NULL, NULL); + mgmt_send(data->mgmt, MGMT_OP_SET_ADVERTISING, data->mgmt_index, + sizeof(param), param, NULL, NULL, NULL); + mgmt_send(data->mgmt, MGMT_OP_SET_POWERED, data->mgmt_index, + sizeof(param), param, setup_powered_server_callback, + NULL, NULL); +} + +static void client_smp_rsp(const void *data, uint16_t len, void *user_data) +{ + struct test_data *test_data = user_data; + const struct smp_server_data *srv = test_data->test_data; + + tester_print("Client received response"); + + if (!srv->expect_rsp) { + tester_test_passed(); + return; + } + + if (srv->expect_rsp_len != len) { + tester_warn("Unexpected SMP response length (%u != %u)", + len, srv->expect_rsp_len); + goto failed; + } + + if (memcmp(srv->expect_rsp, data, len) != 0) { + tester_warn("Unexpected SMP response"); + goto failed; + } + + tester_test_passed(); + return; + +failed: + tester_test_failed(); +} + +static void client_new_conn(uint16_t handle, void *user_data) +{ + struct test_data *data = user_data; + const struct smp_server_data *srv = data->test_data; + struct bthost *bthost = hciemu_client_get_host(data->hciemu); + + tester_print("New client connection with handle 0x%04x", handle); + + bthost_add_cid_hook(bthost, handle, SMP_CID, client_smp_rsp, data); + + if (!srv->send_req) + return; + + tester_print("Sending SMP Request from client"); + + bthost_send_cid(bthost, handle, SMP_CID, srv->send_req, + srv->send_req_len); +} + +static void test_server(const void *test_data) +{ + struct test_data *data = tester_get_data(); + const uint8_t *master_bdaddr; + struct bthost *bthost; + + master_bdaddr = hciemu_get_master_bdaddr(data->hciemu); + if (!master_bdaddr) { + tester_warn("No master bdaddr"); + tester_test_failed(); + return; + } + + bthost = hciemu_client_get_host(data->hciemu); + bthost_set_connect_cb(bthost, client_new_conn, data); + + bthost_hci_connect(bthost, master_bdaddr, BDADDR_LE_PUBLIC); +} + +int main(int argc, char *argv[]) +{ + tester_init(&argc, &argv); + + test_smp("SMP Server - Invalid Request 1", + &smp_server_nval_req_1_test, + setup_powered_server, test_server); + test_smp("SMP Server - Invalid Request 2", + &smp_server_nval_req_2_test, + setup_powered_server, test_server); + + return tester_run(); +} -- 2.11.0