#include <stdlib.h>
#include <stdbool.h>
#include <sys/ioctl.h>
+#include <errno.h>
+#include <unistd.h>
#include <glib.h>
#include "lib/hci.h"
#include "lib/hci_lib.h"
#include "lib/mgmt.h"
+#include "lib/l2cap.h"
#include "monitor/bt.h"
#include "emulator/bthost.h"
enum hciemu_type hciemu_type;
int unmet_conditions;
int unmet_setup_conditions;
+ int sk;
};
static void mgmt_debug(const char *str, void *user_data)
tester_post_teardown_complete();
}
+struct generic_data {
+ bool setup_le_states;
+ const uint8_t *le_states;
+ const uint16_t *setup_settings;
+ bool setup_nobredr;
+ bool setup_limited_discov;
+ uint16_t setup_expect_hci_command;
+ const void *setup_expect_hci_param;
+ uint8_t setup_expect_hci_len;
+ uint16_t setup_send_opcode;
+ const void *setup_send_param;
+ uint16_t setup_send_len;
+ const struct setup_mgmt_cmd *setup_mgmt_cmd_arr;
+ bool send_index_none;
+ uint16_t send_opcode;
+ const void *send_param;
+ uint16_t send_len;
+ const void * (*send_func)(uint16_t *len);
+ uint8_t expect_status;
+ bool expect_ignore_param;
+ const void *expect_param;
+ uint16_t expect_len;
+ const void * (*expect_func)(uint16_t *len);
+ uint32_t expect_settings_set;
+ uint32_t expect_settings_unset;
+ uint16_t expect_alt_ev;
+ const void *expect_alt_ev_param;
+ bool (*verify_alt_ev_func)(const void *param, uint16_t length);
+ uint16_t expect_alt_ev_len;
+ uint16_t expect_hci_command;
+ const void *expect_hci_param;
+ uint8_t expect_hci_len;
+ const void * (*expect_hci_func)(uint8_t *len);
+ bool expect_pin;
+ uint8_t pin_len;
+ const void *pin;
+ uint8_t client_pin_len;
+ const void *client_pin;
+ bool client_enable_ssp;
+ uint8_t io_cap;
+ uint8_t client_io_cap;
+ uint8_t client_auth_req;
+ bool reject_confirm;
+ bool client_reject_confirm;
+ bool just_works;
+ bool client_enable_le;
+ bool client_enable_sc;
+ bool client_enable_adv;
+ bool expect_sc_key;
+ bool force_power_off;
+ bool addr_type_avail;
+ uint8_t addr_type;
+ bool set_adv;
+ const uint8_t *adv_data;
+ uint8_t adv_data_len;
+};
+
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();
+ const struct generic_data *test = data->test_data;
tester_print("Read Index List callback");
tester_print(" Status: %s (0x%02x)", mgmt_errstr(status), status);
tester_warn("Failed to setup HCI emulation");
tester_pre_setup_failed();
}
+
+ if (test && test->setup_le_states)
+ hciemu_set_master_le_states(data->hciemu, test->le_states);
}
static void test_pre_setup(const void *test_data)
mgmt_send(data->mgmt, MGMT_OP_READ_INDEX_LIST, MGMT_INDEX_NONE, 0, NULL,
read_index_list_callback, NULL, NULL);
+
+ data->sk = -1;
}
static void test_post_teardown(const void *test_data)
{
struct test_data *data = tester_get_data();
+ if (data->sk >= 0)
+ close(data->sk);
+
hciemu_unref(data->hciemu);
data->hciemu = NULL;
}
uint16_t send_len;
};
-struct generic_data {
- const uint16_t *setup_settings;
- bool setup_nobredr;
- bool setup_limited_discov;
- uint16_t setup_expect_hci_command;
- const void *setup_expect_hci_param;
- uint8_t setup_expect_hci_len;
- uint16_t setup_send_opcode;
- const void *setup_send_param;
- uint16_t setup_send_len;
- const struct setup_mgmt_cmd *setup_mgmt_cmd_arr;
- bool send_index_none;
- uint16_t send_opcode;
- const void *send_param;
- uint16_t send_len;
- const void * (*send_func)(uint16_t *len);
- uint8_t expect_status;
- bool expect_ignore_param;
- const void *expect_param;
- uint16_t expect_len;
- const void * (*expect_func)(uint16_t *len);
- uint32_t expect_settings_set;
- uint32_t expect_settings_unset;
- uint16_t expect_alt_ev;
- const void *expect_alt_ev_param;
- bool (*verify_alt_ev_func)(const void *param, uint16_t length);
- uint16_t expect_alt_ev_len;
- uint16_t expect_hci_command;
- const void *expect_hci_param;
- uint8_t expect_hci_len;
- const void * (*expect_hci_func)(uint8_t *len);
- bool expect_pin;
- uint8_t pin_len;
- const void *pin;
- uint8_t client_pin_len;
- const void *client_pin;
- bool client_enable_ssp;
- uint8_t io_cap;
- uint8_t client_io_cap;
- uint8_t client_auth_req;
- bool reject_confirm;
- bool client_reject_confirm;
- bool just_works;
- bool client_enable_le;
- bool client_enable_sc;
- bool client_enable_adv;
- bool expect_sc_key;
- bool force_power_off;
- bool addr_type_avail;
- uint8_t addr_type;
- bool set_adv;
- const uint8_t *adv_data;
- uint8_t adv_data_len;
-};
-
static const char dummy_data[] = { 0x00 };
static const struct generic_data invalid_command_test = {
.expect_hci_command = BT_HCI_CMD_READ_LOCAL_OOB_EXT_DATA,
};
+static const uint8_t le_states_conn_slave_adv_connectable[] = {
+ 0x00, 0x00, 0x20, 0x00, 0x40, 0x00, 0x00, 0x00};
+static const uint8_t le_states_conn_slave_adv_non_connectable[] = {
+ 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00};
+static const uint8_t le_states_conn_master_adv_connectable[] = {
+ 0x00, 0x00, 0x08, 0x00, 0x08, 0x00, 0x00, 0x00};
+static const uint8_t le_states_conn_master_adv_non_connectable[] = {
+ 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00};
+
+static const struct generic_data conn_slave_adv_conneactable_test = {
+ .setup_le_states = true,
+ .le_states = le_states_conn_slave_adv_connectable,
+ .setup_settings = settings_powered_le,
+ .client_enable_le = true
+};
+
+static const struct generic_data conn_slave_adv_non_conneactable_test = {
+ .setup_le_states = true,
+ .le_states = le_states_conn_slave_adv_non_connectable,
+ .setup_settings = settings_powered_le,
+ .client_enable_le = true
+};
+
+static const struct generic_data conn_master_adv_conneactable_test = {
+ .setup_le_states = true,
+ .le_states = le_states_conn_master_adv_connectable,
+ .setup_settings = settings_powered_le,
+ .client_enable_le = true,
+ .client_enable_adv = 1
+};
+
+static const struct generic_data conn_master_adv_non_conneactable_test = {
+ .setup_le_states = true,
+ .le_states = le_states_conn_master_adv_non_connectable,
+ .setup_settings = settings_powered_le,
+ .client_enable_le = true,
+ .client_enable_adv = 1
+};
+
static const char ext_ctrl_info1[] = {
0x00, 0x00, 0x00, 0x01, 0xaa, 0x00, /* btaddr */
0x09, /* version */
NULL, NULL);
}
+static int create_le_att_sock(struct test_data *data)
+{
+ struct sockaddr_l2 addr;
+ int sk, err;
+
+ sk = socket(PF_BLUETOOTH, SOCK_SEQPACKET | SOCK_NONBLOCK,
+ BTPROTO_L2CAP);
+ if (sk < 0) {
+ err = -errno;
+ tester_warn("Can't create socket: %s (%d)", strerror(errno),
+ errno);
+ return err;
+ }
+
+ memset(&addr, 0, sizeof(addr));
+ addr.l2_family = AF_BLUETOOTH;
+ addr.l2_psm = 0;
+ addr.l2_cid = htobs(0x0004);
+ addr.l2_bdaddr_type = BDADDR_LE_PUBLIC;
+
+ if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
+ err = -errno;
+ tester_warn("Can't bind socket: %s (%d)", strerror(errno),
+ errno);
+ close(sk);
+ return err;
+ }
+
+ if (listen(sk, 1) < 0) {
+ err = -errno;
+ tester_warn("Can't bind socket: %s (%d)", strerror(errno),
+ errno);
+ close(sk);
+ return err;
+ }
+
+ data->sk = sk;
+
+ return sk;
+}
+
+static void setup_advertise_while_connected(const void *test_data)
+{
+ struct test_data *data = tester_get_data();
+ struct mgmt_cp_add_advertising *cp;
+ uint8_t adv_param[sizeof(*cp) + TESTER_ADD_ADV_DATA_LEN];
+
+ tester_print("Adding advertising instances");
+
+ cp = (struct mgmt_cp_add_advertising *) adv_param;
+ setup_add_adv_param(cp, 1);
+
+ cp->flags |= MGMT_ADV_FLAG_CONNECTABLE;
+ mgmt_send(data->mgmt, MGMT_OP_ADD_ADVERTISING, data->mgmt_index,
+ sizeof(adv_param), adv_param,
+ NULL, NULL, NULL);
+
+ cp->flags &= ~MGMT_ADV_FLAG_CONNECTABLE;
+ cp->instance = 2;
+
+ mgmt_send(data->mgmt, MGMT_OP_ADD_ADVERTISING, data->mgmt_index,
+ sizeof(adv_param), adv_param,
+ setup_add_advertising_callback,
+ NULL, NULL);
+
+ /* Listen on the socket so Kernel does not drop connection just after
+ * connect. Socket is closed in test_post_teardown
+ */
+ if (create_le_att_sock(data) < 0)
+ tester_test_failed();
+}
+
static void setup_add_advertising_timeout(const void *test_data)
{
struct test_data *data = tester_get_data();
bthost_hci_connect(bthost, master_bdaddr, addr_type);
}
+static bool test_adv_enable_hook(const void *data, uint16_t len,
+ void *user_data)
+{
+ struct test_data *test_data = user_data;
+ const uint8_t *status = data;
+
+ if (*status == 0) {
+ tester_print("Advertising enabled");
+ test_condition_complete(test_data);
+ } else {
+ tester_print("Advertising enabled error 0x%02x", *status);
+ }
+
+ return true;
+}
+
+static void disconnected_event(uint16_t index, uint16_t length,
+ const void *param, void *user_data)
+{
+ tester_test_failed();
+}
+
+static void le_connected_event(uint16_t index, uint16_t length,
+ const void *param, void *user_data)
+{
+ struct test_data *data = tester_get_data();
+
+ tester_print("Device connected");
+
+ test_add_condition(data);
+ hciemu_add_hook(data->hciemu, HCIEMU_HOOK_POST_CMD,
+ BT_HCI_CMD_LE_SET_ADV_ENABLE,
+ test_adv_enable_hook, data);
+
+ /* Make sure we get not disconnected during the testaces */
+ mgmt_register(data->mgmt_alt, MGMT_EV_DEVICE_DISCONNECTED,
+ data->mgmt_index, disconnected_event,
+
+ NULL, NULL);
+
+ test_condition_complete(data);
+}
+
+static void add_device_callback(uint8_t status, uint16_t len, const void *param,
+ void *user_data)
+{
+ struct test_data *data = user_data;
+ const struct generic_data *test = data->test_data;
+ struct bthost *bthost;
+ const uint8_t *master_bdaddr;
+
+ if (status != 0) {
+ tester_test_failed();
+ return;
+ }
+
+ tester_print("Device added");
+
+ /* If advertising is enabled on client that means we can stop here and
+ * just wait for connection
+ */
+ if (test->client_enable_adv)
+ return;
+
+ 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_hci_connect(bthost, master_bdaddr, BDADDR_LE_PUBLIC);
+}
+
+static void test_connected_and_advertising(const void *test_data)
+{
+ struct test_data *data = tester_get_data();
+ const struct generic_data *test = data->test_data;
+ const uint8_t *client_bdaddr;
+ struct mgmt_cp_add_device cp;
+
+ tester_print("Registering %s notification",
+ mgmt_evstr(MGMT_EV_DEVICE_CONNECTED));
+
+ test_add_condition(data);
+ mgmt_register(data->mgmt_alt, MGMT_EV_DEVICE_CONNECTED,
+ data->mgmt_index, le_connected_event,
+ NULL, NULL);
+
+ client_bdaddr = hciemu_get_client_bdaddr(data->hciemu);
+ if (!client_bdaddr) {
+ tester_warn("No client bdaddr");
+ tester_test_failed();
+ return;
+ }
+
+ memset(&cp, 0, sizeof(cp));
+ memcpy(&cp.addr.bdaddr, client_bdaddr, 6);
+ cp.addr.type = BDADDR_LE_PUBLIC;
+
+ if (test->client_enable_adv)
+ cp.action = 0x02; /* Auto connect */
+ else
+ cp.action = 0x01; /* Allow incoming connection */
+
+ mgmt_send(data->mgmt_alt, MGMT_OP_ADD_DEVICE, data->mgmt_index,
+ sizeof(cp), &cp,
+ add_device_callback,
+ data, NULL);
+}
+
int main(int argc, char *argv[])
{
tester_init(&argc, &argv);
setup_command_generic,
test_command_generic);
+ test_le_full("Adv. connectable & connected (slave) - Success",
+ &conn_slave_adv_conneactable_test,
+ setup_advertise_while_connected,
+ test_connected_and_advertising, 10);
+
+ test_le_full("Adv. non-connectable & connected (slave) - Success",
+ &conn_slave_adv_non_conneactable_test,
+ setup_advertise_while_connected,
+ test_connected_and_advertising, 10);
+
+ test_le_full("Adv. connectable & connected (master) - Success",
+ &conn_master_adv_conneactable_test,
+ setup_advertise_while_connected,
+ test_connected_and_advertising, 10);
+
+ test_le_full("Adv. non-connectable & connected (master) - Success",
+ &conn_master_adv_non_conneactable_test,
+ setup_advertise_while_connected,
+ test_connected_and_advertising, 10);
+
test_bredrle("Remove Advertising - Invalid Params 1",
&remove_advertising_fail_1,
NULL, test_command_generic);