|
Packit |
34410b |
/*
|
|
Packit |
34410b |
*
|
|
Packit |
34410b |
* BlueZ - Bluetooth protocol stack for Linux
|
|
Packit |
34410b |
*
|
|
Packit |
34410b |
* Copyright (C) 2014 Intel Corporation. All rights reserved.
|
|
Packit |
34410b |
*
|
|
Packit |
34410b |
*
|
|
Packit |
34410b |
* This program is free software; you can redistribute it and/or modify
|
|
Packit |
34410b |
* it under the terms of the GNU General Public License as published by
|
|
Packit |
34410b |
* the Free Software Foundation; either version 2 of the License, or
|
|
Packit |
34410b |
* (at your option) any later version.
|
|
Packit |
34410b |
*
|
|
Packit |
34410b |
* This program is distributed in the hope that it will be useful,
|
|
Packit |
34410b |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit |
34410b |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
Packit |
34410b |
* GNU General Public License for more details.
|
|
Packit |
34410b |
*
|
|
Packit |
34410b |
* You should have received a copy of the GNU General Public License
|
|
Packit |
34410b |
* along with this program; if not, write to the Free Software
|
|
Packit |
34410b |
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
Packit |
34410b |
*
|
|
Packit |
34410b |
*/
|
|
Packit |
34410b |
|
|
Packit |
34410b |
#ifdef HAVE_CONFIG_H
|
|
Packit |
34410b |
#include <config.h>
|
|
Packit |
34410b |
#endif
|
|
Packit |
34410b |
|
|
Packit |
34410b |
#include <stdlib.h>
|
|
Packit |
34410b |
#include <stdint.h>
|
|
Packit |
34410b |
#include <unistd.h>
|
|
Packit |
34410b |
#include <errno.h>
|
|
Packit |
34410b |
#include <stdbool.h>
|
|
Packit |
34410b |
|
|
Packit |
34410b |
#include <glib.h>
|
|
Packit |
34410b |
|
|
Packit |
34410b |
#include "lib/bluetooth.h"
|
|
Packit |
34410b |
#include "lib/rfcomm.h"
|
|
Packit |
34410b |
#include "lib/mgmt.h"
|
|
Packit |
34410b |
|
|
Packit |
34410b |
#include "monitor/bt.h"
|
|
Packit |
34410b |
#include "emulator/bthost.h"
|
|
Packit |
34410b |
#include "emulator/hciemu.h"
|
|
Packit |
34410b |
|
|
Packit |
34410b |
#include "src/shared/tester.h"
|
|
Packit |
34410b |
#include "src/shared/mgmt.h"
|
|
Packit |
34410b |
|
|
Packit |
34410b |
struct test_data {
|
|
Packit |
34410b |
struct mgmt *mgmt;
|
|
Packit |
34410b |
uint16_t mgmt_index;
|
|
Packit |
34410b |
struct hciemu *hciemu;
|
|
Packit |
34410b |
enum hciemu_type hciemu_type;
|
|
Packit |
34410b |
const void *test_data;
|
|
Packit |
34410b |
unsigned int io_id;
|
|
Packit |
34410b |
uint16_t conn_handle;
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
struct rfcomm_client_data {
|
|
Packit |
34410b |
uint8_t server_channel;
|
|
Packit |
34410b |
uint8_t client_channel;
|
|
Packit |
34410b |
int expected_connect_err;
|
|
Packit |
34410b |
const uint8_t *send_data;
|
|
Packit |
34410b |
const uint8_t *read_data;
|
|
Packit |
34410b |
uint16_t data_len;
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
struct rfcomm_server_data {
|
|
Packit |
34410b |
uint8_t server_channel;
|
|
Packit |
34410b |
uint8_t client_channel;
|
|
Packit |
34410b |
bool expected_status;
|
|
Packit |
34410b |
const uint8_t *send_data;
|
|
Packit |
34410b |
const uint8_t *read_data;
|
|
Packit |
34410b |
uint16_t data_len;
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void mgmt_debug(const char *str, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
const char *prefix = user_data;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("%s%s", prefix, str);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void read_info_callback(uint8_t status, uint16_t length,
|
|
Packit |
34410b |
const void *param, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct mgmt_rp_read_info *rp = param;
|
|
Packit |
34410b |
char addr[18];
|
|
Packit |
34410b |
uint16_t manufacturer;
|
|
Packit |
34410b |
uint32_t supported_settings, current_settings;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Read Info callback");
|
|
Packit |
34410b |
tester_print(" Status: 0x%02x", status);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (status || !param) {
|
|
Packit |
34410b |
tester_pre_setup_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
ba2str(&rp->bdaddr, addr);
|
|
Packit |
34410b |
manufacturer = btohs(rp->manufacturer);
|
|
Packit |
34410b |
supported_settings = btohl(rp->supported_settings);
|
|
Packit |
34410b |
current_settings = btohl(rp->current_settings);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print(" Address: %s", addr);
|
|
Packit |
34410b |
tester_print(" Version: 0x%02x", rp->version);
|
|
Packit |
34410b |
tester_print(" Manufacturer: 0x%04x", manufacturer);
|
|
Packit |
34410b |
tester_print(" Supported settings: 0x%08x", supported_settings);
|
|
Packit |
34410b |
tester_print(" Current settings: 0x%08x", current_settings);
|
|
Packit |
34410b |
tester_print(" Class: 0x%02x%02x%02x",
|
|
Packit |
34410b |
rp->dev_class[2], rp->dev_class[1], rp->dev_class[0]);
|
|
Packit |
34410b |
tester_print(" Name: %s", rp->name);
|
|
Packit |
34410b |
tester_print(" Short name: %s", rp->short_name);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (strcmp(hciemu_get_address(data->hciemu), addr)) {
|
|
Packit |
34410b |
tester_pre_setup_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_pre_setup_complete();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void index_added_callback(uint16_t index, uint16_t length,
|
|
Packit |
34410b |
const void *param, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Index Added callback");
|
|
Packit |
34410b |
tester_print(" Index: 0x%04x", index);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->mgmt_index = index;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_send(data->mgmt, MGMT_OP_READ_INFO, data->mgmt_index, 0, NULL,
|
|
Packit |
34410b |
read_info_callback, NULL, NULL);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void index_removed_callback(uint16_t index, uint16_t length,
|
|
Packit |
34410b |
const void *param, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Index Removed callback");
|
|
Packit |
34410b |
tester_print(" Index: 0x%04x", index);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (index != data->mgmt_index)
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_unregister_index(data->mgmt, data->mgmt_index);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_unref(data->mgmt);
|
|
Packit |
34410b |
data->mgmt = NULL;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_post_teardown_complete();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void read_index_list_callback(uint8_t status, uint16_t length,
|
|
Packit |
34410b |
const void *param, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Read Index List callback");
|
|
Packit |
34410b |
tester_print(" Status: 0x%02x", status);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (status || !param) {
|
|
Packit |
34410b |
tester_pre_setup_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_register(data->mgmt, MGMT_EV_INDEX_ADDED, MGMT_INDEX_NONE,
|
|
Packit |
34410b |
index_added_callback, NULL, NULL);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_register(data->mgmt, MGMT_EV_INDEX_REMOVED, MGMT_INDEX_NONE,
|
|
Packit |
34410b |
index_removed_callback, NULL, NULL);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->hciemu = hciemu_new(data->hciemu_type);
|
|
Packit |
34410b |
if (!data->hciemu) {
|
|
Packit |
34410b |
tester_warn("Failed to setup HCI emulation");
|
|
Packit |
34410b |
tester_pre_setup_failed();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("New hciemu instance created");
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void test_pre_setup(const void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->mgmt = mgmt_new_default();
|
|
Packit |
34410b |
if (!data->mgmt) {
|
|
Packit |
34410b |
tester_warn("Failed to setup management interface");
|
|
Packit |
34410b |
tester_pre_setup_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (tester_use_debug())
|
|
Packit |
34410b |
mgmt_set_debug(data->mgmt, mgmt_debug, "mgmt: ", NULL);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_send(data->mgmt, MGMT_OP_READ_INDEX_LIST, MGMT_INDEX_NONE, 0, NULL,
|
|
Packit |
34410b |
read_index_list_callback, NULL, NULL);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void test_post_teardown(const void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (data->io_id > 0) {
|
|
Packit |
34410b |
g_source_remove(data->io_id);
|
|
Packit |
34410b |
data->io_id = 0;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
hciemu_unref(data->hciemu);
|
|
Packit |
34410b |
data->hciemu = NULL;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void test_data_free(void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = test_data;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
free(data);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void client_connectable_complete(uint16_t opcode, uint8_t status,
|
|
Packit |
34410b |
const void *param, uint8_t len,
|
|
Packit |
34410b |
void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
switch (opcode) {
|
|
Packit |
34410b |
case BT_HCI_CMD_WRITE_SCAN_ENABLE:
|
|
Packit |
34410b |
break;
|
|
Packit |
34410b |
default:
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Client set connectable status 0x%02x", status);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (status)
|
|
Packit |
34410b |
tester_setup_failed();
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
tester_setup_complete();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void setup_powered_client_callback(uint8_t status, uint16_t length,
|
|
Packit |
34410b |
const void *param, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
struct bthost *bthost;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (status != MGMT_STATUS_SUCCESS) {
|
|
Packit |
34410b |
tester_setup_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Controller powered on");
|
|
Packit |
34410b |
|
|
Packit |
34410b |
bthost = hciemu_client_get_host(data->hciemu);
|
|
Packit |
34410b |
bthost_set_cmd_complete_cb(bthost, client_connectable_complete, data);
|
|
Packit |
34410b |
bthost_write_scan_enable(bthost, 0x03);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void setup_powered_client(const void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
unsigned char param[] = { 0x01 };
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Powering on controller");
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_send(data->mgmt, MGMT_OP_SET_POWERED, data->mgmt_index,
|
|
Packit |
34410b |
sizeof(param), param, setup_powered_client_callback,
|
|
Packit |
34410b |
NULL, NULL);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void setup_powered_server_callback(uint8_t status, uint16_t length,
|
|
Packit |
34410b |
const void *param, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
if (status != MGMT_STATUS_SUCCESS) {
|
|
Packit |
34410b |
tester_setup_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Controller powered on");
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_setup_complete();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void setup_powered_server(const void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
unsigned char param[] = { 0x01 };
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Powering on controller");
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_send(data->mgmt, MGMT_OP_SET_CONNECTABLE, data->mgmt_index,
|
|
Packit |
34410b |
sizeof(param), param,
|
|
Packit |
34410b |
NULL, NULL, NULL);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
mgmt_send(data->mgmt, MGMT_OP_SET_POWERED, data->mgmt_index,
|
|
Packit |
34410b |
sizeof(param), param, setup_powered_server_callback,
|
|
Packit |
34410b |
NULL, NULL);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_client_data connect_success = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0c
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const uint8_t data[] = {0, 1, 2, 3, 4, 5, 6, 7, 8};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_client_data connect_send_success = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0c,
|
|
Packit |
34410b |
.data_len = sizeof(data),
|
|
Packit |
34410b |
.send_data = data
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_client_data connect_read_success = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0c,
|
|
Packit |
34410b |
.data_len = sizeof(data),
|
|
Packit |
34410b |
.read_data = data
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_client_data connect_nval = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0e,
|
|
Packit |
34410b |
.expected_connect_err = -ECONNREFUSED
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_server_data listen_success = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0c,
|
|
Packit |
34410b |
.expected_status = true
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_server_data listen_send_success = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0c,
|
|
Packit |
34410b |
.expected_status = true,
|
|
Packit |
34410b |
.data_len = sizeof(data),
|
|
Packit |
34410b |
.send_data = data
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_server_data listen_read_success = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0c,
|
|
Packit |
34410b |
.expected_status = true,
|
|
Packit |
34410b |
.data_len = sizeof(data),
|
|
Packit |
34410b |
.read_data = data
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
const struct rfcomm_server_data listen_nval = {
|
|
Packit |
34410b |
.server_channel = 0x0c,
|
|
Packit |
34410b |
.client_channel = 0x0e,
|
|
Packit |
34410b |
.expected_status = false
|
|
Packit |
34410b |
};
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void test_basic(const void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
int sk;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = socket(PF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
|
|
Packit |
34410b |
if (sk < 0) {
|
|
Packit |
34410b |
tester_warn("Can't create socket: %s (%d)", strerror(errno),
|
|
Packit |
34410b |
errno);
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
close(sk);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static int create_rfcomm_sock(bdaddr_t *address, uint8_t channel)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
int sk;
|
|
Packit |
34410b |
struct sockaddr_rc addr;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = socket(PF_BLUETOOTH, SOCK_STREAM | SOCK_NONBLOCK, BTPROTO_RFCOMM);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
memset(&addr, 0, sizeof(addr));
|
|
Packit |
34410b |
addr.rc_family = AF_BLUETOOTH;
|
|
Packit |
34410b |
addr.rc_channel = channel;
|
|
Packit |
34410b |
bacpy(&addr.rc_bdaddr, address);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
|
|
Packit |
34410b |
close(sk);
|
|
Packit |
34410b |
return -1;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return sk;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static int connect_rfcomm_sock(int sk, const bdaddr_t *bdaddr, uint8_t channel)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct sockaddr_rc addr;
|
|
Packit |
34410b |
int err;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
memset(&addr, 0, sizeof(addr));
|
|
Packit |
34410b |
addr.rc_family = AF_BLUETOOTH;
|
|
Packit |
34410b |
bacpy(&addr.rc_bdaddr, bdaddr);
|
|
Packit |
34410b |
addr.rc_channel = htobs(channel);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
err = connect(sk, (struct sockaddr *) &addr, sizeof(addr));
|
|
Packit |
34410b |
if (err < 0 && !(errno == EAGAIN || errno == EINPROGRESS))
|
|
Packit |
34410b |
return err;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return 0;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static gboolean client_received_data(GIOChannel *io, GIOCondition cond,
|
|
Packit |
34410b |
gpointer user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_client_data *cli = data->test_data;
|
|
Packit |
34410b |
int sk;
|
|
Packit |
34410b |
ssize_t ret;
|
|
Packit |
34410b |
char buf[248];
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = g_io_channel_unix_get_fd(io);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
ret = read(sk, buf, cli->data_len);
|
|
Packit |
34410b |
if (cli->data_len != ret) {
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (memcmp(cli->read_data, buf, cli->data_len))
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static gboolean rc_connect_cb(GIOChannel *io, GIOCondition cond,
|
|
Packit |
34410b |
gpointer user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_client_data *cli = data->test_data;
|
|
Packit |
34410b |
socklen_t len = sizeof(int);
|
|
Packit |
34410b |
int sk, err, sk_err;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Connected");
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->io_id = 0;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = g_io_channel_unix_get_fd(io);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (getsockopt(sk, SOL_SOCKET, SO_ERROR, &sk_err, &len) < 0)
|
|
Packit |
34410b |
err = -errno;
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
err = -sk_err;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (cli->expected_connect_err && err == cli->expected_connect_err) {
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (cli->send_data) {
|
|
Packit |
34410b |
ssize_t ret;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Writing %u bytes of data", cli->data_len);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
ret = write(sk, cli->send_data, cli->data_len);
|
|
Packit |
34410b |
if (cli->data_len != ret) {
|
|
Packit |
34410b |
tester_warn("Failed to write %u bytes: %s (%d)",
|
|
Packit |
34410b |
cli->data_len, strerror(errno), errno);
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
} else if (cli->read_data) {
|
|
Packit |
34410b |
g_io_add_watch(io, G_IO_IN, client_received_data, NULL);
|
|
Packit |
34410b |
bthost_send_rfcomm_data(hciemu_client_get_host(data->hciemu),
|
|
Packit |
34410b |
data->conn_handle,
|
|
Packit |
34410b |
cli->client_channel,
|
|
Packit |
34410b |
cli->read_data, cli->data_len);
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (err < 0)
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void client_hook_func(const void *data, uint16_t len,
|
|
Packit |
34410b |
void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *test_data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_client_data *cli = test_data->test_data;
|
|
Packit |
34410b |
ssize_t ret;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("bthost received %u bytes of data", len);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (cli->data_len != len) {
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
ret = memcmp(cli->send_data, data, len);
|
|
Packit |
34410b |
if (ret)
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void server_hook_func(const void *data, uint16_t len,
|
|
Packit |
34410b |
void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *test_data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_server_data *srv = test_data->test_data;
|
|
Packit |
34410b |
ssize_t ret;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (srv->data_len != len) {
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
ret = memcmp(srv->send_data, data, len);
|
|
Packit |
34410b |
if (ret)
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void rfcomm_connect_cb(uint16_t handle, uint16_t cid,
|
|
Packit |
34410b |
void *user_data, bool status)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_client_data *cli = data->test_data;
|
|
Packit |
34410b |
struct bthost *bthost = hciemu_client_get_host(data->hciemu);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (cli->send_data)
|
|
Packit |
34410b |
bthost_add_rfcomm_chan_hook(bthost, handle,
|
|
Packit |
34410b |
cli->client_channel,
|
|
Packit |
34410b |
client_hook_func, NULL);
|
|
Packit |
34410b |
else if (cli->read_data)
|
|
Packit |
34410b |
data->conn_handle = handle;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void test_connect(const void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
struct bthost *bthost = hciemu_client_get_host(data->hciemu);
|
|
Packit |
34410b |
const struct rfcomm_client_data *cli = data->test_data;
|
|
Packit |
34410b |
const uint8_t *client_addr, *master_addr;
|
|
Packit |
34410b |
GIOChannel *io;
|
|
Packit |
34410b |
int sk;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
bthost_add_l2cap_server(bthost, 0x0003, NULL, NULL);
|
|
Packit |
34410b |
bthost_add_rfcomm_server(bthost, cli->server_channel,
|
|
Packit |
34410b |
rfcomm_connect_cb, NULL);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
master_addr = hciemu_get_master_bdaddr(data->hciemu);
|
|
Packit |
34410b |
client_addr = hciemu_get_client_bdaddr(data->hciemu);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = create_rfcomm_sock((bdaddr_t *) master_addr, 0);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (connect_rfcomm_sock(sk, (const bdaddr_t *) client_addr,
|
|
Packit |
34410b |
cli->client_channel) < 0) {
|
|
Packit |
34410b |
close(sk);
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
io = g_io_channel_unix_new(sk);
|
|
Packit |
34410b |
g_io_channel_set_close_on_unref(io, TRUE);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->io_id = g_io_add_watch(io, G_IO_OUT, rc_connect_cb, NULL);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
g_io_channel_unref(io);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Connect in progress %d", sk);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static gboolean server_received_data(GIOChannel *io, GIOCondition cond,
|
|
Packit |
34410b |
gpointer user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_server_data *srv = data->test_data;
|
|
Packit |
34410b |
char buf[1024];
|
|
Packit |
34410b |
ssize_t ret;
|
|
Packit |
34410b |
int sk;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = g_io_channel_unix_get_fd(io);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
ret = read(sk, buf, srv->data_len);
|
|
Packit |
34410b |
if (ret != srv->data_len) {
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (memcmp(buf, srv->read_data, srv->data_len))
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static gboolean rfcomm_listen_cb(GIOChannel *io, GIOCondition cond,
|
|
Packit |
34410b |
gpointer user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_server_data *srv = data->test_data;
|
|
Packit |
34410b |
int sk, new_sk;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->io_id = 0;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = g_io_channel_unix_get_fd(io);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
new_sk = accept(sk, NULL, NULL);
|
|
Packit |
34410b |
if (new_sk < 0) {
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (srv->send_data) {
|
|
Packit |
34410b |
ssize_t ret;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
ret = write(new_sk, srv->send_data, srv->data_len);
|
|
Packit |
34410b |
if (ret != srv->data_len)
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
close(new_sk);
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
} else if (srv->read_data) {
|
|
Packit |
34410b |
GIOChannel *new_io;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
new_io = g_io_channel_unix_new(new_sk);
|
|
Packit |
34410b |
g_io_channel_set_close_on_unref(new_io, TRUE);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->io_id = g_io_add_watch(new_io, G_IO_IN,
|
|
Packit |
34410b |
server_received_data, NULL);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
g_io_channel_unref(new_io);
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
close(new_sk);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return false;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void connection_cb(uint16_t handle, uint16_t cid, void *user_data,
|
|
Packit |
34410b |
bool status)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_server_data *srv = data->test_data;
|
|
Packit |
34410b |
struct bthost *bthost = hciemu_client_get_host(data->hciemu);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (srv->read_data) {
|
|
Packit |
34410b |
data->conn_handle = handle;
|
|
Packit |
34410b |
bthost_send_rfcomm_data(bthost, data->conn_handle,
|
|
Packit |
34410b |
srv->client_channel,
|
|
Packit |
34410b |
srv->read_data, srv->data_len);
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
} else if (srv->data_len) {
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (srv->expected_status == status)
|
|
Packit |
34410b |
tester_test_passed();
|
|
Packit |
34410b |
else
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void client_new_conn(uint16_t handle, void *user_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_server_data *srv = data->test_data;
|
|
Packit |
34410b |
struct bthost *bthost;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
bthost = hciemu_client_get_host(data->hciemu);
|
|
Packit |
34410b |
bthost_add_rfcomm_chan_hook(bthost, handle, srv->client_channel,
|
|
Packit |
34410b |
server_hook_func, NULL);
|
|
Packit |
34410b |
bthost_connect_rfcomm(bthost, handle, srv->client_channel,
|
|
Packit |
34410b |
connection_cb, NULL);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
static void test_server(const void *test_data)
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
struct test_data *data = tester_get_data();
|
|
Packit |
34410b |
const struct rfcomm_server_data *srv = data->test_data;
|
|
Packit |
34410b |
const uint8_t *master_addr;
|
|
Packit |
34410b |
struct bthost *bthost;
|
|
Packit |
34410b |
GIOChannel *io;
|
|
Packit |
34410b |
int sk;
|
|
Packit |
34410b |
|
|
Packit |
34410b |
master_addr = hciemu_get_master_bdaddr(data->hciemu);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
sk = create_rfcomm_sock((bdaddr_t *) master_addr, srv->server_channel);
|
|
Packit |
34410b |
if (sk < 0) {
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
if (listen(sk, 5) < 0) {
|
|
Packit |
34410b |
tester_warn("listening on socket failed: %s (%u)",
|
|
Packit |
34410b |
strerror(errno), errno);
|
|
Packit |
34410b |
tester_test_failed();
|
|
Packit |
34410b |
close(sk);
|
|
Packit |
34410b |
return;
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
io = g_io_channel_unix_new(sk);
|
|
Packit |
34410b |
g_io_channel_set_close_on_unref(io, TRUE);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
data->io_id = g_io_add_watch(io, G_IO_IN, rfcomm_listen_cb, NULL);
|
|
Packit |
34410b |
g_io_channel_unref(io);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
tester_print("Listening for connections");
|
|
Packit |
34410b |
|
|
Packit |
34410b |
bthost = hciemu_client_get_host(data->hciemu);
|
|
Packit |
34410b |
bthost_set_connect_cb(bthost, client_new_conn, data);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
bthost_hci_connect(bthost, master_addr, BDADDR_BREDR);
|
|
Packit |
34410b |
}
|
|
Packit |
34410b |
|
|
Packit |
34410b |
#define test_rfcomm(name, data, setup, func) \
|
|
Packit |
34410b |
do { \
|
|
Packit |
34410b |
struct test_data *user; \
|
|
Packit |
34410b |
user = malloc(sizeof(struct test_data)); \
|
|
Packit |
34410b |
if (!user) \
|
|
Packit |
34410b |
break; \
|
|
Packit |
34410b |
user->hciemu_type = HCIEMU_TYPE_BREDR; \
|
|
Packit |
34410b |
user->test_data = data; \
|
|
Packit |
34410b |
user->io_id = 0; \
|
|
Packit |
34410b |
tester_add_full(name, data, \
|
|
Packit |
34410b |
test_pre_setup, setup, func, NULL, \
|
|
Packit |
34410b |
test_post_teardown, 2, user, test_data_free); \
|
|
Packit |
34410b |
} while (0)
|
|
Packit |
34410b |
|
|
Packit |
34410b |
int main(int argc, char *argv[])
|
|
Packit |
34410b |
{
|
|
Packit |
34410b |
tester_init(&argc, &argv);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket - Success", NULL,
|
|
Packit |
34410b |
setup_powered_client, test_basic);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Client - Success", &connect_success,
|
|
Packit |
34410b |
setup_powered_client, test_connect);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Client - Write Success",
|
|
Packit |
34410b |
&connect_send_success, setup_powered_client,
|
|
Packit |
34410b |
test_connect);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Client - Read Success",
|
|
Packit |
34410b |
&connect_read_success, setup_powered_client,
|
|
Packit |
34410b |
test_connect);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Client - Conn Refused",
|
|
Packit |
34410b |
&connect_nval, setup_powered_client, test_connect);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Server - Success", &listen_success,
|
|
Packit |
34410b |
setup_powered_server, test_server);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Server - Write Success",
|
|
Packit |
34410b |
&listen_send_success, setup_powered_server,
|
|
Packit |
34410b |
test_server);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Server - Read Success",
|
|
Packit |
34410b |
&listen_read_success, setup_powered_server,
|
|
Packit |
34410b |
test_server);
|
|
Packit |
34410b |
test_rfcomm("Basic RFCOMM Socket Server - Conn Refused", &listen_nval,
|
|
Packit |
34410b |
setup_powered_server, test_server);
|
|
Packit |
34410b |
|
|
Packit |
34410b |
return tester_run();
|
|
Packit |
34410b |
}
|