korg/bluez
0
0
Fork 0
mirror of https://git.kernel.org/pub/scm/bluetooth/bluez.git synced 2024-11-16 16:54:38 +08:00
Code Issues Packages Projects Releases Wiki Activity

emulator: implement write_scan_enable support

Browse Source
This commit is contained in:
Johan Hedberg 2013-05-22 12:28:51 -07:00
parent b76f55ce12
commit af2c5941cc
4 changed files with 75 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
emulator/bthost.c
View File

@ -58,6 +58,8 @@ struct bthost {
void *send_data;
struct cmd_queue cmd_q;
uint8_t ncmd;
bthost_cmd_complete_cb cmd_complete_cb;
void *cmd_complete_data;
};
struct bthost *bthost_create(void)
@ -224,6 +226,10 @@ static void evt_cmd_complete(struct bthost *bthost, const void *data,
break;
}
if (bthost->cmd_complete_cb)
bthost->cmd_complete_cb(opcode, 0, param, len - sizeof(*ev),
bthost->cmd_complete_data);
next_cmd(bthost);
}
@ -231,12 +237,19 @@ static void evt_cmd_status(struct bthost *bthost, const void *data,
uint8_t len)
{
const struct bt_hci_evt_cmd_status *ev = data;
uint16_t opcode;
if (len < sizeof(*ev))
return;
bthost->ncmd = ev->ncmd;
opcode = le16toh(ev->opcode);
if (ev->status && bthost->cmd_complete_cb)
bthost->cmd_complete_cb(opcode, ev->status, NULL, 0,
bthost->cmd_complete_data);
next_cmd(bthost);
}
@ -290,6 +303,18 @@ void bthost_receive_h4(struct bthost *bthost, const void *data, uint16_t len)
}
}
void bthost_set_cmd_complete_cb(struct bthost *bthost,
bthost_cmd_complete_cb cb, void *user_data)
{
bthost->cmd_complete_cb = cb;
bthost->cmd_complete_data = user_data;
}
void bthost_write_scan_enable(struct bthost *bthost, uint8_t scan)
{
send_command(bthost, BT_HCI_CMD_WRITE_SCAN_ENABLE, &scan, 1);
}
void bthost_start(struct bthost *bthost)
{
if (!bthost)

9
emulator/bthost.h
View File

@ -37,5 +37,14 @@ void bthost_set_send_handler(struct bthost *bthost, bthost_send_func handler,
void bthost_receive_h4(struct bthost *bthost, const void *data, uint16_t len);
typedef void (*bthost_cmd_complete_cb) (uint16_t opcode, uint8_t status,
const void *param, uint8_t len,
void *user_data);
void bthost_set_cmd_complete_cb(struct bthost *bthost,
bthost_cmd_complete_cb cb, void *user_data);
void bthost_write_scan_enable(struct bthost *bthost, uint8_t scan);
void bthost_start(struct bthost *bthost);
void bthost_stop(struct bthost *bthost);

36
src/shared/hciemu.c
View File

@ -51,6 +51,8 @@ struct hciemu {
guint client_source;
GList *post_command_hooks;
char bdaddr_str[18];
hciemu_scan_enable_cb scan_enable_cb;
void *scan_enable_data;
};
struct hciemu_command_hook {
@ -215,6 +217,29 @@ static bool create_vhci(struct hciemu *hciemu)
return true;
}
static void client_cmd_complete(uint16_t opcode, uint8_t status,
const void *param, uint8_t len,
void *user_data)
{
struct hciemu *hciemu = user_data;
switch (opcode) {
case BT_HCI_CMD_WRITE_SCAN_ENABLE:
if (!hciemu->scan_enable_cb)
break;
hciemu->scan_enable_cb(status, hciemu->scan_enable_data);
hciemu->scan_enable_cb = NULL;
hciemu->scan_enable_data = NULL;
break;
default:
break;
}
}
static bool create_stack(struct hciemu *hciemu)
{
struct btdev *btdev;
@ -231,6 +256,8 @@ static bool create_stack(struct hciemu *hciemu)
return false;
}
bthost_set_cmd_complete_cb(bthost, client_cmd_complete, hciemu);
btdev_set_command_handler(btdev, client_command_callback, hciemu);
if (socketpair(AF_UNIX, SOCK_SEQPACKET | SOCK_NONBLOCK | SOCK_CLOEXEC,
@ -331,6 +358,15 @@ void hciemu_unref(struct hciemu *hciemu)
g_free(hciemu);
}
void hciemu_client_scan_enable(struct hciemu *hciemu, uint8_t scan,
hciemu_scan_enable_cb cb, void *user_data)
{
hciemu->scan_enable_cb = cb;
hciemu->scan_enable_data = user_data;
bthost_write_scan_enable(hciemu->host_stack, scan);
}
const char *hciemu_get_address(struct hciemu *hciemu)
{
const uint8_t *addr;

5
src/shared/hciemu.h
View File

@ -37,6 +37,11 @@ struct hciemu *hciemu_new(enum hciemu_type type);
struct hciemu *hciemu_ref(struct hciemu *hciemu);
void hciemu_unref(struct hciemu *hciemu);
typedef void (*hciemu_scan_enable_cb)(uint8_t status, void *user_data);
void hciemu_client_scan_enable(struct hciemu *hciemu, uint8_t scan,
hciemu_scan_enable_cb cb, void *user_data);
const char *hciemu_get_address(struct hciemu *hciemu);
typedef void (*hciemu_command_func_t)(uint16_t opcode, const void *data,