mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-03 19:03:57 +08:00
Bluetooth: HCI: Use skb_pull_data to parse BR/EDR events
This uses skb_pull_data to check the BR/EDR events received have the minimum required length. Signed-off-by: Luiz Augusto von Dentz <luiz.von.dentz@intel.com> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
Luiz Augusto von Dentz
Marcel Holtmann
parent
13244cccc2
commit
ae61a10d9d
@ -2012,6 +2012,10 @@ struct hci_cp_le_reject_cis {
|
||||
} __packed;
|
||||
|
||||
/* ---- HCI Events ---- */
|
||||
struct hci_ev_status {
|
||||
__u8 status;
|
||||
} __packed;
|
||||
|
||||
#define HCI_EV_INQUIRY_COMPLETE 0x01
|
||||
|
||||
#define HCI_EV_INQUIRY_RESULT 0x02
|
||||
|
||||
@ -45,6 +45,18 @@
|
||||
|
||||
/* Handle HCI Event packets */
|
||||
|
||||
static void *hci_ev_skb_pull(struct hci_dev *hdev, struct sk_buff *skb,
|
||||
u8 ev, size_t len)
|
||||
{
|
||||
void *data;
|
||||
|
||||
data = skb_pull_data(skb, len);
|
||||
if (!data)
|
||||
bt_dev_err(hdev, "Malformed Event: 0x%2.2x", ev);
|
||||
|
||||
return data;
|
||||
}
|
||||
|
||||
static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb,
|
||||
u8 *new_status)
|
||||
{
|
||||
@ -2682,11 +2694,15 @@ static void hci_cs_switch_role(struct hci_dev *hdev, u8 status)
|
||||
|
||||
static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
__u8 status = *((__u8 *) skb->data);
|
||||
struct hci_ev_status *ev;
|
||||
struct discovery_state *discov = &hdev->discovery;
|
||||
struct inquiry_entry *e;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, status);
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_INQUIRY_COMPLETE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_conn_check_pending(hdev);
|
||||
|
||||
@ -2780,9 +2796,13 @@ static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
|
||||
static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_conn_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_conn_complete *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_CONN_COMPLETE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -2904,12 +2924,16 @@ static void hci_reject_conn(struct hci_dev *hdev, bdaddr_t *bdaddr)
|
||||
|
||||
static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_conn_request *ev = (void *) skb->data;
|
||||
struct hci_ev_conn_request *ev;
|
||||
int mask = hdev->link_mode;
|
||||
struct inquiry_entry *ie;
|
||||
struct hci_conn *conn;
|
||||
__u8 flags = 0;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_CONN_REQUEST, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
|
||||
ev->link_type);
|
||||
|
||||
@ -3015,12 +3039,16 @@ static u8 hci_to_mgmt_reason(u8 err)
|
||||
|
||||
static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_disconn_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_disconn_complete *ev;
|
||||
u8 reason;
|
||||
struct hci_conn_params *params;
|
||||
struct hci_conn *conn;
|
||||
bool mgmt_connected;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_DISCONN_COMPLETE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -3099,9 +3127,13 @@ unlock:
|
||||
|
||||
static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_auth_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_auth_complete *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_AUTH_COMPLETE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -3169,9 +3201,13 @@ unlock:
|
||||
|
||||
static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_remote_name *ev = (void *) skb->data;
|
||||
struct hci_ev_remote_name *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_REMOTE_NAME, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_conn_check_pending(hdev);
|
||||
@ -3252,9 +3288,13 @@ unlock:
|
||||
|
||||
static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_encrypt_change *ev = (void *) skb->data;
|
||||
struct hci_ev_encrypt_change *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_ENCRYPT_CHANGE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -3367,9 +3407,14 @@ unlock:
|
||||
static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_change_link_key_complete *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_CHANGE_LINK_KEY_COMPLETE,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -3390,9 +3435,13 @@ static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
|
||||
static void hci_remote_features_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_remote_features *ev = (void *) skb->data;
|
||||
struct hci_ev_remote_features *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_REMOTE_FEATURES, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -3841,9 +3890,11 @@ static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb,
|
||||
hci_req_complete_t *req_complete,
|
||||
hci_req_complete_skb_t *req_complete_skb)
|
||||
{
|
||||
struct hci_ev_cmd_status *ev = (void *) skb->data;
|
||||
struct hci_ev_cmd_status *ev;
|
||||
|
||||
skb_pull(skb, sizeof(*ev));
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_CMD_STATUS, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
*opcode = __le16_to_cpu(ev->opcode);
|
||||
*status = ev->status;
|
||||
@ -3951,7 +4002,11 @@ static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb,
|
||||
|
||||
static void hci_hardware_error_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_hardware_error *ev = (void *) skb->data;
|
||||
struct hci_ev_hardware_error *ev;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_HARDWARE_ERROR, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
hdev->hw_error_code = ev->code;
|
||||
|
||||
@ -3960,9 +4015,13 @@ static void hci_hardware_error_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
|
||||
static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_role_change *ev = (void *) skb->data;
|
||||
struct hci_ev_role_change *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_ROLE_CHANGE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4070,20 +4129,22 @@ static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
|
||||
|
||||
static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
|
||||
struct hci_ev_num_comp_blocks *ev;
|
||||
int i;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_NUM_COMP_BLOCKS, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
if (!hci_ev_skb_pull(hdev, skb, HCI_EV_NUM_COMP_BLOCKS,
|
||||
flex_array_size(ev, handles, ev->num_hndl)))
|
||||
return;
|
||||
|
||||
if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
|
||||
bt_dev_err(hdev, "wrong event for mode %d", hdev->flow_ctl_mode);
|
||||
return;
|
||||
}
|
||||
|
||||
if (skb->len < sizeof(*ev) ||
|
||||
skb->len < struct_size(ev, handles, ev->num_hndl)) {
|
||||
BT_DBG("%s bad parameters", hdev->name);
|
||||
return;
|
||||
}
|
||||
|
||||
BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
|
||||
ev->num_hndl);
|
||||
|
||||
@ -4121,9 +4182,13 @@ static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
|
||||
static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_mode_change *ev = (void *) skb->data;
|
||||
struct hci_ev_mode_change *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_MODE_CHANGE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4149,9 +4214,13 @@ static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
|
||||
static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_pin_code_req *ev = (void *) skb->data;
|
||||
struct hci_ev_pin_code_req *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_PIN_CODE_REQ, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4219,11 +4288,15 @@ static void conn_set_key(struct hci_conn *conn, u8 key_type, u8 pin_len)
|
||||
|
||||
static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_link_key_req *ev = (void *) skb->data;
|
||||
struct hci_ev_link_key_req *ev;
|
||||
struct hci_cp_link_key_reply cp;
|
||||
struct hci_conn *conn;
|
||||
struct link_key *key;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_LINK_KEY_REQ, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
if (!hci_dev_test_flag(hdev, HCI_MGMT))
|
||||
@ -4279,12 +4352,16 @@ not_found:
|
||||
|
||||
static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_link_key_notify *ev = (void *) skb->data;
|
||||
struct hci_ev_link_key_notify *ev;
|
||||
struct hci_conn *conn;
|
||||
struct link_key *key;
|
||||
bool persistent;
|
||||
u8 pin_len = 0;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_LINK_KEY_NOTIFY, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4339,9 +4416,13 @@ unlock:
|
||||
|
||||
static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_clock_offset *ev = (void *) skb->data;
|
||||
struct hci_ev_clock_offset *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_CLOCK_OFFSET, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4362,9 +4443,13 @@ static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
|
||||
static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_pkt_type_change *ev = (void *) skb->data;
|
||||
struct hci_ev_pkt_type_change *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_PKT_TYPE_CHANGE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4378,9 +4463,13 @@ static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
|
||||
static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
|
||||
struct hci_ev_pscan_rep_mode *ev;
|
||||
struct inquiry_entry *ie;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_PSCAN_REP_MODE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4468,9 +4557,14 @@ unlock:
|
||||
static void hci_remote_ext_features_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_remote_ext_features *ev = (void *) skb->data;
|
||||
struct hci_ev_remote_ext_features *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_REMOTE_EXT_FEATURES,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4532,9 +4626,13 @@ unlock:
|
||||
static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_sync_conn_complete *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_SYNC_CONN_COMPLETE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4697,9 +4795,14 @@ static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
|
||||
static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_key_refresh_complete *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_KEY_REFRESH_COMPLETE,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
|
||||
__le16_to_cpu(ev->handle));
|
||||
|
||||
@ -4806,9 +4909,13 @@ static u8 bredr_oob_data_present(struct hci_conn *conn)
|
||||
|
||||
static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_io_capa_request *ev = (void *) skb->data;
|
||||
struct hci_ev_io_capa_request *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_IO_CAPA_REQUEST, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4875,9 +4982,13 @@ unlock:
|
||||
|
||||
static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_io_capa_reply *ev = (void *) skb->data;
|
||||
struct hci_ev_io_capa_reply *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_IO_CAPA_REPLY, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4896,10 +5007,15 @@ unlock:
|
||||
static void hci_user_confirm_request_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_user_confirm_req *ev = (void *) skb->data;
|
||||
struct hci_ev_user_confirm_req *ev;
|
||||
int loc_mitm, rem_mitm, confirm_hint = 0;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_USER_CONFIRM_REQUEST,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -4981,7 +5097,12 @@ unlock:
|
||||
static void hci_user_passkey_request_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_user_passkey_req *ev = (void *) skb->data;
|
||||
struct hci_ev_user_passkey_req *ev;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_USER_PASSKEY_REQUEST,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
@ -4992,9 +5113,14 @@ static void hci_user_passkey_request_evt(struct hci_dev *hdev,
|
||||
static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
|
||||
struct hci_ev_user_passkey_notify *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_USER_PASSKEY_NOTIFY,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
|
||||
@ -5012,9 +5138,13 @@ static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
|
||||
|
||||
static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_keypress_notify *ev = (void *) skb->data;
|
||||
struct hci_ev_keypress_notify *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_KEYPRESS_NOTIFY, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
|
||||
@ -5051,9 +5181,14 @@ static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_simple_pair_complete *ev;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_SIMPLE_PAIR_COMPLETE,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -5082,10 +5217,15 @@ unlock:
|
||||
static void hci_remote_host_features_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_remote_host_features *ev = (void *) skb->data;
|
||||
struct hci_ev_remote_host_features *ev;
|
||||
struct inquiry_entry *ie;
|
||||
struct hci_conn *conn;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_REMOTE_HOST_FEATURES,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -5104,9 +5244,14 @@ static void hci_remote_host_features_evt(struct hci_dev *hdev,
|
||||
static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
|
||||
struct hci_ev_remote_oob_data_request *ev;
|
||||
struct oob_data *data;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_REMOTE_OOB_DATA_REQUEST,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s", hdev->name);
|
||||
|
||||
hci_dev_lock(hdev);
|
||||
@ -5158,12 +5303,14 @@ unlock:
|
||||
#if IS_ENABLED(CONFIG_BT_HS)
|
||||
static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_channel_selected *ev = (void *)skb->data;
|
||||
struct hci_ev_channel_selected *ev;
|
||||
struct hci_conn *hcon;
|
||||
|
||||
BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_CHANNEL_SELECTED, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
skb_pull(skb, sizeof(*ev));
|
||||
BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
|
||||
|
||||
hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
|
||||
if (!hcon)
|
||||
@ -5175,9 +5322,13 @@ static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
static void hci_phy_link_complete_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_phy_link_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_phy_link_complete *ev;
|
||||
struct hci_conn *hcon, *bredr_hcon;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_PHY_LINK_COMPLETE, sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
|
||||
ev->status);
|
||||
|
||||
@ -5215,11 +5366,16 @@ unlock:
|
||||
|
||||
static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_logical_link_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_logical_link_complete *ev;
|
||||
struct hci_conn *hcon;
|
||||
struct hci_chan *hchan;
|
||||
struct amp_mgr *mgr;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_LOGICAL_LINK_COMPLETE,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
|
||||
hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
|
||||
ev->status);
|
||||
@ -5255,9 +5411,14 @@ static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
|
||||
static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_disconn_logical_link_complete *ev;
|
||||
struct hci_chan *hchan;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
|
||||
le16_to_cpu(ev->handle), ev->status);
|
||||
|
||||
@ -5279,9 +5440,14 @@ unlock:
|
||||
static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
|
||||
struct hci_ev_disconn_phy_link_complete *ev;
|
||||
struct hci_conn *hcon;
|
||||
|
||||
ev = hci_ev_skb_pull(hdev, skb, HCI_EV_DISCONN_PHY_LINK_COMPLETE,
|
||||
sizeof(*ev));
|
||||
if (!ev)
|
||||
return;
|
||||
|
||||
BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
|
||||
|
||||
if (ev->status)
|
||||
|
||||
Loading…
Reference in New Issue
Block a user