|
@@ -255,7 +255,7 @@ static struct pending_cmd *mgmt_pending_add(struct sock *sk, u16 opcode,
|
|
return cmd;
|
|
return cmd;
|
|
}
|
|
}
|
|
|
|
|
|
-static void mgmt_pending_foreach(u16 opcode, int index,
|
|
|
|
|
|
+static void mgmt_pending_foreach(u16 opcode, struct hci_dev *hdev,
|
|
void (*cb)(struct pending_cmd *cmd, void *data),
|
|
void (*cb)(struct pending_cmd *cmd, void *data),
|
|
void *data)
|
|
void *data)
|
|
{
|
|
{
|
|
@@ -269,7 +269,7 @@ static void mgmt_pending_foreach(u16 opcode, int index,
|
|
if (opcode > 0 && cmd->opcode != opcode)
|
|
if (opcode > 0 && cmd->opcode != opcode)
|
|
continue;
|
|
continue;
|
|
|
|
|
|
- if (index >= 0 && cmd->index != index)
|
|
|
|
|
|
+ if (hdev && cmd->index != hdev->id)
|
|
continue;
|
|
continue;
|
|
|
|
|
|
cb(cmd, data);
|
|
cb(cmd, data);
|
|
@@ -475,8 +475,8 @@ failed:
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-static int mgmt_event(u16 event, u16 index, void *data, u16 data_len,
|
|
|
|
- struct sock *skip_sk)
|
|
|
|
|
|
+static int mgmt_event(u16 event, struct hci_dev *hdev, void *data,
|
|
|
|
+ u16 data_len, struct sock *skip_sk)
|
|
{
|
|
{
|
|
struct sk_buff *skb;
|
|
struct sk_buff *skb;
|
|
struct mgmt_hdr *hdr;
|
|
struct mgmt_hdr *hdr;
|
|
@@ -489,7 +489,10 @@ static int mgmt_event(u16 event, u16 index, void *data, u16 data_len,
|
|
|
|
|
|
hdr = (void *) skb_put(skb, sizeof(*hdr));
|
|
hdr = (void *) skb_put(skb, sizeof(*hdr));
|
|
hdr->opcode = cpu_to_le16(event);
|
|
hdr->opcode = cpu_to_le16(event);
|
|
- hdr->index = cpu_to_le16(index);
|
|
|
|
|
|
+ if (hdev)
|
|
|
|
+ hdr->index = cpu_to_le16(hdev->id);
|
|
|
|
+ else
|
|
|
|
+ hdr->index = cpu_to_le16(MGMT_INDEX_NONE);
|
|
hdr->len = cpu_to_le16(data_len);
|
|
hdr->len = cpu_to_le16(data_len);
|
|
|
|
|
|
if (data)
|
|
if (data)
|
|
@@ -541,7 +544,7 @@ static int set_pairable(struct sock *sk, u16 index, unsigned char *data,
|
|
|
|
|
|
ev.val = cp->val;
|
|
ev.val = cp->val;
|
|
|
|
|
|
- err = mgmt_event(MGMT_EV_PAIRABLE, index, &ev, sizeof(ev), sk);
|
|
|
|
|
|
+ err = mgmt_event(MGMT_EV_PAIRABLE, hdev, &ev, sizeof(ev), sk);
|
|
|
|
|
|
failed:
|
|
failed:
|
|
hci_dev_unlock_bh(hdev);
|
|
hci_dev_unlock_bh(hdev);
|
|
@@ -1966,18 +1969,18 @@ static void cmd_status_rsp(struct pending_cmd *cmd, void *data)
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_index_added(u16 index)
|
|
|
|
|
|
+int mgmt_index_added(struct hci_dev *hdev)
|
|
{
|
|
{
|
|
- return mgmt_event(MGMT_EV_INDEX_ADDED, index, NULL, 0, NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_INDEX_ADDED, hdev, NULL, 0, NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_index_removed(u16 index)
|
|
|
|
|
|
+int mgmt_index_removed(struct hci_dev *hdev)
|
|
{
|
|
{
|
|
u8 status = ENODEV;
|
|
u8 status = ENODEV;
|
|
|
|
|
|
- mgmt_pending_foreach(0, index, cmd_status_rsp, &status);
|
|
|
|
|
|
+ mgmt_pending_foreach(0, hdev, cmd_status_rsp, &status);
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_INDEX_REMOVED, index, NULL, 0, NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_INDEX_REMOVED, hdev, NULL, 0, NULL);
|
|
}
|
|
}
|
|
|
|
|
|
struct cmd_lookup {
|
|
struct cmd_lookup {
|
|
@@ -2005,22 +2008,22 @@ static void mode_rsp(struct pending_cmd *cmd, void *data)
|
|
mgmt_pending_free(cmd);
|
|
mgmt_pending_free(cmd);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_powered(u16 index, u8 powered)
|
|
|
|
|
|
+int mgmt_powered(struct hci_dev *hdev, u8 powered)
|
|
{
|
|
{
|
|
struct mgmt_mode ev;
|
|
struct mgmt_mode ev;
|
|
struct cmd_lookup match = { powered, NULL };
|
|
struct cmd_lookup match = { powered, NULL };
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- mgmt_pending_foreach(MGMT_OP_SET_POWERED, index, mode_rsp, &match);
|
|
|
|
|
|
+ mgmt_pending_foreach(MGMT_OP_SET_POWERED, hdev, mode_rsp, &match);
|
|
|
|
|
|
if (!powered) {
|
|
if (!powered) {
|
|
u8 status = ENETDOWN;
|
|
u8 status = ENETDOWN;
|
|
- mgmt_pending_foreach(0, index, cmd_status_rsp, &status);
|
|
|
|
|
|
+ mgmt_pending_foreach(0, hdev, cmd_status_rsp, &status);
|
|
}
|
|
}
|
|
|
|
|
|
ev.val = powered;
|
|
ev.val = powered;
|
|
|
|
|
|
- ret = mgmt_event(MGMT_EV_POWERED, index, &ev, sizeof(ev), match.sk);
|
|
|
|
|
|
+ ret = mgmt_event(MGMT_EV_POWERED, hdev, &ev, sizeof(ev), match.sk);
|
|
|
|
|
|
if (match.sk)
|
|
if (match.sk)
|
|
sock_put(match.sk);
|
|
sock_put(match.sk);
|
|
@@ -2028,17 +2031,17 @@ int mgmt_powered(u16 index, u8 powered)
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_discoverable(u16 index, u8 discoverable)
|
|
|
|
|
|
+int mgmt_discoverable(struct hci_dev *hdev, u8 discoverable)
|
|
{
|
|
{
|
|
struct mgmt_mode ev;
|
|
struct mgmt_mode ev;
|
|
struct cmd_lookup match = { discoverable, NULL };
|
|
struct cmd_lookup match = { discoverable, NULL };
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- mgmt_pending_foreach(MGMT_OP_SET_DISCOVERABLE, index, mode_rsp, &match);
|
|
|
|
|
|
+ mgmt_pending_foreach(MGMT_OP_SET_DISCOVERABLE, hdev, mode_rsp, &match);
|
|
|
|
|
|
ev.val = discoverable;
|
|
ev.val = discoverable;
|
|
|
|
|
|
- ret = mgmt_event(MGMT_EV_DISCOVERABLE, index, &ev, sizeof(ev),
|
|
|
|
|
|
+ ret = mgmt_event(MGMT_EV_DISCOVERABLE, hdev, &ev, sizeof(ev),
|
|
match.sk);
|
|
match.sk);
|
|
|
|
|
|
if (match.sk)
|
|
if (match.sk)
|
|
@@ -2047,17 +2050,17 @@ int mgmt_discoverable(u16 index, u8 discoverable)
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_connectable(u16 index, u8 connectable)
|
|
|
|
|
|
+int mgmt_connectable(struct hci_dev *hdev, u8 connectable)
|
|
{
|
|
{
|
|
struct mgmt_mode ev;
|
|
struct mgmt_mode ev;
|
|
struct cmd_lookup match = { connectable, NULL };
|
|
struct cmd_lookup match = { connectable, NULL };
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- mgmt_pending_foreach(MGMT_OP_SET_CONNECTABLE, index, mode_rsp, &match);
|
|
|
|
|
|
+ mgmt_pending_foreach(MGMT_OP_SET_CONNECTABLE, hdev, mode_rsp, &match);
|
|
|
|
|
|
ev.val = connectable;
|
|
ev.val = connectable;
|
|
|
|
|
|
- ret = mgmt_event(MGMT_EV_CONNECTABLE, index, &ev, sizeof(ev), match.sk);
|
|
|
|
|
|
+ ret = mgmt_event(MGMT_EV_CONNECTABLE, hdev, &ev, sizeof(ev), match.sk);
|
|
|
|
|
|
if (match.sk)
|
|
if (match.sk)
|
|
sock_put(match.sk);
|
|
sock_put(match.sk);
|
|
@@ -2065,20 +2068,21 @@ int mgmt_connectable(u16 index, u8 connectable)
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_write_scan_failed(u16 index, u8 scan, u8 status)
|
|
|
|
|
|
+int mgmt_write_scan_failed(struct hci_dev *hdev, u8 scan, u8 status)
|
|
{
|
|
{
|
|
if (scan & SCAN_PAGE)
|
|
if (scan & SCAN_PAGE)
|
|
- mgmt_pending_foreach(MGMT_OP_SET_CONNECTABLE, index,
|
|
|
|
|
|
+ mgmt_pending_foreach(MGMT_OP_SET_CONNECTABLE, hdev,
|
|
cmd_status_rsp, &status);
|
|
cmd_status_rsp, &status);
|
|
|
|
|
|
if (scan & SCAN_INQUIRY)
|
|
if (scan & SCAN_INQUIRY)
|
|
- mgmt_pending_foreach(MGMT_OP_SET_DISCOVERABLE, index,
|
|
|
|
|
|
+ mgmt_pending_foreach(MGMT_OP_SET_DISCOVERABLE, hdev,
|
|
cmd_status_rsp, &status);
|
|
cmd_status_rsp, &status);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_new_link_key(u16 index, struct link_key *key, u8 persistent)
|
|
|
|
|
|
+int mgmt_new_link_key(struct hci_dev *hdev, struct link_key *key,
|
|
|
|
+ u8 persistent)
|
|
{
|
|
{
|
|
struct mgmt_ev_new_link_key ev;
|
|
struct mgmt_ev_new_link_key ev;
|
|
|
|
|
|
@@ -2090,17 +2094,17 @@ int mgmt_new_link_key(u16 index, struct link_key *key, u8 persistent)
|
|
memcpy(ev.key.val, key->val, 16);
|
|
memcpy(ev.key.val, key->val, 16);
|
|
ev.key.pin_len = key->pin_len;
|
|
ev.key.pin_len = key->pin_len;
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_NEW_LINK_KEY, index, &ev, sizeof(ev), NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_NEW_LINK_KEY, hdev, &ev, sizeof(ev), NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_connected(u16 index, bdaddr_t *bdaddr, u8 link_type)
|
|
|
|
|
|
+int mgmt_connected(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 link_type)
|
|
{
|
|
{
|
|
struct mgmt_addr_info ev;
|
|
struct mgmt_addr_info ev;
|
|
|
|
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
ev.type = link_to_mgmt(link_type);
|
|
ev.type = link_to_mgmt(link_type);
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_CONNECTED, index, &ev, sizeof(ev), NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_CONNECTED, hdev, &ev, sizeof(ev), NULL);
|
|
}
|
|
}
|
|
|
|
|
|
static void disconnect_rsp(struct pending_cmd *cmd, void *data)
|
|
static void disconnect_rsp(struct pending_cmd *cmd, void *data)
|
|
@@ -2119,18 +2123,18 @@ static void disconnect_rsp(struct pending_cmd *cmd, void *data)
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_disconnected(u16 index, bdaddr_t *bdaddr, u8 type)
|
|
|
|
|
|
+int mgmt_disconnected(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type)
|
|
{
|
|
{
|
|
struct mgmt_addr_info ev;
|
|
struct mgmt_addr_info ev;
|
|
struct sock *sk = NULL;
|
|
struct sock *sk = NULL;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- mgmt_pending_foreach(MGMT_OP_DISCONNECT, index, disconnect_rsp, &sk);
|
|
|
|
|
|
+ mgmt_pending_foreach(MGMT_OP_DISCONNECT, hdev, disconnect_rsp, &sk);
|
|
|
|
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
ev.type = link_to_mgmt(type);
|
|
ev.type = link_to_mgmt(type);
|
|
|
|
|
|
- err = mgmt_event(MGMT_EV_DISCONNECTED, index, &ev, sizeof(ev), sk);
|
|
|
|
|
|
+ err = mgmt_event(MGMT_EV_DISCONNECTED, hdev, &ev, sizeof(ev), sk);
|
|
|
|
|
|
if (sk)
|
|
if (sk)
|
|
sock_put(sk);
|
|
sock_put(sk);
|
|
@@ -2138,23 +2142,24 @@ int mgmt_disconnected(u16 index, bdaddr_t *bdaddr, u8 type)
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_disconnect_failed(u16 index)
|
|
|
|
|
|
+int mgmt_disconnect_failed(struct hci_dev *hdev)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_DISCONNECT, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_DISCONNECT, hdev->id);
|
|
if (!cmd)
|
|
if (!cmd)
|
|
return -ENOENT;
|
|
return -ENOENT;
|
|
|
|
|
|
- err = cmd_status(cmd->sk, index, MGMT_OP_DISCONNECT, EIO);
|
|
|
|
|
|
+ err = cmd_status(cmd->sk, hdev->id, MGMT_OP_DISCONNECT, EIO);
|
|
|
|
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
|
|
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_connect_failed(u16 index, bdaddr_t *bdaddr, u8 type, u8 status)
|
|
|
|
|
|
+int mgmt_connect_failed(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type,
|
|
|
|
+ u8 status)
|
|
{
|
|
{
|
|
struct mgmt_ev_connect_failed ev;
|
|
struct mgmt_ev_connect_failed ev;
|
|
|
|
|
|
@@ -2162,34 +2167,35 @@ int mgmt_connect_failed(u16 index, bdaddr_t *bdaddr, u8 type, u8 status)
|
|
ev.addr.type = link_to_mgmt(type);
|
|
ev.addr.type = link_to_mgmt(type);
|
|
ev.status = status;
|
|
ev.status = status;
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_CONNECT_FAILED, index, &ev, sizeof(ev), NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_CONNECT_FAILED, hdev, &ev, sizeof(ev), NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_pin_code_request(u16 index, bdaddr_t *bdaddr, u8 secure)
|
|
|
|
|
|
+int mgmt_pin_code_request(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 secure)
|
|
{
|
|
{
|
|
struct mgmt_ev_pin_code_request ev;
|
|
struct mgmt_ev_pin_code_request ev;
|
|
|
|
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
ev.secure = secure;
|
|
ev.secure = secure;
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_PIN_CODE_REQUEST, index, &ev, sizeof(ev),
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_PIN_CODE_REQUEST, hdev, &ev, sizeof(ev),
|
|
NULL);
|
|
NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_pin_code_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
|
|
|
|
|
|
+int mgmt_pin_code_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
|
|
|
|
+ u8 status)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
struct mgmt_rp_pin_code_reply rp;
|
|
struct mgmt_rp_pin_code_reply rp;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_REPLY, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_REPLY, hdev->id);
|
|
if (!cmd)
|
|
if (!cmd)
|
|
return -ENOENT;
|
|
return -ENOENT;
|
|
|
|
|
|
bacpy(&rp.bdaddr, bdaddr);
|
|
bacpy(&rp.bdaddr, bdaddr);
|
|
rp.status = status;
|
|
rp.status = status;
|
|
|
|
|
|
- err = cmd_complete(cmd->sk, index, MGMT_OP_PIN_CODE_REPLY, &rp,
|
|
|
|
|
|
+ err = cmd_complete(cmd->sk, hdev->id, MGMT_OP_PIN_CODE_REPLY, &rp,
|
|
sizeof(rp));
|
|
sizeof(rp));
|
|
|
|
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
@@ -2197,20 +2203,21 @@ int mgmt_pin_code_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_pin_code_neg_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
|
|
|
|
|
|
+int mgmt_pin_code_neg_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
|
|
|
|
+ u8 status)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
struct mgmt_rp_pin_code_reply rp;
|
|
struct mgmt_rp_pin_code_reply rp;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_NEG_REPLY, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_NEG_REPLY, hdev->id);
|
|
if (!cmd)
|
|
if (!cmd)
|
|
return -ENOENT;
|
|
return -ENOENT;
|
|
|
|
|
|
bacpy(&rp.bdaddr, bdaddr);
|
|
bacpy(&rp.bdaddr, bdaddr);
|
|
rp.status = status;
|
|
rp.status = status;
|
|
|
|
|
|
- err = cmd_complete(cmd->sk, index, MGMT_OP_PIN_CODE_NEG_REPLY, &rp,
|
|
|
|
|
|
+ err = cmd_complete(cmd->sk, hdev->id, MGMT_OP_PIN_CODE_NEG_REPLY, &rp,
|
|
sizeof(rp));
|
|
sizeof(rp));
|
|
|
|
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
@@ -2218,97 +2225,95 @@ int mgmt_pin_code_neg_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_user_confirm_request(u16 index, bdaddr_t *bdaddr, __le32 value,
|
|
|
|
- u8 confirm_hint)
|
|
|
|
|
|
+int mgmt_user_confirm_request(struct hci_dev *hdev, bdaddr_t *bdaddr,
|
|
|
|
+ __le32 value, u8 confirm_hint)
|
|
{
|
|
{
|
|
struct mgmt_ev_user_confirm_request ev;
|
|
struct mgmt_ev_user_confirm_request ev;
|
|
|
|
|
|
- BT_DBG("hci%u", index);
|
|
|
|
|
|
+ BT_DBG("%s", hdev->name);
|
|
|
|
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
ev.confirm_hint = confirm_hint;
|
|
ev.confirm_hint = confirm_hint;
|
|
put_unaligned_le32(value, &ev.value);
|
|
put_unaligned_le32(value, &ev.value);
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_USER_CONFIRM_REQUEST, index, &ev, sizeof(ev),
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_USER_CONFIRM_REQUEST, hdev, &ev, sizeof(ev),
|
|
NULL);
|
|
NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-static int confirm_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status,
|
|
|
|
- u8 opcode)
|
|
|
|
|
|
+static int confirm_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
|
|
|
|
+ u8 status, u8 opcode)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
struct mgmt_rp_user_confirm_reply rp;
|
|
struct mgmt_rp_user_confirm_reply rp;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- cmd = mgmt_pending_find(opcode, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(opcode, hdev->id);
|
|
if (!cmd)
|
|
if (!cmd)
|
|
return -ENOENT;
|
|
return -ENOENT;
|
|
|
|
|
|
bacpy(&rp.bdaddr, bdaddr);
|
|
bacpy(&rp.bdaddr, bdaddr);
|
|
rp.status = status;
|
|
rp.status = status;
|
|
- err = cmd_complete(cmd->sk, index, opcode, &rp, sizeof(rp));
|
|
|
|
|
|
+ err = cmd_complete(cmd->sk, hdev->id, opcode, &rp, sizeof(rp));
|
|
|
|
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
|
|
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_user_confirm_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
|
|
|
|
|
|
+int mgmt_user_confirm_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
|
|
|
|
+ u8 status)
|
|
{
|
|
{
|
|
- return confirm_reply_complete(index, bdaddr, status,
|
|
|
|
|
|
+ return confirm_reply_complete(hdev, bdaddr, status,
|
|
MGMT_OP_USER_CONFIRM_REPLY);
|
|
MGMT_OP_USER_CONFIRM_REPLY);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_user_confirm_neg_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
|
|
|
|
|
|
+int mgmt_user_confirm_neg_reply_complete(struct hci_dev *hdev,
|
|
|
|
+ bdaddr_t *bdaddr, u8 status)
|
|
{
|
|
{
|
|
- return confirm_reply_complete(index, bdaddr, status,
|
|
|
|
|
|
+ return confirm_reply_complete(hdev, bdaddr, status,
|
|
MGMT_OP_USER_CONFIRM_NEG_REPLY);
|
|
MGMT_OP_USER_CONFIRM_NEG_REPLY);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_auth_failed(u16 index, bdaddr_t *bdaddr, u8 status)
|
|
|
|
|
|
+int mgmt_auth_failed(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 status)
|
|
{
|
|
{
|
|
struct mgmt_ev_auth_failed ev;
|
|
struct mgmt_ev_auth_failed ev;
|
|
|
|
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
ev.status = status;
|
|
ev.status = status;
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_AUTH_FAILED, index, &ev, sizeof(ev), NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_AUTH_FAILED, hdev, &ev, sizeof(ev), NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_set_local_name_complete(u16 index, u8 *name, u8 status)
|
|
|
|
|
|
+int mgmt_set_local_name_complete(struct hci_dev *hdev, u8 *name, u8 status)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
- struct hci_dev *hdev;
|
|
|
|
struct mgmt_cp_set_local_name ev;
|
|
struct mgmt_cp_set_local_name ev;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
memset(&ev, 0, sizeof(ev));
|
|
memset(&ev, 0, sizeof(ev));
|
|
memcpy(ev.name, name, HCI_MAX_NAME_LENGTH);
|
|
memcpy(ev.name, name, HCI_MAX_NAME_LENGTH);
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_SET_LOCAL_NAME, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_SET_LOCAL_NAME, hdev->id);
|
|
if (!cmd)
|
|
if (!cmd)
|
|
goto send_event;
|
|
goto send_event;
|
|
|
|
|
|
if (status) {
|
|
if (status) {
|
|
- err = cmd_status(cmd->sk, index, MGMT_OP_SET_LOCAL_NAME, EIO);
|
|
|
|
|
|
+ err = cmd_status(cmd->sk, hdev->id, MGMT_OP_SET_LOCAL_NAME,
|
|
|
|
+ EIO);
|
|
goto failed;
|
|
goto failed;
|
|
}
|
|
}
|
|
|
|
|
|
- hdev = hci_dev_get(index);
|
|
|
|
- if (hdev) {
|
|
|
|
- hci_dev_lock_bh(hdev);
|
|
|
|
- update_eir(hdev);
|
|
|
|
- hci_dev_unlock_bh(hdev);
|
|
|
|
- hci_dev_put(hdev);
|
|
|
|
- }
|
|
|
|
|
|
+ hci_dev_lock_bh(hdev);
|
|
|
|
+ update_eir(hdev);
|
|
|
|
+ hci_dev_unlock_bh(hdev);
|
|
|
|
|
|
- err = cmd_complete(cmd->sk, index, MGMT_OP_SET_LOCAL_NAME, &ev,
|
|
|
|
|
|
+ err = cmd_complete(cmd->sk, hdev->id, MGMT_OP_SET_LOCAL_NAME, &ev,
|
|
sizeof(ev));
|
|
sizeof(ev));
|
|
if (err < 0)
|
|
if (err < 0)
|
|
goto failed;
|
|
goto failed;
|
|
|
|
|
|
send_event:
|
|
send_event:
|
|
- err = mgmt_event(MGMT_EV_LOCAL_NAME_CHANGED, index, &ev, sizeof(ev),
|
|
|
|
|
|
+ err = mgmt_event(MGMT_EV_LOCAL_NAME_CHANGED, hdev, &ev, sizeof(ev),
|
|
cmd ? cmd->sk : NULL);
|
|
cmd ? cmd->sk : NULL);
|
|
|
|
|
|
failed:
|
|
failed:
|
|
@@ -2317,29 +2322,30 @@ failed:
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_read_local_oob_data_reply_complete(u16 index, u8 *hash, u8 *randomizer,
|
|
|
|
- u8 status)
|
|
|
|
|
|
+int mgmt_read_local_oob_data_reply_complete(struct hci_dev *hdev, u8 *hash,
|
|
|
|
+ u8 *randomizer, u8 status)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- BT_DBG("hci%u status %u", index, status);
|
|
|
|
|
|
+ BT_DBG("%s status %u", hdev->name, status);
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_READ_LOCAL_OOB_DATA, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_READ_LOCAL_OOB_DATA, hdev->id);
|
|
if (!cmd)
|
|
if (!cmd)
|
|
return -ENOENT;
|
|
return -ENOENT;
|
|
|
|
|
|
if (status) {
|
|
if (status) {
|
|
- err = cmd_status(cmd->sk, index, MGMT_OP_READ_LOCAL_OOB_DATA,
|
|
|
|
- EIO);
|
|
|
|
|
|
+ err = cmd_status(cmd->sk, hdev->id,
|
|
|
|
+ MGMT_OP_READ_LOCAL_OOB_DATA, EIO);
|
|
} else {
|
|
} else {
|
|
struct mgmt_rp_read_local_oob_data rp;
|
|
struct mgmt_rp_read_local_oob_data rp;
|
|
|
|
|
|
memcpy(rp.hash, hash, sizeof(rp.hash));
|
|
memcpy(rp.hash, hash, sizeof(rp.hash));
|
|
memcpy(rp.randomizer, randomizer, sizeof(rp.randomizer));
|
|
memcpy(rp.randomizer, randomizer, sizeof(rp.randomizer));
|
|
|
|
|
|
- err = cmd_complete(cmd->sk, index, MGMT_OP_READ_LOCAL_OOB_DATA,
|
|
|
|
- &rp, sizeof(rp));
|
|
|
|
|
|
+ err = cmd_complete(cmd->sk, hdev->id,
|
|
|
|
+ MGMT_OP_READ_LOCAL_OOB_DATA,
|
|
|
|
+ &rp, sizeof(rp));
|
|
}
|
|
}
|
|
|
|
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
@@ -2347,8 +2353,8 @@ int mgmt_read_local_oob_data_reply_complete(u16 index, u8 *hash, u8 *randomizer,
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_device_found(u16 index, bdaddr_t *bdaddr, u8 type, u8 *dev_class,
|
|
|
|
- s8 rssi, u8 *eir)
|
|
|
|
|
|
+int mgmt_device_found(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type,
|
|
|
|
+ u8 *dev_class, s8 rssi, u8 *eir)
|
|
{
|
|
{
|
|
struct mgmt_ev_device_found ev;
|
|
struct mgmt_ev_device_found ev;
|
|
|
|
|
|
@@ -2364,10 +2370,10 @@ int mgmt_device_found(u16 index, bdaddr_t *bdaddr, u8 type, u8 *dev_class,
|
|
if (dev_class)
|
|
if (dev_class)
|
|
memcpy(ev.dev_class, dev_class, sizeof(ev.dev_class));
|
|
memcpy(ev.dev_class, dev_class, sizeof(ev.dev_class));
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_DEVICE_FOUND, index, &ev, sizeof(ev), NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_DEVICE_FOUND, hdev, &ev, sizeof(ev), NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_remote_name(u16 index, bdaddr_t *bdaddr, u8 *name)
|
|
|
|
|
|
+int mgmt_remote_name(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 *name)
|
|
{
|
|
{
|
|
struct mgmt_ev_remote_name ev;
|
|
struct mgmt_ev_remote_name ev;
|
|
|
|
|
|
@@ -2376,64 +2382,64 @@ int mgmt_remote_name(u16 index, bdaddr_t *bdaddr, u8 *name)
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
memcpy(ev.name, name, HCI_MAX_NAME_LENGTH);
|
|
memcpy(ev.name, name, HCI_MAX_NAME_LENGTH);
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_REMOTE_NAME, index, &ev, sizeof(ev), NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_REMOTE_NAME, hdev, &ev, sizeof(ev), NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_inquiry_failed(u16 index, u8 status)
|
|
|
|
|
|
+int mgmt_inquiry_failed(struct hci_dev *hdev, u8 status)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_START_DISCOVERY, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_START_DISCOVERY, hdev->id);
|
|
if (!cmd)
|
|
if (!cmd)
|
|
return -ENOENT;
|
|
return -ENOENT;
|
|
|
|
|
|
- err = cmd_status(cmd->sk, index, cmd->opcode, status);
|
|
|
|
|
|
+ err = cmd_status(cmd->sk, hdev->id, cmd->opcode, status);
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
|
|
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_discovering(u16 index, u8 discovering)
|
|
|
|
|
|
+int mgmt_discovering(struct hci_dev *hdev, u8 discovering)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
|
|
|
|
if (discovering)
|
|
if (discovering)
|
|
- cmd = mgmt_pending_find(MGMT_OP_START_DISCOVERY, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_START_DISCOVERY, hdev->id);
|
|
else
|
|
else
|
|
- cmd = mgmt_pending_find(MGMT_OP_STOP_DISCOVERY, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_STOP_DISCOVERY, hdev->id);
|
|
|
|
|
|
if (cmd != NULL) {
|
|
if (cmd != NULL) {
|
|
- cmd_complete(cmd->sk, index, cmd->opcode, NULL, 0);
|
|
|
|
|
|
+ cmd_complete(cmd->sk, hdev->id, cmd->opcode, NULL, 0);
|
|
mgmt_pending_remove(cmd);
|
|
mgmt_pending_remove(cmd);
|
|
}
|
|
}
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_DISCOVERING, index, &discovering,
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_DISCOVERING, hdev, &discovering,
|
|
sizeof(discovering), NULL);
|
|
sizeof(discovering), NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_device_blocked(u16 index, bdaddr_t *bdaddr)
|
|
|
|
|
|
+int mgmt_device_blocked(struct hci_dev *hdev, bdaddr_t *bdaddr)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
struct mgmt_ev_device_blocked ev;
|
|
struct mgmt_ev_device_blocked ev;
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_BLOCK_DEVICE, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_BLOCK_DEVICE, hdev->id);
|
|
|
|
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_DEVICE_BLOCKED, index, &ev, sizeof(ev),
|
|
|
|
- cmd ? cmd->sk : NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_DEVICE_BLOCKED, hdev, &ev, sizeof(ev),
|
|
|
|
+ cmd ? cmd->sk : NULL);
|
|
}
|
|
}
|
|
|
|
|
|
-int mgmt_device_unblocked(u16 index, bdaddr_t *bdaddr)
|
|
|
|
|
|
+int mgmt_device_unblocked(struct hci_dev *hdev, bdaddr_t *bdaddr)
|
|
{
|
|
{
|
|
struct pending_cmd *cmd;
|
|
struct pending_cmd *cmd;
|
|
struct mgmt_ev_device_unblocked ev;
|
|
struct mgmt_ev_device_unblocked ev;
|
|
|
|
|
|
- cmd = mgmt_pending_find(MGMT_OP_UNBLOCK_DEVICE, index);
|
|
|
|
|
|
+ cmd = mgmt_pending_find(MGMT_OP_UNBLOCK_DEVICE, hdev->id);
|
|
|
|
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
bacpy(&ev.bdaddr, bdaddr);
|
|
|
|
|
|
- return mgmt_event(MGMT_EV_DEVICE_UNBLOCKED, index, &ev, sizeof(ev),
|
|
|
|
- cmd ? cmd->sk : NULL);
|
|
|
|
|
|
+ return mgmt_event(MGMT_EV_DEVICE_UNBLOCKED, hdev, &ev, sizeof(ev),
|
|
|
|
+ cmd ? cmd->sk : NULL);
|
|
}
|
|
}
|