Blame tools/bnep-tester.c

Packit Service 8264ee
/*
Packit Service 8264ee
 *
Packit Service 8264ee
 *  BlueZ - Bluetooth protocol stack for Linux
Packit Service 8264ee
 *
Packit Service 8264ee
 *  Copyright (C) 2014  Intel Corporation. All rights reserved.
Packit Service 8264ee
 *
Packit Service 8264ee
 *
Packit Service 8264ee
 *  This program is free software; you can redistribute it and/or modify
Packit Service 8264ee
 *  it under the terms of the GNU General Public License as published by
Packit Service 8264ee
 *  the Free Software Foundation; either version 2 of the License, or
Packit Service 8264ee
 *  (at your option) any later version.
Packit Service 8264ee
 *
Packit Service 8264ee
 *  This program is distributed in the hope that it will be useful,
Packit Service 8264ee
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
Packit Service 8264ee
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
Packit Service 8264ee
 *  GNU General Public License for more details.
Packit Service 8264ee
 *
Packit Service 8264ee
 *  You should have received a copy of the GNU General Public License
Packit Service 8264ee
 *  along with this program; if not, write to the Free Software
Packit Service 8264ee
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
Packit Service 8264ee
 *
Packit Service 8264ee
 */
Packit Service 8264ee
Packit Service 8264ee
#ifdef HAVE_CONFIG_H
Packit Service 8264ee
#include <config.h>
Packit Service 8264ee
#endif
Packit Service 8264ee
Packit Service 8264ee
#include <stdlib.h>
Packit Service 8264ee
#include <stdint.h>
Packit Service 8264ee
#include <unistd.h>
Packit Service 8264ee
#include <errno.h>
Packit Service 8264ee
#include <stdbool.h>
Packit Service 8264ee
Packit Service 8264ee
#include <glib.h>
Packit Service 8264ee
Packit Service 8264ee
#include "lib/bluetooth.h"
Packit Service 8264ee
#include "lib/bnep.h"
Packit Service 8264ee
#include "lib/mgmt.h"
Packit Service 8264ee
Packit Service 8264ee
#include "monitor/bt.h"
Packit Service 8264ee
#include "emulator/bthost.h"
Packit Service 8264ee
#include "emulator/hciemu.h"
Packit Service 8264ee
Packit Service 8264ee
#include "src/shared/tester.h"
Packit Service 8264ee
#include "src/shared/mgmt.h"
Packit Service 8264ee
Packit Service 8264ee
struct test_data {
Packit Service 8264ee
	struct mgmt *mgmt;
Packit Service 8264ee
	uint16_t mgmt_index;
Packit Service 8264ee
	struct hciemu *hciemu;
Packit Service 8264ee
	enum hciemu_type hciemu_type;
Packit Service 8264ee
	const void *test_data;
Packit Service 8264ee
	unsigned int io_id;
Packit Service 8264ee
	uint16_t conn_handle;
Packit Service 8264ee
};
Packit Service 8264ee
Packit Service 8264ee
struct rfcomm_client_data {
Packit Service 8264ee
	uint8_t server_channel;
Packit Service 8264ee
	uint8_t client_channel;
Packit Service 8264ee
	int expected_connect_err;
Packit Service 8264ee
	const uint8_t *send_data;
Packit Service 8264ee
	const uint8_t *read_data;
Packit Service 8264ee
	uint16_t data_len;
Packit Service 8264ee
};
Packit Service 8264ee
Packit Service 8264ee
struct rfcomm_server_data {
Packit Service 8264ee
	uint8_t server_channel;
Packit Service 8264ee
	uint8_t client_channel;
Packit Service 8264ee
	bool expected_status;
Packit Service 8264ee
	const uint8_t *send_data;
Packit Service 8264ee
	const uint8_t *read_data;
Packit Service 8264ee
	uint16_t data_len;
Packit Service 8264ee
};
Packit Service 8264ee
Packit Service 8264ee
static void mgmt_debug(const char *str, void *user_data)
Packit Service 8264ee
{
Packit Service 8264ee
	const char *prefix = user_data;
Packit Service 8264ee
Packit Service 8264ee
	tester_print("%s%s", prefix, str);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void read_info_callback(uint8_t status, uint16_t length,
Packit Service 8264ee
					const void *param, void *user_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
	const struct mgmt_rp_read_info *rp = param;
Packit Service 8264ee
	char addr[18];
Packit Service 8264ee
	uint16_t manufacturer;
Packit Service 8264ee
	uint32_t supported_settings, current_settings;
Packit Service 8264ee
Packit Service 8264ee
	tester_print("Read Info callback");
Packit Service 8264ee
	tester_print("  Status: 0x%02x", status);
Packit Service 8264ee
Packit Service 8264ee
	if (status || !param) {
Packit Service 8264ee
		tester_pre_setup_failed();
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	ba2str(&rp->bdaddr, addr);
Packit Service 8264ee
	manufacturer = btohs(rp->manufacturer);
Packit Service 8264ee
	supported_settings = btohl(rp->supported_settings);
Packit Service 8264ee
	current_settings = btohl(rp->current_settings);
Packit Service 8264ee
Packit Service 8264ee
	tester_print("  Address: %s", addr);
Packit Service 8264ee
	tester_print("  Version: 0x%02x", rp->version);
Packit Service 8264ee
	tester_print("  Manufacturer: 0x%04x", manufacturer);
Packit Service 8264ee
	tester_print("  Supported settings: 0x%08x", supported_settings);
Packit Service 8264ee
	tester_print("  Current settings: 0x%08x", current_settings);
Packit Service 8264ee
	tester_print("  Class: 0x%02x%02x%02x",
Packit Service 8264ee
			rp->dev_class[2], rp->dev_class[1], rp->dev_class[0]);
Packit Service 8264ee
	tester_print("  Name: %s", rp->name);
Packit Service 8264ee
	tester_print("  Short name: %s", rp->short_name);
Packit Service 8264ee
Packit Service 8264ee
	if (strcmp(hciemu_get_address(data->hciemu), addr)) {
Packit Service 8264ee
		tester_pre_setup_failed();
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	tester_pre_setup_complete();
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void index_added_callback(uint16_t index, uint16_t length,
Packit Service 8264ee
					const void *param, void *user_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
Packit Service 8264ee
	tester_print("Index Added callback");
Packit Service 8264ee
	tester_print("  Index: 0x%04x", index);
Packit Service 8264ee
Packit Service 8264ee
	data->mgmt_index = index;
Packit Service 8264ee
Packit Service 8264ee
	mgmt_send(data->mgmt, MGMT_OP_READ_INFO, data->mgmt_index, 0, NULL,
Packit Service 8264ee
					read_info_callback, NULL, NULL);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void index_removed_callback(uint16_t index, uint16_t length,
Packit Service 8264ee
					const void *param, void *user_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
Packit Service 8264ee
	tester_print("Index Removed callback");
Packit Service 8264ee
	tester_print("  Index: 0x%04x", index);
Packit Service 8264ee
Packit Service 8264ee
	if (index != data->mgmt_index)
Packit Service 8264ee
		return;
Packit Service 8264ee
Packit Service 8264ee
	mgmt_unregister_index(data->mgmt, data->mgmt_index);
Packit Service 8264ee
Packit Service 8264ee
	mgmt_unref(data->mgmt);
Packit Service 8264ee
	data->mgmt = NULL;
Packit Service 8264ee
Packit Service 8264ee
	tester_post_teardown_complete();
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void read_index_list_callback(uint8_t status, uint16_t length,
Packit Service 8264ee
					const void *param, void *user_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
Packit Service 8264ee
	tester_print("Read Index List callback");
Packit Service 8264ee
	tester_print("  Status: 0x%02x", status);
Packit Service 8264ee
Packit Service 8264ee
	if (status || !param) {
Packit Service 8264ee
		tester_pre_setup_failed();
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	mgmt_register(data->mgmt, MGMT_EV_INDEX_ADDED, MGMT_INDEX_NONE,
Packit Service 8264ee
					index_added_callback, NULL, NULL);
Packit Service 8264ee
Packit Service 8264ee
	mgmt_register(data->mgmt, MGMT_EV_INDEX_REMOVED, MGMT_INDEX_NONE,
Packit Service 8264ee
					index_removed_callback, NULL, NULL);
Packit Service 8264ee
Packit Service 8264ee
	data->hciemu = hciemu_new(data->hciemu_type);
Packit Service 8264ee
	if (!data->hciemu) {
Packit Service 8264ee
		tester_warn("Failed to setup HCI emulation");
Packit Service 8264ee
		tester_pre_setup_failed();
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	tester_print("New hciemu instance created");
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void test_pre_setup(const void *test_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
Packit Service 8264ee
	data->mgmt = mgmt_new_default();
Packit Service 8264ee
	if (!data->mgmt) {
Packit Service 8264ee
		tester_warn("Failed to setup management interface");
Packit Service 8264ee
		tester_pre_setup_failed();
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	if (tester_use_debug())
Packit Service 8264ee
		mgmt_set_debug(data->mgmt, mgmt_debug, "mgmt: ", NULL);
Packit Service 8264ee
Packit Service 8264ee
	mgmt_send(data->mgmt, MGMT_OP_READ_INDEX_LIST, MGMT_INDEX_NONE, 0, NULL,
Packit Service 8264ee
					read_index_list_callback, NULL, NULL);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void test_post_teardown(const void *test_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
Packit Service 8264ee
	if (data->io_id > 0) {
Packit Service 8264ee
		g_source_remove(data->io_id);
Packit Service 8264ee
		data->io_id = 0;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	hciemu_unref(data->hciemu);
Packit Service 8264ee
	data->hciemu = NULL;
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void test_data_free(void *test_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = test_data;
Packit Service 8264ee
Packit Service 8264ee
	free(data);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void client_connectable_complete(uint16_t opcode, uint8_t status,
Packit Service 8264ee
					const void *param, uint8_t len,
Packit Service 8264ee
					void *user_data)
Packit Service 8264ee
{
Packit Service 8264ee
	switch (opcode) {
Packit Service 8264ee
	case BT_HCI_CMD_WRITE_SCAN_ENABLE:
Packit Service 8264ee
		break;
Packit Service 8264ee
	default:
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	tester_print("Client set connectable status 0x%02x", status);
Packit Service 8264ee
Packit Service 8264ee
	if (status)
Packit Service 8264ee
		tester_setup_failed();
Packit Service 8264ee
	else
Packit Service 8264ee
		tester_setup_complete();
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void setup_powered_client_callback(uint8_t status, uint16_t length,
Packit Service 8264ee
					const void *param, void *user_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
	struct bthost *bthost;
Packit Service 8264ee
Packit Service 8264ee
	if (status != MGMT_STATUS_SUCCESS) {
Packit Service 8264ee
		tester_setup_failed();
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	tester_print("Controller powered on");
Packit Service 8264ee
Packit Service 8264ee
	bthost = hciemu_client_get_host(data->hciemu);
Packit Service 8264ee
	bthost_set_cmd_complete_cb(bthost, client_connectable_complete, data);
Packit Service 8264ee
	bthost_write_scan_enable(bthost, 0x03);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void setup_powered_client(const void *test_data)
Packit Service 8264ee
{
Packit Service 8264ee
	struct test_data *data = tester_get_data();
Packit Service 8264ee
	unsigned char param[] = { 0x01 };
Packit Service 8264ee
Packit Service 8264ee
	tester_print("Powering on controller");
Packit Service 8264ee
Packit Service 8264ee
	mgmt_send(data->mgmt, MGMT_OP_SET_POWERED, data->mgmt_index,
Packit Service 8264ee
			sizeof(param), param, setup_powered_client_callback,
Packit Service 8264ee
			NULL, NULL);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void test_basic(const void *test_data)
Packit Service 8264ee
{
Packit Service 8264ee
	int sk;
Packit Service 8264ee
Packit Service 8264ee
	sk = socket(PF_BLUETOOTH, SOCK_RAW, BTPROTO_BNEP);
Packit Service 8264ee
	if (sk < 0) {
Packit Service 8264ee
		tester_warn("Can't create socket: %s (%d)", strerror(errno),
Packit Service 8264ee
									errno);
Packit Service 8264ee
		tester_test_failed();
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	close(sk);
Packit Service 8264ee
Packit Service 8264ee
	tester_test_passed();
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
#define test_bnep(name, data, setup, func) \
Packit Service 8264ee
	do { \
Packit Service 8264ee
		struct test_data *user; \
Packit Service 8264ee
		user = malloc(sizeof(struct test_data)); \
Packit Service 8264ee
		if (!user) \
Packit Service 8264ee
			break; \
Packit Service 8264ee
		user->hciemu_type = HCIEMU_TYPE_BREDR; \
Packit Service 8264ee
		user->test_data = data; \
Packit Service 8264ee
		user->io_id = 0; \
Packit Service 8264ee
		tester_add_full(name, data, \
Packit Service 8264ee
				test_pre_setup, setup, func, NULL, \
Packit Service 8264ee
				test_post_teardown, 2, user, test_data_free); \
Packit Service 8264ee
	} while (0)
Packit Service 8264ee
Packit Service 8264ee
int main(int argc, char *argv[])
Packit Service 8264ee
{
Packit Service 8264ee
	tester_init(&argc, &argv);
Packit Service 8264ee
Packit Service 8264ee
	test_bnep("Basic BNEP Socket - Success", NULL,
Packit Service 8264ee
					setup_powered_client, test_basic);
Packit Service 8264ee
Packit Service 8264ee
	return tester_run();
Packit Service 8264ee
}