blob: 90cba6a8293bd8c32dd003bb0ab48664431ef40a [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI event handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <asm/unaligned.h>
28
29#include <net/bluetooth/bluetooth.h>
30#include <net/bluetooth/hci_core.h>
Mikel Astizf0d6a0e2012-08-09 09:52:30 +020031#include <net/bluetooth/mgmt.h>
Marcel Holtmann7ef9fbf2013-10-10 14:54:14 -070032
Marcel Holtmann70247282013-10-10 14:54:15 -070033#include "a2mp.h"
Marcel Holtmann7ef9fbf2013-10-10 14:54:14 -070034#include "amp.h"
Johan Hedberg2ceba532014-06-16 19:25:16 +030035#include "smp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070036
Linus Torvalds1da177e2005-04-16 15:20:36 -070037/* Handle HCI Event packets */
38
Marcel Holtmanna9de9242007-10-20 13:33:56 +020039static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070040{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020041 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030043 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
Andre Guedes82f47852013-04-30 15:29:34 -030045 if (status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020046 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
Andre Guedes89352e72011-11-04 14:16:53 -030048 clear_bit(HCI_INQUIRY, &hdev->flags);
Peter Zijlstra4e857c52014-03-17 18:06:10 +010049 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
Andre Guedes3e13fa12013-03-27 20:04:56 -030050 wake_up_bit(&hdev->flags, HCI_INQUIRY);
Andre Guedes89352e72011-11-04 14:16:53 -030051
Johan Hedberg50143a42014-06-10 14:05:57 +030052 hci_dev_lock(hdev);
53 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
54 hci_dev_unlock(hdev);
55
Marcel Holtmanna9de9242007-10-20 13:33:56 +020056 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070057}
58
Andre Guedes4d934832012-03-21 00:03:35 -030059static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
60{
61 __u8 status = *((__u8 *) skb->data);
62
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030063 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesae854a72012-03-21 00:03:36 -030064
65 if (status)
66 return;
67
68 set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
Andre Guedes4d934832012-03-21 00:03:35 -030069}
70
Marcel Holtmanna9de9242007-10-20 13:33:56 +020071static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070072{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020073 __u8 status = *((__u8 *) skb->data);
74
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030075 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020076
77 if (status)
78 return;
79
Andre Guedesae854a72012-03-21 00:03:36 -030080 clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
81
Marcel Holtmanna9de9242007-10-20 13:33:56 +020082 hci_conn_check_pending(hdev);
83}
84
Gustavo Padovan807deac2012-05-17 00:36:24 -030085static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
86 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020087{
88 BT_DBG("%s", hdev->name);
89}
90
91static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
92{
93 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030096 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070097
Marcel Holtmanna9de9242007-10-20 13:33:56 +020098 if (rp->status)
99 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200101 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200103 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
104 if (conn) {
105 if (rp->role)
106 conn->link_mode &= ~HCI_LM_MASTER;
107 else
108 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200110
111 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112}
113
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200114static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
115{
116 struct hci_rp_read_link_policy *rp = (void *) skb->data;
117 struct hci_conn *conn;
118
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300119 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200120
121 if (rp->status)
122 return;
123
124 hci_dev_lock(hdev);
125
126 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
127 if (conn)
128 conn->link_policy = __le16_to_cpu(rp->policy);
129
130 hci_dev_unlock(hdev);
131}
132
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200133static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200135 struct hci_rp_write_link_policy *rp = (void *) skb->data;
136 struct hci_conn *conn;
137 void *sent;
138
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300139 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200140
141 if (rp->status)
142 return;
143
144 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
145 if (!sent)
146 return;
147
148 hci_dev_lock(hdev);
149
150 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200151 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700152 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200153
154 hci_dev_unlock(hdev);
155}
156
Gustavo Padovan807deac2012-05-17 00:36:24 -0300157static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
158 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200159{
160 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
161
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300162 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200163
164 if (rp->status)
165 return;
166
167 hdev->link_policy = __le16_to_cpu(rp->policy);
168}
169
Gustavo Padovan807deac2012-05-17 00:36:24 -0300170static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
171 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200172{
173 __u8 status = *((__u8 *) skb->data);
174 void *sent;
175
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300176 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200177
178 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
179 if (!sent)
180 return;
181
182 if (!status)
183 hdev->link_policy = get_unaligned_le16(sent);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200184}
185
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200186static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
187{
188 __u8 status = *((__u8 *) skb->data);
189
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300190 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200191
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300192 clear_bit(HCI_RESET, &hdev->flags);
193
Johan Hedberga297e972012-02-21 17:55:47 +0200194 /* Reset all non-persistent flags */
Johan Hedberg2cc6fb02013-03-15 17:06:57 -0500195 hdev->dev_flags &= ~HCI_PERSISTENT_MASK;
Andre Guedes69775ff2012-02-23 16:50:05 +0200196
197 hdev->discovery.state = DISCOVERY_STOPPED;
Johan Hedbergbbaf4442012-11-08 01:22:59 +0100198 hdev->inq_tx_power = HCI_TX_POWER_INVALID;
199 hdev->adv_tx_power = HCI_TX_POWER_INVALID;
Johan Hedberg3f0f5242012-11-08 01:23:00 +0100200
201 memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
202 hdev->adv_data_len = 0;
Marcel Holtmannf8e808b2013-10-16 00:16:47 -0700203
204 memset(hdev->scan_rsp_data, 0, sizeof(hdev->scan_rsp_data));
205 hdev->scan_rsp_data_len = 0;
Marcel Holtmann06f5b772013-10-19 07:09:11 -0700206
Marcel Holtmann533553f2014-03-21 12:18:10 -0700207 hdev->le_scan_type = LE_SCAN_PASSIVE;
208
Marcel Holtmann06f5b772013-10-19 07:09:11 -0700209 hdev->ssp_debug_mode = 0;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200210}
211
212static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
213{
214 __u8 status = *((__u8 *) skb->data);
215 void *sent;
216
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300217 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200218
219 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
220 if (!sent)
221 return;
222
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200223 hci_dev_lock(hdev);
224
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200225 if (test_bit(HCI_MGMT, &hdev->dev_flags))
226 mgmt_set_local_name_complete(hdev, sent, status);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +0200227 else if (!status)
228 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200229
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200230 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200231}
232
233static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
234{
235 struct hci_rp_read_local_name *rp = (void *) skb->data;
236
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300237 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200238
239 if (rp->status)
240 return;
241
Johan Hedbergdb99b5f2012-02-22 20:14:22 +0200242 if (test_bit(HCI_SETUP, &hdev->dev_flags))
243 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200244}
245
246static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
247{
248 __u8 status = *((__u8 *) skb->data);
249 void *sent;
250
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300251 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200252
253 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
254 if (!sent)
255 return;
256
257 if (!status) {
258 __u8 param = *((__u8 *) sent);
259
260 if (param == AUTH_ENABLED)
261 set_bit(HCI_AUTH, &hdev->flags);
262 else
263 clear_bit(HCI_AUTH, &hdev->flags);
264 }
265
Johan Hedberg33ef95e2012-02-16 23:56:27 +0200266 if (test_bit(HCI_MGMT, &hdev->dev_flags))
267 mgmt_auth_enable_complete(hdev, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200268}
269
270static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
271{
272 __u8 status = *((__u8 *) skb->data);
273 void *sent;
274
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300275 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200276
277 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
278 if (!sent)
279 return;
280
281 if (!status) {
282 __u8 param = *((__u8 *) sent);
283
284 if (param)
285 set_bit(HCI_ENCRYPT, &hdev->flags);
286 else
287 clear_bit(HCI_ENCRYPT, &hdev->flags);
288 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200289}
290
291static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
292{
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200293 __u8 param, status = *((__u8 *) skb->data);
294 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200295 void *sent;
296
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300297 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200298
299 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
300 if (!sent)
301 return;
302
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200303 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200304
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200305 hci_dev_lock(hdev);
306
Mikel Astizfa1bd912012-08-09 09:52:29 +0200307 if (status) {
Johan Hedberg744cf192011-11-08 20:40:14 +0200308 mgmt_write_scan_failed(hdev, param, status);
Johan Hedberg2d7cee52011-11-07 22:16:03 +0200309 hdev->discov_timeout = 0;
310 goto done;
311 }
312
Johan Hedberg0663ca22013-10-02 13:43:14 +0300313 /* We need to ensure that we set this back on if someone changed
314 * the scan mode through a raw HCI socket.
315 */
316 set_bit(HCI_BREDR_ENABLED, &hdev->dev_flags);
317
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200318 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
319 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200320
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200321 if (param & SCAN_INQUIRY) {
322 set_bit(HCI_ISCAN, &hdev->flags);
323 if (!old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200324 mgmt_discoverable(hdev, 1);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200325 } else if (old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200326 mgmt_discoverable(hdev, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200327
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200328 if (param & SCAN_PAGE) {
329 set_bit(HCI_PSCAN, &hdev->flags);
330 if (!old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200331 mgmt_connectable(hdev, 1);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200332 } else if (old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200333 mgmt_connectable(hdev, 0);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200334
335done:
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200336 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200337}
338
339static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
340{
341 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
342
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300343 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200344
345 if (rp->status)
346 return;
347
348 memcpy(hdev->dev_class, rp->dev_class, 3);
349
350 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300351 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200352}
353
354static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
355{
356 __u8 status = *((__u8 *) skb->data);
357 void *sent;
358
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300359 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200360
361 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
362 if (!sent)
363 return;
364
Marcel Holtmann7f9a9032012-02-22 18:38:01 +0100365 hci_dev_lock(hdev);
366
367 if (status == 0)
368 memcpy(hdev->dev_class, sent, 3);
369
370 if (test_bit(HCI_MGMT, &hdev->dev_flags))
371 mgmt_set_class_of_dev_complete(hdev, sent, status);
372
373 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200374}
375
376static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
377{
378 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200380
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300381 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200382
383 if (rp->status)
384 return;
385
386 setting = __le16_to_cpu(rp->voice_setting);
387
Marcel Holtmannf383f272008-07-14 20:13:47 +0200388 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200389 return;
390
391 hdev->voice_setting = setting;
392
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300393 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200394
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200395 if (hdev->notify)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200396 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200397}
398
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300399static void hci_cc_write_voice_setting(struct hci_dev *hdev,
400 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200401{
402 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200403 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 void *sent;
405
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300406 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
Marcel Holtmannf383f272008-07-14 20:13:47 +0200408 if (status)
409 return;
410
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200411 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
412 if (!sent)
413 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414
Marcel Holtmannf383f272008-07-14 20:13:47 +0200415 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416
Marcel Holtmannf383f272008-07-14 20:13:47 +0200417 if (hdev->voice_setting == setting)
418 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419
Marcel Holtmannf383f272008-07-14 20:13:47 +0200420 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300422 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200423
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200424 if (hdev->notify)
Marcel Holtmannf383f272008-07-14 20:13:47 +0200425 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426}
427
Marcel Holtmannb4cb9fb2013-10-14 13:56:16 -0700428static void hci_cc_read_num_supported_iac(struct hci_dev *hdev,
429 struct sk_buff *skb)
430{
431 struct hci_rp_read_num_supported_iac *rp = (void *) skb->data;
432
433 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
434
435 if (rp->status)
436 return;
437
438 hdev->num_iac = rp->num_iac;
439
440 BT_DBG("%s num iac %d", hdev->name, hdev->num_iac);
441}
442
Marcel Holtmann333140b2008-07-14 20:13:48 +0200443static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
444{
445 __u8 status = *((__u8 *) skb->data);
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300446 struct hci_cp_write_ssp_mode *sent;
Marcel Holtmann333140b2008-07-14 20:13:48 +0200447
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300448 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann333140b2008-07-14 20:13:48 +0200449
Marcel Holtmann333140b2008-07-14 20:13:48 +0200450 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
451 if (!sent)
452 return;
453
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300454 if (!status) {
455 if (sent->mode)
Johan Hedbergcad718e2013-04-17 15:00:51 +0300456 hdev->features[1][0] |= LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300457 else
Johan Hedbergcad718e2013-04-17 15:00:51 +0300458 hdev->features[1][0] &= ~LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300459 }
460
Johan Hedberged2c4ee2012-02-17 00:56:28 +0200461 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300462 mgmt_ssp_enable_complete(hdev, sent->mode, status);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200463 else if (!status) {
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300464 if (sent->mode)
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200465 set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
466 else
467 clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
468 }
Marcel Holtmann333140b2008-07-14 20:13:48 +0200469}
470
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800471static void hci_cc_write_sc_support(struct hci_dev *hdev, struct sk_buff *skb)
472{
473 u8 status = *((u8 *) skb->data);
474 struct hci_cp_write_sc_support *sent;
475
476 BT_DBG("%s status 0x%2.2x", hdev->name, status);
477
478 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SC_SUPPORT);
479 if (!sent)
480 return;
481
482 if (!status) {
483 if (sent->support)
484 hdev->features[1][0] |= LMP_HOST_SC;
485 else
486 hdev->features[1][0] &= ~LMP_HOST_SC;
487 }
488
489 if (test_bit(HCI_MGMT, &hdev->dev_flags))
490 mgmt_sc_enable_complete(hdev, sent->support, status);
491 else if (!status) {
492 if (sent->support)
493 set_bit(HCI_SC_ENABLED, &hdev->dev_flags);
494 else
495 clear_bit(HCI_SC_ENABLED, &hdev->dev_flags);
496 }
497}
498
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200499static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
500{
501 struct hci_rp_read_local_version *rp = (void *) skb->data;
502
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300503 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200504
505 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200506 return;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200507
Marcel Holtmann0d5551f2013-10-18 12:04:50 -0700508 if (test_bit(HCI_SETUP, &hdev->dev_flags)) {
509 hdev->hci_ver = rp->hci_ver;
510 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
511 hdev->lmp_ver = rp->lmp_ver;
512 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
513 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
514 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200515}
516
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300517static void hci_cc_read_local_commands(struct hci_dev *hdev,
518 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200519{
520 struct hci_rp_read_local_commands *rp = (void *) skb->data;
521
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300522 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200523
Marcel Holtmann6a070e62013-10-31 04:54:33 -0700524 if (rp->status)
525 return;
526
527 if (test_bit(HCI_SETUP, &hdev->dev_flags))
Johan Hedberg2177bab2013-03-05 20:37:43 +0200528 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200529}
530
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300531static void hci_cc_read_local_features(struct hci_dev *hdev,
532 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200533{
534 struct hci_rp_read_local_features *rp = (void *) skb->data;
535
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300536 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200537
538 if (rp->status)
539 return;
540
541 memcpy(hdev->features, rp->features, 8);
542
543 /* Adjust default settings according to features
544 * supported by device. */
545
Johan Hedbergcad718e2013-04-17 15:00:51 +0300546 if (hdev->features[0][0] & LMP_3SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200547 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
548
Johan Hedbergcad718e2013-04-17 15:00:51 +0300549 if (hdev->features[0][0] & LMP_5SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200550 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
551
Johan Hedbergcad718e2013-04-17 15:00:51 +0300552 if (hdev->features[0][1] & LMP_HV2) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200553 hdev->pkt_type |= (HCI_HV2);
554 hdev->esco_type |= (ESCO_HV2);
555 }
556
Johan Hedbergcad718e2013-04-17 15:00:51 +0300557 if (hdev->features[0][1] & LMP_HV3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200558 hdev->pkt_type |= (HCI_HV3);
559 hdev->esco_type |= (ESCO_HV3);
560 }
561
Andre Guedes45db810f2012-07-24 15:03:49 -0300562 if (lmp_esco_capable(hdev))
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200563 hdev->esco_type |= (ESCO_EV3);
564
Johan Hedbergcad718e2013-04-17 15:00:51 +0300565 if (hdev->features[0][4] & LMP_EV4)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200566 hdev->esco_type |= (ESCO_EV4);
567
Johan Hedbergcad718e2013-04-17 15:00:51 +0300568 if (hdev->features[0][4] & LMP_EV5)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200569 hdev->esco_type |= (ESCO_EV5);
570
Johan Hedbergcad718e2013-04-17 15:00:51 +0300571 if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100572 hdev->esco_type |= (ESCO_2EV3);
573
Johan Hedbergcad718e2013-04-17 15:00:51 +0300574 if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100575 hdev->esco_type |= (ESCO_3EV3);
576
Johan Hedbergcad718e2013-04-17 15:00:51 +0300577 if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100578 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200579}
580
Andre Guedes971e3a42011-06-30 19:20:52 -0300581static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300582 struct sk_buff *skb)
Andre Guedes971e3a42011-06-30 19:20:52 -0300583{
584 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
585
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300586 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andre Guedes971e3a42011-06-30 19:20:52 -0300587
588 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200589 return;
Andre Guedes971e3a42011-06-30 19:20:52 -0300590
Marcel Holtmann57af75a2013-10-18 12:04:47 -0700591 if (hdev->max_page < rp->max_page)
592 hdev->max_page = rp->max_page;
Johan Hedbergd2c5d772013-04-17 15:00:52 +0300593
Johan Hedbergcad718e2013-04-17 15:00:51 +0300594 if (rp->page < HCI_MAX_PAGES)
595 memcpy(hdev->features[rp->page], rp->features, 8);
Andre Guedes971e3a42011-06-30 19:20:52 -0300596}
597
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200598static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300599 struct sk_buff *skb)
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200600{
601 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
602
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300603 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200604
Johan Hedberg42c6b122013-03-05 20:37:49 +0200605 if (!rp->status)
606 hdev->flow_ctl_mode = rp->mode;
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200607}
608
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200609static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
610{
611 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
612
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300613 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200614
615 if (rp->status)
616 return;
617
618 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
619 hdev->sco_mtu = rp->sco_mtu;
620 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
621 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
622
623 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
624 hdev->sco_mtu = 64;
625 hdev->sco_pkts = 8;
626 }
627
628 hdev->acl_cnt = hdev->acl_pkts;
629 hdev->sco_cnt = hdev->sco_pkts;
630
Gustavo Padovan807deac2012-05-17 00:36:24 -0300631 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
632 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200633}
634
635static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
636{
637 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
638
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300639 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200640
641 if (!rp->status)
642 bacpy(&hdev->bdaddr, &rp->bdaddr);
Johan Hedberg23bb5762010-12-21 23:01:27 +0200643}
644
Johan Hedbergf332ec62013-03-15 17:07:11 -0500645static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
646 struct sk_buff *skb)
647{
648 struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;
649
650 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
651
652 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status) {
653 hdev->page_scan_interval = __le16_to_cpu(rp->interval);
654 hdev->page_scan_window = __le16_to_cpu(rp->window);
655 }
656}
657
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500658static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
659 struct sk_buff *skb)
660{
661 u8 status = *((u8 *) skb->data);
662 struct hci_cp_write_page_scan_activity *sent;
663
664 BT_DBG("%s status 0x%2.2x", hdev->name, status);
665
666 if (status)
667 return;
668
669 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
670 if (!sent)
671 return;
672
673 hdev->page_scan_interval = __le16_to_cpu(sent->interval);
674 hdev->page_scan_window = __le16_to_cpu(sent->window);
675}
676
Johan Hedbergf332ec62013-03-15 17:07:11 -0500677static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
678 struct sk_buff *skb)
679{
680 struct hci_rp_read_page_scan_type *rp = (void *) skb->data;
681
682 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
683
684 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status)
685 hdev->page_scan_type = rp->type;
686}
687
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500688static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
689 struct sk_buff *skb)
690{
691 u8 status = *((u8 *) skb->data);
692 u8 *type;
693
694 BT_DBG("%s status 0x%2.2x", hdev->name, status);
695
696 if (status)
697 return;
698
699 type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
700 if (type)
701 hdev->page_scan_type = *type;
702}
703
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200704static void hci_cc_read_data_block_size(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300705 struct sk_buff *skb)
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200706{
707 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
708
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300709 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200710
711 if (rp->status)
712 return;
713
714 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
715 hdev->block_len = __le16_to_cpu(rp->block_len);
716 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
717
718 hdev->block_cnt = hdev->num_blocks;
719
720 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300721 hdev->block_cnt, hdev->block_len);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200722}
723
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300724static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300725 struct sk_buff *skb)
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300726{
727 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
728
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300729 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300730
731 if (rp->status)
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300732 goto a2mp_rsp;
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300733
734 hdev->amp_status = rp->amp_status;
735 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
736 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
737 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
738 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
739 hdev->amp_type = rp->amp_type;
740 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
741 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
742 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
743 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
744
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300745a2mp_rsp:
746 a2mp_send_getinfo_rsp(hdev);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300747}
748
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300749static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
750 struct sk_buff *skb)
751{
752 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
753 struct amp_assoc *assoc = &hdev->loc_assoc;
754 size_t rem_len, frag_len;
755
756 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
757
758 if (rp->status)
759 goto a2mp_rsp;
760
761 frag_len = skb->len - sizeof(*rp);
762 rem_len = __le16_to_cpu(rp->rem_len);
763
764 if (rem_len > frag_len) {
Andrei Emeltchenko2e430be32012-09-28 14:44:23 +0300765 BT_DBG("frag_len %zu rem_len %zu", frag_len, rem_len);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300766
767 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
768 assoc->offset += frag_len;
769
770 /* Read other fragments */
771 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
772
773 return;
774 }
775
776 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
777 assoc->len = assoc->offset + rem_len;
778 assoc->offset = 0;
779
780a2mp_rsp:
781 /* Send A2MP Rsp when all fragments are received */
782 a2mp_send_getampassoc_rsp(hdev, rp->status);
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +0300783 a2mp_send_create_phy_link_req(hdev, rp->status);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300784}
785
Johan Hedbergd5859e22011-01-25 01:19:58 +0200786static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300787 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200788{
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700789 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200790
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300791 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200792
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700793 if (!rp->status)
794 hdev->inq_tx_power = rp->tx_power;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200795}
796
Johan Hedberg980e1a52011-01-22 06:10:07 +0200797static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
798{
799 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
800 struct hci_cp_pin_code_reply *cp;
801 struct hci_conn *conn;
802
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300803 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200804
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200805 hci_dev_lock(hdev);
806
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200807 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200808 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200809
Mikel Astizfa1bd912012-08-09 09:52:29 +0200810 if (rp->status)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200811 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200812
813 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
814 if (!cp)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200815 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200816
817 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
818 if (conn)
819 conn->pin_length = cp->pin_len;
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200820
821unlock:
822 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200823}
824
825static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
826{
827 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
828
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300829 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200830
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200831 hci_dev_lock(hdev);
832
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200833 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200834 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300835 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200836
837 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200838}
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200839
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300840static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
841 struct sk_buff *skb)
842{
843 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
844
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300845 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300846
847 if (rp->status)
848 return;
849
850 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
851 hdev->le_pkts = rp->le_max_pkt;
852
853 hdev->le_cnt = hdev->le_pkts;
854
855 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300856}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200857
Johan Hedberg60e77322013-01-22 14:01:59 +0200858static void hci_cc_le_read_local_features(struct hci_dev *hdev,
859 struct sk_buff *skb)
860{
861 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
862
863 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
864
865 if (!rp->status)
866 memcpy(hdev->le_features, rp->features, 8);
Johan Hedberg60e77322013-01-22 14:01:59 +0200867}
868
Johan Hedberg8fa19092012-10-19 20:57:49 +0300869static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
870 struct sk_buff *skb)
871{
872 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
873
874 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
875
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500876 if (!rp->status)
Johan Hedberg8fa19092012-10-19 20:57:49 +0300877 hdev->adv_tx_power = rp->tx_power;
Johan Hedberg8fa19092012-10-19 20:57:49 +0300878}
879
Johan Hedberga5c29682011-02-19 12:05:57 -0300880static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
881{
882 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
883
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300884 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300885
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200886 hci_dev_lock(hdev);
887
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200888 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300889 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
890 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200891
892 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300893}
894
895static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300896 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -0300897{
898 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
899
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300900 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300901
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200902 hci_dev_lock(hdev);
903
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200904 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200905 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300906 ACL_LINK, 0, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200907
908 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300909}
910
Brian Gix1143d452011-11-23 08:28:34 -0800911static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
912{
913 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
914
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300915 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800916
917 hci_dev_lock(hdev);
918
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200919 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +0200920 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300921 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800922
923 hci_dev_unlock(hdev);
924}
925
926static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300927 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -0800928{
929 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
930
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300931 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800932
933 hci_dev_lock(hdev);
934
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200935 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Brian Gix1143d452011-11-23 08:28:34 -0800936 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300937 ACL_LINK, 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800938
939 hci_dev_unlock(hdev);
940}
941
Marcel Holtmann4d2d2792014-01-10 02:07:26 -0800942static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
943 struct sk_buff *skb)
Szymon Jancc35938b2011-03-22 13:12:21 +0100944{
945 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
946
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300947 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Szymon Jancc35938b2011-03-22 13:12:21 +0100948
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200949 hci_dev_lock(hdev);
Marcel Holtmann4d2d2792014-01-10 02:07:26 -0800950 mgmt_read_local_oob_data_complete(hdev, rp->hash, rp->randomizer,
951 NULL, NULL, rp->status);
952 hci_dev_unlock(hdev);
953}
954
955static void hci_cc_read_local_oob_ext_data(struct hci_dev *hdev,
956 struct sk_buff *skb)
957{
958 struct hci_rp_read_local_oob_ext_data *rp = (void *) skb->data;
959
960 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
961
962 hci_dev_lock(hdev);
963 mgmt_read_local_oob_data_complete(hdev, rp->hash192, rp->randomizer192,
964 rp->hash256, rp->randomizer256,
965 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200966 hci_dev_unlock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +0100967}
968
Marcel Holtmann7a4cd512014-02-19 19:52:13 -0800969
970static void hci_cc_le_set_random_addr(struct hci_dev *hdev, struct sk_buff *skb)
971{
972 __u8 status = *((__u8 *) skb->data);
973 bdaddr_t *sent;
974
975 BT_DBG("%s status 0x%2.2x", hdev->name, status);
976
977 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_RANDOM_ADDR);
978 if (!sent)
979 return;
980
981 hci_dev_lock(hdev);
982
983 if (!status)
984 bacpy(&hdev->random_addr, sent);
985
986 hci_dev_unlock(hdev);
987}
988
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100989static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
990{
991 __u8 *sent, status = *((__u8 *) skb->data);
992
993 BT_DBG("%s status 0x%2.2x", hdev->name, status);
994
995 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
996 if (!sent)
997 return;
998
Johan Hedberg3c857752014-03-25 10:30:49 +0200999 if (status)
1000 return;
1001
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001002 hci_dev_lock(hdev);
1003
Johan Hedberg3c857752014-03-25 10:30:49 +02001004 /* If we're doing connection initation as peripheral. Set a
1005 * timeout in case something goes wrong.
1006 */
1007 if (*sent) {
1008 struct hci_conn *conn;
1009
1010 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
1011 if (conn)
1012 queue_delayed_work(hdev->workqueue,
1013 &conn->le_conn_timeout,
1014 HCI_LE_CONN_TIMEOUT);
1015 }
1016
1017 mgmt_advertising(hdev, *sent);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001018
Johan Hedberg04b4edc2013-03-15 17:07:01 -05001019 hci_dev_unlock(hdev);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001020}
1021
Marcel Holtmann533553f2014-03-21 12:18:10 -07001022static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
1023{
1024 struct hci_cp_le_set_scan_param *cp;
1025 __u8 status = *((__u8 *) skb->data);
1026
1027 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1028
1029 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_PARAM);
1030 if (!cp)
1031 return;
1032
1033 hci_dev_lock(hdev);
1034
1035 if (!status)
1036 hdev->le_scan_type = cp->type;
1037
1038 hci_dev_unlock(hdev);
1039}
1040
Johan Hedbergb9a63282014-03-25 10:51:52 +02001041static bool has_pending_adv_report(struct hci_dev *hdev)
1042{
1043 struct discovery_state *d = &hdev->discovery;
1044
1045 return bacmp(&d->last_adv_addr, BDADDR_ANY);
1046}
1047
1048static void clear_pending_adv_report(struct hci_dev *hdev)
1049{
1050 struct discovery_state *d = &hdev->discovery;
1051
1052 bacpy(&d->last_adv_addr, BDADDR_ANY);
1053 d->last_adv_data_len = 0;
1054}
1055
1056static void store_pending_adv_report(struct hci_dev *hdev, bdaddr_t *bdaddr,
Johan Hedbergff5cd292014-03-25 14:40:52 +02001057 u8 bdaddr_type, s8 rssi, u8 *data, u8 len)
Johan Hedbergb9a63282014-03-25 10:51:52 +02001058{
1059 struct discovery_state *d = &hdev->discovery;
1060
1061 bacpy(&d->last_adv_addr, bdaddr);
1062 d->last_adv_addr_type = bdaddr_type;
Johan Hedbergff5cd292014-03-25 14:40:52 +02001063 d->last_adv_rssi = rssi;
Johan Hedbergb9a63282014-03-25 10:51:52 +02001064 memcpy(d->last_adv_data, data, len);
1065 d->last_adv_data_len = len;
1066}
1067
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001068static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001069 struct sk_buff *skb)
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001070{
1071 struct hci_cp_le_set_scan_enable *cp;
1072 __u8 status = *((__u8 *) skb->data);
1073
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001074 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001075
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001076 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
1077 if (!cp)
1078 return;
1079
Andre Guedes3fd319b2013-04-30 15:29:36 -03001080 if (status)
1081 return;
1082
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001083 switch (cp->enable) {
Andre Guedes76a388b2013-04-04 20:21:02 -03001084 case LE_SCAN_ENABLE:
Andre Guedesd23264a2011-11-25 20:53:38 -03001085 set_bit(HCI_LE_SCAN, &hdev->dev_flags);
Johan Hedbergb9a63282014-03-25 10:51:52 +02001086 if (hdev->le_scan_type == LE_SCAN_ACTIVE)
1087 clear_pending_adv_report(hdev);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001088 break;
1089
Andre Guedes76a388b2013-04-04 20:21:02 -03001090 case LE_SCAN_DISABLE:
Johan Hedbergb9a63282014-03-25 10:51:52 +02001091 /* We do this here instead of when setting DISCOVERY_STOPPED
1092 * since the latter would potentially require waiting for
1093 * inquiry to stop too.
1094 */
1095 if (has_pending_adv_report(hdev)) {
1096 struct discovery_state *d = &hdev->discovery;
1097
1098 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergab0aa432014-03-26 14:17:12 +02001099 d->last_adv_addr_type, NULL,
1100 d->last_adv_rssi, 0, 1,
1101 d->last_adv_data,
Johan Hedbergb9a63282014-03-25 10:51:52 +02001102 d->last_adv_data_len, NULL, 0);
1103 }
1104
Johan Hedberg317ac8c2014-02-28 20:26:12 +02001105 /* Cancel this timer so that we don't try to disable scanning
1106 * when it's already disabled.
1107 */
1108 cancel_delayed_work(&hdev->le_scan_disable);
1109
Andre Guedesd23264a2011-11-25 20:53:38 -03001110 clear_bit(HCI_LE_SCAN, &hdev->dev_flags);
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001111 /* The HCI_LE_SCAN_INTERRUPTED flag indicates that we
1112 * interrupted scanning due to a connect request. Mark
1113 * therefore discovery as stopped.
1114 */
1115 if (test_and_clear_bit(HCI_LE_SCAN_INTERRUPTED,
1116 &hdev->dev_flags))
1117 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001118 break;
1119
1120 default:
1121 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1122 break;
Andre Guedes35815082011-05-26 16:23:53 -03001123 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001124}
1125
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001126static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
1127 struct sk_buff *skb)
1128{
1129 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
1130
1131 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
1132
1133 if (!rp->status)
1134 hdev->le_white_list_size = rp->size;
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001135}
1136
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001137static void hci_cc_le_clear_white_list(struct hci_dev *hdev,
1138 struct sk_buff *skb)
1139{
1140 __u8 status = *((__u8 *) skb->data);
1141
1142 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1143
1144 if (!status)
1145 hci_white_list_clear(hdev);
1146}
1147
1148static void hci_cc_le_add_to_white_list(struct hci_dev *hdev,
1149 struct sk_buff *skb)
1150{
1151 struct hci_cp_le_add_to_white_list *sent;
1152 __u8 status = *((__u8 *) skb->data);
1153
1154 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1155
1156 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_WHITE_LIST);
1157 if (!sent)
1158 return;
1159
1160 if (!status)
1161 hci_white_list_add(hdev, &sent->bdaddr, sent->bdaddr_type);
1162}
1163
1164static void hci_cc_le_del_from_white_list(struct hci_dev *hdev,
1165 struct sk_buff *skb)
1166{
1167 struct hci_cp_le_del_from_white_list *sent;
1168 __u8 status = *((__u8 *) skb->data);
1169
1170 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1171
1172 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_WHITE_LIST);
1173 if (!sent)
1174 return;
1175
1176 if (!status)
1177 hci_white_list_del(hdev, &sent->bdaddr, sent->bdaddr_type);
1178}
1179
Johan Hedberg9b008c02013-01-22 14:02:01 +02001180static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
1181 struct sk_buff *skb)
1182{
1183 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
1184
1185 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1186
1187 if (!rp->status)
1188 memcpy(hdev->le_states, rp->le_states, 8);
Johan Hedberg9b008c02013-01-22 14:02:01 +02001189}
1190
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001191static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1192 struct sk_buff *skb)
Andre Guedesf9b49302011-06-30 19:20:53 -03001193{
Johan Hedberg06199cf2012-02-22 16:37:11 +02001194 struct hci_cp_write_le_host_supported *sent;
Andre Guedesf9b49302011-06-30 19:20:53 -03001195 __u8 status = *((__u8 *) skb->data);
1196
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001197 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001198
Johan Hedberg06199cf2012-02-22 16:37:11 +02001199 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001200 if (!sent)
Andre Guedesf9b49302011-06-30 19:20:53 -03001201 return;
1202
Johan Hedberg8f984df2012-02-28 01:07:22 +02001203 if (!status) {
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001204 if (sent->le) {
Johan Hedbergcad718e2013-04-17 15:00:51 +03001205 hdev->features[1][0] |= LMP_HOST_LE;
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001206 set_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1207 } else {
Johan Hedbergcad718e2013-04-17 15:00:51 +03001208 hdev->features[1][0] &= ~LMP_HOST_LE;
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001209 clear_bit(HCI_LE_ENABLED, &hdev->dev_flags);
Johan Hedbergf3d3444a2013-10-05 12:01:04 +02001210 clear_bit(HCI_ADVERTISING, &hdev->dev_flags);
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001211 }
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001212
1213 if (sent->simul)
Johan Hedbergcad718e2013-04-17 15:00:51 +03001214 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001215 else
Johan Hedbergcad718e2013-04-17 15:00:51 +03001216 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
Johan Hedberg8f984df2012-02-28 01:07:22 +02001217 }
Andre Guedesf9b49302011-06-30 19:20:53 -03001218}
1219
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02001220static void hci_cc_set_adv_param(struct hci_dev *hdev, struct sk_buff *skb)
1221{
1222 struct hci_cp_le_set_adv_param *cp;
1223 u8 status = *((u8 *) skb->data);
1224
1225 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1226
1227 if (status)
1228 return;
1229
1230 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_PARAM);
1231 if (!cp)
1232 return;
1233
1234 hci_dev_lock(hdev);
1235 hdev->adv_addr_type = cp->own_address_type;
1236 hci_dev_unlock(hdev);
1237}
1238
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001239static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1240 struct sk_buff *skb)
1241{
1242 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1243
1244 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1245 hdev->name, rp->status, rp->phy_handle);
1246
1247 if (rp->status)
1248 return;
1249
1250 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1251}
1252
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02001253static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
1254{
1255 struct hci_rp_read_rssi *rp = (void *) skb->data;
1256 struct hci_conn *conn;
1257
1258 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1259
1260 if (rp->status)
1261 return;
1262
1263 hci_dev_lock(hdev);
1264
1265 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
1266 if (conn)
1267 conn->rssi = rp->rssi;
1268
1269 hci_dev_unlock(hdev);
1270}
1271
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001272static void hci_cc_read_tx_power(struct hci_dev *hdev, struct sk_buff *skb)
1273{
1274 struct hci_cp_read_tx_power *sent;
1275 struct hci_rp_read_tx_power *rp = (void *) skb->data;
1276 struct hci_conn *conn;
1277
1278 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1279
1280 if (rp->status)
1281 return;
1282
1283 sent = hci_sent_cmd_data(hdev, HCI_OP_READ_TX_POWER);
1284 if (!sent)
1285 return;
1286
1287 hci_dev_lock(hdev);
1288
1289 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001290 if (!conn)
1291 goto unlock;
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001292
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001293 switch (sent->type) {
1294 case 0x00:
1295 conn->tx_power = rp->tx_power;
1296 break;
1297 case 0x01:
1298 conn->max_tx_power = rp->tx_power;
1299 break;
1300 }
1301
1302unlock:
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001303 hci_dev_unlock(hdev);
1304}
1305
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001306static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001307{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001308 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001309
1310 if (status) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001311 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001312 return;
1313 }
1314
Andre Guedes89352e72011-11-04 14:16:53 -03001315 set_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001316}
1317
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001318static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001320 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001323 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001324
1325 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326 if (!cp)
1327 return;
1328
1329 hci_dev_lock(hdev);
1330
1331 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1332
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001333 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001334
1335 if (status) {
1336 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001337 if (status != 0x0c || conn->attempt > 2) {
1338 conn->state = BT_CLOSED;
1339 hci_proto_connect_cfm(conn, status);
1340 hci_conn_del(conn);
1341 } else
1342 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001343 }
1344 } else {
1345 if (!conn) {
1346 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1347 if (conn) {
Johan Hedberga0c808b2012-01-16 09:49:58 +02001348 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349 conn->link_mode |= HCI_LM_MASTER;
1350 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001351 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 }
1353 }
1354
1355 hci_dev_unlock(hdev);
1356}
1357
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001358static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001360 struct hci_cp_add_sco *cp;
1361 struct hci_conn *acl, *sco;
1362 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001364 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001365
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001366 if (!status)
1367 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001369 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1370 if (!cp)
1371 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001373 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001374
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001375 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001376
1377 hci_dev_lock(hdev);
1378
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001379 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001380 if (acl) {
1381 sco = acl->link;
1382 if (sco) {
1383 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001384
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001385 hci_proto_connect_cfm(sco, status);
1386 hci_conn_del(sco);
1387 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001388 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001389
1390 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391}
1392
Marcel Holtmannf8558552008-07-14 20:13:49 +02001393static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1394{
1395 struct hci_cp_auth_requested *cp;
1396 struct hci_conn *conn;
1397
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001398 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001399
1400 if (!status)
1401 return;
1402
1403 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1404 if (!cp)
1405 return;
1406
1407 hci_dev_lock(hdev);
1408
1409 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1410 if (conn) {
1411 if (conn->state == BT_CONFIG) {
1412 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001413 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001414 }
1415 }
1416
1417 hci_dev_unlock(hdev);
1418}
1419
1420static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1421{
1422 struct hci_cp_set_conn_encrypt *cp;
1423 struct hci_conn *conn;
1424
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001425 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001426
1427 if (!status)
1428 return;
1429
1430 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1431 if (!cp)
1432 return;
1433
1434 hci_dev_lock(hdev);
1435
1436 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1437 if (conn) {
1438 if (conn->state == BT_CONFIG) {
1439 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001440 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001441 }
1442 }
1443
1444 hci_dev_unlock(hdev);
1445}
1446
Johan Hedberg127178d2010-11-18 22:22:29 +02001447static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001448 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001449{
Johan Hedberg392599b2010-11-18 22:22:28 +02001450 if (conn->state != BT_CONFIG || !conn->out)
1451 return 0;
1452
Johan Hedberg765c2a92011-01-19 12:06:52 +05301453 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001454 return 0;
1455
1456 /* Only request authentication for SSP connections or non-SSP
Johan Hedberg264b8b42014-01-08 16:40:39 +02001457 * devices with sec_level MEDIUM or HIGH or if MITM protection
1458 * is requested.
1459 */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001460 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
Johan Hedberg7e3691e2014-05-30 14:45:19 +03001461 conn->pending_sec_level != BT_SECURITY_FIPS &&
Johan Hedberg264b8b42014-01-08 16:40:39 +02001462 conn->pending_sec_level != BT_SECURITY_HIGH &&
1463 conn->pending_sec_level != BT_SECURITY_MEDIUM)
Johan Hedberg392599b2010-11-18 22:22:28 +02001464 return 0;
1465
Johan Hedberg392599b2010-11-18 22:22:28 +02001466 return 1;
1467}
1468
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001469static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001470 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001471{
1472 struct hci_cp_remote_name_req cp;
1473
1474 memset(&cp, 0, sizeof(cp));
1475
1476 bacpy(&cp.bdaddr, &e->data.bdaddr);
1477 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1478 cp.pscan_mode = e->data.pscan_mode;
1479 cp.clock_offset = e->data.clock_offset;
1480
1481 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1482}
1483
Johan Hedbergb644ba32012-01-17 21:48:47 +02001484static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001485{
1486 struct discovery_state *discov = &hdev->discovery;
1487 struct inquiry_entry *e;
1488
Johan Hedbergb644ba32012-01-17 21:48:47 +02001489 if (list_empty(&discov->resolve))
1490 return false;
1491
1492 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001493 if (!e)
1494 return false;
1495
Johan Hedbergb644ba32012-01-17 21:48:47 +02001496 if (hci_resolve_name(hdev, e) == 0) {
1497 e->name_state = NAME_PENDING;
1498 return true;
1499 }
1500
1501 return false;
1502}
1503
1504static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001505 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001506{
1507 struct discovery_state *discov = &hdev->discovery;
1508 struct inquiry_entry *e;
1509
1510 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001511 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1512 name_len, conn->dev_class);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001513
1514 if (discov->state == DISCOVERY_STOPPED)
1515 return;
1516
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001517 if (discov->state == DISCOVERY_STOPPING)
1518 goto discov_complete;
1519
1520 if (discov->state != DISCOVERY_RESOLVING)
1521 return;
1522
1523 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001524 /* If the device was not found in a list of found devices names of which
1525 * are pending. there is no need to continue resolving a next name as it
1526 * will be done upon receiving another Remote Name Request Complete
1527 * Event */
1528 if (!e)
1529 return;
1530
1531 list_del(&e->list);
1532 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001533 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001534 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1535 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001536 } else {
1537 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001538 }
1539
Johan Hedbergb644ba32012-01-17 21:48:47 +02001540 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001541 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001542
1543discov_complete:
1544 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1545}
1546
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001547static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1548{
Johan Hedberg127178d2010-11-18 22:22:29 +02001549 struct hci_cp_remote_name_req *cp;
1550 struct hci_conn *conn;
1551
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001552 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001553
1554 /* If successful wait for the name req complete event before
1555 * checking for the need to do authentication */
1556 if (!status)
1557 return;
1558
1559 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1560 if (!cp)
1561 return;
1562
1563 hci_dev_lock(hdev);
1564
1565 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001566
1567 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1568 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1569
Johan Hedberg79c6c702011-04-28 11:28:55 -07001570 if (!conn)
1571 goto unlock;
1572
1573 if (!hci_outgoing_auth_needed(hdev, conn))
1574 goto unlock;
1575
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001576 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02001577 struct hci_cp_auth_requested auth_cp;
1578
1579 auth_cp.handle = __cpu_to_le16(conn->handle);
1580 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1581 sizeof(auth_cp), &auth_cp);
Johan Hedberg127178d2010-11-18 22:22:29 +02001582 }
1583
Johan Hedberg79c6c702011-04-28 11:28:55 -07001584unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001585 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001586}
1587
Marcel Holtmann769be972008-07-14 20:13:49 +02001588static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1589{
1590 struct hci_cp_read_remote_features *cp;
1591 struct hci_conn *conn;
1592
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001593 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001594
1595 if (!status)
1596 return;
1597
1598 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1599 if (!cp)
1600 return;
1601
1602 hci_dev_lock(hdev);
1603
1604 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1605 if (conn) {
1606 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001607 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001608 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001609 }
1610 }
1611
1612 hci_dev_unlock(hdev);
1613}
1614
1615static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1616{
1617 struct hci_cp_read_remote_ext_features *cp;
1618 struct hci_conn *conn;
1619
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001620 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001621
1622 if (!status)
1623 return;
1624
1625 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1626 if (!cp)
1627 return;
1628
1629 hci_dev_lock(hdev);
1630
1631 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1632 if (conn) {
1633 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001634 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001635 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001636 }
1637 }
1638
1639 hci_dev_unlock(hdev);
1640}
1641
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001642static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1643{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001644 struct hci_cp_setup_sync_conn *cp;
1645 struct hci_conn *acl, *sco;
1646 __u16 handle;
1647
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001648 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001649
1650 if (!status)
1651 return;
1652
1653 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1654 if (!cp)
1655 return;
1656
1657 handle = __le16_to_cpu(cp->handle);
1658
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001659 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001660
1661 hci_dev_lock(hdev);
1662
1663 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001664 if (acl) {
1665 sco = acl->link;
1666 if (sco) {
1667 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001668
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001669 hci_proto_connect_cfm(sco, status);
1670 hci_conn_del(sco);
1671 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001672 }
1673
1674 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001675}
1676
1677static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1678{
1679 struct hci_cp_sniff_mode *cp;
1680 struct hci_conn *conn;
1681
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001682 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001683
1684 if (!status)
1685 return;
1686
1687 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1688 if (!cp)
1689 return;
1690
1691 hci_dev_lock(hdev);
1692
1693 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001694 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001695 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001696
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001697 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001698 hci_sco_setup(conn, status);
1699 }
1700
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001701 hci_dev_unlock(hdev);
1702}
1703
1704static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1705{
1706 struct hci_cp_exit_sniff_mode *cp;
1707 struct hci_conn *conn;
1708
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001709 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001710
1711 if (!status)
1712 return;
1713
1714 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1715 if (!cp)
1716 return;
1717
1718 hci_dev_lock(hdev);
1719
1720 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001721 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001722 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001723
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001724 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001725 hci_sco_setup(conn, status);
1726 }
1727
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001728 hci_dev_unlock(hdev);
1729}
1730
Johan Hedberg88c3df12012-02-09 14:27:38 +02001731static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1732{
1733 struct hci_cp_disconnect *cp;
1734 struct hci_conn *conn;
1735
1736 if (!status)
1737 return;
1738
1739 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1740 if (!cp)
1741 return;
1742
1743 hci_dev_lock(hdev);
1744
1745 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1746 if (conn)
1747 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001748 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001749
1750 hci_dev_unlock(hdev);
1751}
1752
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001753static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1754{
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001755 struct hci_cp_create_phy_link *cp;
1756
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001757 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001758
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001759 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1760 if (!cp)
1761 return;
1762
Andrei Emeltchenkoe58917b2012-10-31 15:46:33 +02001763 hci_dev_lock(hdev);
1764
1765 if (status) {
1766 struct hci_conn *hcon;
1767
1768 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1769 if (hcon)
1770 hci_conn_del(hcon);
1771 } else {
1772 amp_write_remote_assoc(hdev, cp->phy_handle);
1773 }
1774
1775 hci_dev_unlock(hdev);
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001776}
1777
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03001778static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1779{
1780 struct hci_cp_accept_phy_link *cp;
1781
1782 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1783
1784 if (status)
1785 return;
1786
1787 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1788 if (!cp)
1789 return;
1790
1791 amp_write_remote_assoc(hdev, cp->phy_handle);
1792}
1793
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02001794static void hci_cs_le_create_conn(struct hci_dev *hdev, u8 status)
1795{
1796 struct hci_cp_le_create_conn *cp;
1797 struct hci_conn *conn;
1798
1799 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1800
1801 /* All connection failure handling is taken care of by the
1802 * hci_le_conn_failed function which is triggered by the HCI
1803 * request completion callbacks used for connecting.
1804 */
1805 if (status)
1806 return;
1807
1808 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1809 if (!cp)
1810 return;
1811
1812 hci_dev_lock(hdev);
1813
1814 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1815 if (!conn)
1816 goto unlock;
1817
1818 /* Store the initiator and responder address information which
1819 * is needed for SMP. These values will not change during the
1820 * lifetime of the connection.
1821 */
1822 conn->init_addr_type = cp->own_address_type;
1823 if (cp->own_address_type == ADDR_LE_DEV_RANDOM)
1824 bacpy(&conn->init_addr, &hdev->random_addr);
1825 else
1826 bacpy(&conn->init_addr, &hdev->bdaddr);
1827
1828 conn->resp_addr_type = cp->peer_addr_type;
1829 bacpy(&conn->resp_addr, &cp->peer_addr);
1830
Johan Hedberg9489eca2014-02-28 17:45:46 +02001831 /* We don't want the connection attempt to stick around
1832 * indefinitely since LE doesn't have a page timeout concept
1833 * like BR/EDR. Set a timer for any connection that doesn't use
1834 * the white list for connecting.
1835 */
1836 if (cp->filter_policy == HCI_LE_USE_PEER_ADDR)
1837 queue_delayed_work(conn->hdev->workqueue,
1838 &conn->le_conn_timeout,
1839 HCI_LE_CONN_TIMEOUT);
1840
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02001841unlock:
1842 hci_dev_unlock(hdev);
1843}
1844
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02001845static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1846{
1847 struct hci_cp_le_start_enc *cp;
1848 struct hci_conn *conn;
1849
1850 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1851
1852 if (!status)
1853 return;
1854
1855 hci_dev_lock(hdev);
1856
1857 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_START_ENC);
1858 if (!cp)
1859 goto unlock;
1860
1861 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1862 if (!conn)
1863 goto unlock;
1864
1865 if (conn->state != BT_CONNECTED)
1866 goto unlock;
1867
1868 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
1869 hci_conn_drop(conn);
1870
1871unlock:
1872 hci_dev_unlock(hdev);
1873}
1874
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001875static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001876{
1877 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001878 struct discovery_state *discov = &hdev->discovery;
1879 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001880
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001881 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001882
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001883 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001884
1885 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1886 return;
1887
Peter Zijlstra4e857c52014-03-17 18:06:10 +01001888 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
Andre Guedes3e13fa12013-03-27 20:04:56 -03001889 wake_up_bit(&hdev->flags, HCI_INQUIRY);
1890
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001891 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001892 return;
1893
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001894 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001895
Andre Guedes343f9352012-02-17 20:39:37 -03001896 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001897 goto unlock;
1898
1899 if (list_empty(&discov->resolve)) {
1900 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1901 goto unlock;
1902 }
1903
1904 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1905 if (e && hci_resolve_name(hdev, e) == 0) {
1906 e->name_state = NAME_PENDING;
1907 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1908 } else {
1909 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1910 }
1911
1912unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001913 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001914}
1915
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001916static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001917{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001918 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001919 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001920 int num_rsp = *((__u8 *) skb->data);
1921
1922 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1923
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001924 if (!num_rsp)
1925 return;
1926
Andre Guedes1519cc12012-03-21 00:03:38 -03001927 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1928 return;
1929
Linus Torvalds1da177e2005-04-16 15:20:36 -07001930 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001931
Johan Hedberge17acd42011-03-30 23:57:16 +03001932 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001933 bool name_known, ssp;
Johan Hedberg31754052012-01-04 13:39:52 +02001934
Linus Torvalds1da177e2005-04-16 15:20:36 -07001935 bacpy(&data.bdaddr, &info->bdaddr);
1936 data.pscan_rep_mode = info->pscan_rep_mode;
1937 data.pscan_period_mode = info->pscan_period_mode;
1938 data.pscan_mode = info->pscan_mode;
1939 memcpy(data.dev_class, info->dev_class, 3);
1940 data.clock_offset = info->clock_offset;
1941 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001942 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02001943
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001944 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02001945 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001946 info->dev_class, 0, !name_known, ssp, NULL,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02001947 0, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001948 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001949
Linus Torvalds1da177e2005-04-16 15:20:36 -07001950 hci_dev_unlock(hdev);
1951}
1952
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001953static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001954{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001955 struct hci_ev_conn_complete *ev = (void *) skb->data;
1956 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001957
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001958 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001959
Linus Torvalds1da177e2005-04-16 15:20:36 -07001960 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001961
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001962 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001963 if (!conn) {
1964 if (ev->link_type != SCO_LINK)
1965 goto unlock;
1966
1967 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1968 if (!conn)
1969 goto unlock;
1970
1971 conn->type = SCO_LINK;
1972 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001973
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001974 if (!ev->status) {
1975 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001976
1977 if (conn->type == ACL_LINK) {
1978 conn->state = BT_CONFIG;
1979 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02001980
1981 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1982 !hci_find_link_key(hdev, &ev->bdaddr))
1983 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1984 else
1985 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02001986 } else
1987 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001988
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001989 hci_conn_add_sysfs(conn);
1990
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001991 if (test_bit(HCI_AUTH, &hdev->flags))
1992 conn->link_mode |= HCI_LM_AUTH;
1993
1994 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1995 conn->link_mode |= HCI_LM_ENCRYPT;
1996
1997 /* Get remote features */
1998 if (conn->type == ACL_LINK) {
1999 struct hci_cp_read_remote_features cp;
2000 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02002001 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002002 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002003 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002004
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002005 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02002006 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002007 struct hci_cp_change_conn_ptype cp;
2008 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02002009 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002010 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
2011 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002012 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02002013 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002014 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02002015 if (conn->type == ACL_LINK)
Marcel Holtmann64c7b772014-02-18 14:22:20 -08002016 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002017 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02002018 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002019
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002020 if (conn->type == ACL_LINK)
2021 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002022
Marcel Holtmann769be972008-07-14 20:13:49 +02002023 if (ev->status) {
2024 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002025 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01002026 } else if (ev->link_type != ACL_LINK)
2027 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002028
2029unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002030 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002031
2032 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002033}
2034
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002035static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002036{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002037 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038 int mask = hdev->link_mode;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002039 __u8 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002040
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002041 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002042 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002044 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
2045 &flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046
Szymon Janc138d22e2011-02-17 16:44:23 +01002047 if ((mask & HCI_LM_ACCEPT) &&
Marcel Holtmannb9ee0a72013-10-17 17:24:13 -07002048 !hci_blacklist_lookup(hdev, &ev->bdaddr, BDADDR_BREDR)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02002050 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002051 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002052
2053 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002054
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002055 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2056 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02002057 memcpy(ie->data.dev_class, ev->dev_class, 3);
2058
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002059 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
2060 &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002062 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
2063 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03002064 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002065 hci_dev_unlock(hdev);
2066 return;
2067 }
2068 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002069
Linus Torvalds1da177e2005-04-16 15:20:36 -07002070 memcpy(conn->dev_class, ev->dev_class, 3);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002071
Linus Torvalds1da177e2005-04-16 15:20:36 -07002072 hci_dev_unlock(hdev);
2073
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002074 if (ev->link_type == ACL_LINK ||
2075 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002076 struct hci_cp_accept_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002077 conn->state = BT_CONNECT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002078
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002079 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002080
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002081 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
2082 cp.role = 0x00; /* Become master */
2083 else
2084 cp.role = 0x01; /* Remain slave */
2085
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002086 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
2087 &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002088 } else if (!(flags & HCI_PROTO_DEFER)) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002089 struct hci_cp_accept_sync_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002090 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002091
2092 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02002093 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002094
Joe Perchesdcf4adb2014-03-12 10:52:35 -07002095 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
2096 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
2097 cp.max_latency = cpu_to_le16(0xffff);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002098 cp.content_format = cpu_to_le16(hdev->voice_setting);
2099 cp.retrans_effort = 0xff;
2100
2101 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002102 sizeof(cp), &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002103 } else {
2104 conn->state = BT_CONNECT2;
2105 hci_proto_connect_cfm(conn, 0);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002106 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002107 } else {
2108 /* Connection rejected */
2109 struct hci_cp_reject_conn_req cp;
2110
2111 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02002112 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002113 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002114 }
2115}
2116
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02002117static u8 hci_to_mgmt_reason(u8 err)
2118{
2119 switch (err) {
2120 case HCI_ERROR_CONNECTION_TIMEOUT:
2121 return MGMT_DEV_DISCONN_TIMEOUT;
2122 case HCI_ERROR_REMOTE_USER_TERM:
2123 case HCI_ERROR_REMOTE_LOW_RESOURCES:
2124 case HCI_ERROR_REMOTE_POWER_OFF:
2125 return MGMT_DEV_DISCONN_REMOTE;
2126 case HCI_ERROR_LOCAL_HOST_TERM:
2127 return MGMT_DEV_DISCONN_LOCAL_HOST;
2128 default:
2129 return MGMT_DEV_DISCONN_UNKNOWN;
2130 }
2131}
2132
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002133static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002134{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002135 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Andre Guedesabf54a52013-11-07 17:36:09 -03002136 u8 reason = hci_to_mgmt_reason(ev->reason);
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002137 struct hci_conn_params *params;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002138 struct hci_conn *conn;
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002139 bool mgmt_connected;
Andre Guedes38462202013-11-07 17:36:10 -03002140 u8 type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002141
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002142 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002143
Linus Torvalds1da177e2005-04-16 15:20:36 -07002144 hci_dev_lock(hdev);
2145
Marcel Holtmann04837f62006-07-03 10:02:33 +02002146 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02002147 if (!conn)
2148 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002149
Andre Guedesabf54a52013-11-07 17:36:09 -03002150 if (ev->status) {
2151 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
2152 conn->dst_type, ev->status);
2153 goto unlock;
Johan Hedberg37d9ef72011-11-10 15:54:39 +02002154 }
Johan Hedbergf7520542011-01-20 12:34:39 +02002155
Andre Guedes38462202013-11-07 17:36:10 -03002156 conn->state = BT_CLOSED;
2157
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002158 mgmt_connected = test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags);
2159 mgmt_device_disconnected(hdev, &conn->dst, conn->type, conn->dst_type,
2160 reason, mgmt_connected);
Andre Guedesabf54a52013-11-07 17:36:09 -03002161
Johan Hedbergaf6a9c32014-06-24 13:15:53 +03002162 if (conn->type == ACL_LINK &&
2163 test_bit(HCI_CONN_FLUSH_KEY, &conn->flags))
Andre Guedes38462202013-11-07 17:36:10 -03002164 hci_remove_link_key(hdev, &conn->dst);
Johan Hedberg22102462013-10-05 12:01:06 +02002165
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002166 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
2167 if (params) {
2168 switch (params->auto_connect) {
2169 case HCI_AUTO_CONN_LINK_LOSS:
2170 if (ev->reason != HCI_ERROR_CONNECTION_TIMEOUT)
2171 break;
2172 /* Fall through */
2173
2174 case HCI_AUTO_CONN_ALWAYS:
2175 hci_pend_le_conn_add(hdev, &conn->dst, conn->dst_type);
2176 break;
2177
2178 default:
2179 break;
2180 }
2181 }
2182
Andre Guedes38462202013-11-07 17:36:10 -03002183 type = conn->type;
Johan Hedberg22102462013-10-05 12:01:06 +02002184
Andre Guedes38462202013-11-07 17:36:10 -03002185 hci_proto_disconn_cfm(conn, ev->reason);
2186 hci_conn_del(conn);
2187
2188 /* Re-enable advertising if necessary, since it might
2189 * have been disabled by the connection. From the
2190 * HCI_LE_Set_Advertise_Enable command description in
2191 * the core specification (v4.0):
2192 * "The Controller shall continue advertising until the Host
2193 * issues an LE_Set_Advertise_Enable command with
2194 * Advertising_Enable set to 0x00 (Advertising is disabled)
2195 * or until a connection is created or until the Advertising
2196 * is timed out due to Directed Advertising."
2197 */
2198 if (type == LE_LINK)
2199 mgmt_reenable_advertising(hdev);
Johan Hedbergf7520542011-01-20 12:34:39 +02002200
2201unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002202 hci_dev_unlock(hdev);
2203}
2204
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002205static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002206{
2207 struct hci_ev_auth_complete *ev = (void *) skb->data;
2208 struct hci_conn *conn;
2209
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002210 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002211
2212 hci_dev_lock(hdev);
2213
2214 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002215 if (!conn)
2216 goto unlock;
2217
2218 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002219 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002220 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002221 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03002222 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002223 conn->link_mode |= HCI_LM_AUTH;
2224 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03002225 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002226 } else {
Johan Hedbergbab73cb2012-02-09 16:07:29 +02002227 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002228 ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002229 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002230
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002231 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
2232 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002233
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002234 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002235 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002236 struct hci_cp_set_conn_encrypt cp;
2237 cp.handle = ev->handle;
2238 cp.encrypt = 0x01;
2239 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002240 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002241 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002242 conn->state = BT_CONNECTED;
2243 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002244 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002245 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002246 } else {
2247 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002248
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002249 hci_conn_hold(conn);
2250 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02002251 hci_conn_drop(conn);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002252 }
2253
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002254 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002255 if (!ev->status) {
2256 struct hci_cp_set_conn_encrypt cp;
2257 cp.handle = ev->handle;
2258 cp.encrypt = 0x01;
2259 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002260 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002261 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002262 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002263 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002264 }
2265 }
2266
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002267unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002268 hci_dev_unlock(hdev);
2269}
2270
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002271static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002272{
Johan Hedberg127178d2010-11-18 22:22:29 +02002273 struct hci_ev_remote_name *ev = (void *) skb->data;
2274 struct hci_conn *conn;
2275
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002276 BT_DBG("%s", hdev->name);
2277
2278 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02002279
2280 hci_dev_lock(hdev);
2281
2282 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002283
2284 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
2285 goto check_auth;
2286
2287 if (ev->status == 0)
2288 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002289 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02002290 else
2291 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2292
2293check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07002294 if (!conn)
2295 goto unlock;
2296
2297 if (!hci_outgoing_auth_needed(hdev, conn))
2298 goto unlock;
2299
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002300 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002301 struct hci_cp_auth_requested cp;
2302 cp.handle = __cpu_to_le16(conn->handle);
2303 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2304 }
2305
Johan Hedberg79c6c702011-04-28 11:28:55 -07002306unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02002307 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002308}
2309
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002310static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002311{
2312 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2313 struct hci_conn *conn;
2314
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002315 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002316
2317 hci_dev_lock(hdev);
2318
2319 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002320 if (!conn)
2321 goto unlock;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002322
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002323 if (!ev->status) {
2324 if (ev->encrypt) {
2325 /* Encryption implies authentication */
2326 conn->link_mode |= HCI_LM_AUTH;
2327 conn->link_mode |= HCI_LM_ENCRYPT;
2328 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002329
Marcel Holtmann914a6ff2014-02-01 11:52:02 -08002330 /* P-256 authentication key implies FIPS */
2331 if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256)
2332 conn->link_mode |= HCI_LM_FIPS;
2333
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002334 if ((conn->type == ACL_LINK && ev->encrypt == 0x02) ||
2335 conn->type == LE_LINK)
2336 set_bit(HCI_CONN_AES_CCM, &conn->flags);
2337 } else {
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002338 conn->link_mode &= ~HCI_LM_ENCRYPT;
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002339 clear_bit(HCI_CONN_AES_CCM, &conn->flags);
2340 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002341 }
2342
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002343 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
2344
2345 if (ev->status && conn->state == BT_CONNECTED) {
2346 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
2347 hci_conn_drop(conn);
2348 goto unlock;
2349 }
2350
2351 if (conn->state == BT_CONFIG) {
2352 if (!ev->status)
2353 conn->state = BT_CONNECTED;
2354
Marcel Holtmann40b552a2014-03-19 14:10:25 -07002355 /* In Secure Connections Only mode, do not allow any
2356 * connections that are not encrypted with AES-CCM
2357 * using a P-256 authenticated combination key.
2358 */
2359 if (test_bit(HCI_SC_ONLY, &hdev->dev_flags) &&
2360 (!test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
2361 conn->key_type != HCI_LK_AUTH_COMBINATION_P256)) {
2362 hci_proto_connect_cfm(conn, HCI_ERROR_AUTH_FAILURE);
2363 hci_conn_drop(conn);
2364 goto unlock;
2365 }
2366
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002367 hci_proto_connect_cfm(conn, ev->status);
2368 hci_conn_drop(conn);
2369 } else
2370 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
2371
Gustavo Padovana7d77232012-05-13 03:20:07 -03002372unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002373 hci_dev_unlock(hdev);
2374}
2375
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002376static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2377 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002378{
2379 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2380 struct hci_conn *conn;
2381
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002382 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002383
2384 hci_dev_lock(hdev);
2385
2386 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2387 if (conn) {
2388 if (!ev->status)
2389 conn->link_mode |= HCI_LM_SECURE;
2390
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002391 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002392
2393 hci_key_change_cfm(conn, ev->status);
2394 }
2395
2396 hci_dev_unlock(hdev);
2397}
2398
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002399static void hci_remote_features_evt(struct hci_dev *hdev,
2400 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002401{
2402 struct hci_ev_remote_features *ev = (void *) skb->data;
2403 struct hci_conn *conn;
2404
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002405 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002406
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002407 hci_dev_lock(hdev);
2408
2409 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002410 if (!conn)
2411 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002412
Johan Hedbergccd556f2010-11-10 17:11:51 +02002413 if (!ev->status)
Johan Hedbergcad718e2013-04-17 15:00:51 +03002414 memcpy(conn->features[0], ev->features, 8);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002415
2416 if (conn->state != BT_CONFIG)
2417 goto unlock;
2418
2419 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2420 struct hci_cp_read_remote_ext_features cp;
2421 cp.handle = ev->handle;
2422 cp.page = 0x01;
2423 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002424 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002425 goto unlock;
2426 }
2427
Johan Hedberg671267b2012-05-12 16:11:50 -03002428 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002429 struct hci_cp_remote_name_req cp;
2430 memset(&cp, 0, sizeof(cp));
2431 bacpy(&cp.bdaddr, &conn->dst);
2432 cp.pscan_rep_mode = 0x02;
2433 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002434 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2435 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002436 conn->dst_type, 0, NULL, 0,
2437 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002438
Johan Hedberg127178d2010-11-18 22:22:29 +02002439 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002440 conn->state = BT_CONNECTED;
2441 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002442 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002443 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002444
Johan Hedbergccd556f2010-11-10 17:11:51 +02002445unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002446 hci_dev_unlock(hdev);
2447}
2448
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002449static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002450{
2451 struct hci_ev_cmd_complete *ev = (void *) skb->data;
Johan Hedberg9238f362013-03-05 20:37:48 +02002452 u8 status = skb->data[sizeof(*ev)];
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002453 __u16 opcode;
2454
2455 skb_pull(skb, sizeof(*ev));
2456
2457 opcode = __le16_to_cpu(ev->opcode);
2458
2459 switch (opcode) {
2460 case HCI_OP_INQUIRY_CANCEL:
2461 hci_cc_inquiry_cancel(hdev, skb);
2462 break;
2463
Andre Guedes4d934832012-03-21 00:03:35 -03002464 case HCI_OP_PERIODIC_INQ:
2465 hci_cc_periodic_inq(hdev, skb);
2466 break;
2467
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002468 case HCI_OP_EXIT_PERIODIC_INQ:
2469 hci_cc_exit_periodic_inq(hdev, skb);
2470 break;
2471
2472 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2473 hci_cc_remote_name_req_cancel(hdev, skb);
2474 break;
2475
2476 case HCI_OP_ROLE_DISCOVERY:
2477 hci_cc_role_discovery(hdev, skb);
2478 break;
2479
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002480 case HCI_OP_READ_LINK_POLICY:
2481 hci_cc_read_link_policy(hdev, skb);
2482 break;
2483
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002484 case HCI_OP_WRITE_LINK_POLICY:
2485 hci_cc_write_link_policy(hdev, skb);
2486 break;
2487
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002488 case HCI_OP_READ_DEF_LINK_POLICY:
2489 hci_cc_read_def_link_policy(hdev, skb);
2490 break;
2491
2492 case HCI_OP_WRITE_DEF_LINK_POLICY:
2493 hci_cc_write_def_link_policy(hdev, skb);
2494 break;
2495
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002496 case HCI_OP_RESET:
2497 hci_cc_reset(hdev, skb);
2498 break;
2499
2500 case HCI_OP_WRITE_LOCAL_NAME:
2501 hci_cc_write_local_name(hdev, skb);
2502 break;
2503
2504 case HCI_OP_READ_LOCAL_NAME:
2505 hci_cc_read_local_name(hdev, skb);
2506 break;
2507
2508 case HCI_OP_WRITE_AUTH_ENABLE:
2509 hci_cc_write_auth_enable(hdev, skb);
2510 break;
2511
2512 case HCI_OP_WRITE_ENCRYPT_MODE:
2513 hci_cc_write_encrypt_mode(hdev, skb);
2514 break;
2515
2516 case HCI_OP_WRITE_SCAN_ENABLE:
2517 hci_cc_write_scan_enable(hdev, skb);
2518 break;
2519
2520 case HCI_OP_READ_CLASS_OF_DEV:
2521 hci_cc_read_class_of_dev(hdev, skb);
2522 break;
2523
2524 case HCI_OP_WRITE_CLASS_OF_DEV:
2525 hci_cc_write_class_of_dev(hdev, skb);
2526 break;
2527
2528 case HCI_OP_READ_VOICE_SETTING:
2529 hci_cc_read_voice_setting(hdev, skb);
2530 break;
2531
2532 case HCI_OP_WRITE_VOICE_SETTING:
2533 hci_cc_write_voice_setting(hdev, skb);
2534 break;
2535
Marcel Holtmannb4cb9fb2013-10-14 13:56:16 -07002536 case HCI_OP_READ_NUM_SUPPORTED_IAC:
2537 hci_cc_read_num_supported_iac(hdev, skb);
2538 break;
2539
Marcel Holtmann333140b2008-07-14 20:13:48 +02002540 case HCI_OP_WRITE_SSP_MODE:
2541 hci_cc_write_ssp_mode(hdev, skb);
2542 break;
2543
Marcel Holtmanneac83dc2014-01-10 02:07:23 -08002544 case HCI_OP_WRITE_SC_SUPPORT:
2545 hci_cc_write_sc_support(hdev, skb);
2546 break;
2547
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002548 case HCI_OP_READ_LOCAL_VERSION:
2549 hci_cc_read_local_version(hdev, skb);
2550 break;
2551
2552 case HCI_OP_READ_LOCAL_COMMANDS:
2553 hci_cc_read_local_commands(hdev, skb);
2554 break;
2555
2556 case HCI_OP_READ_LOCAL_FEATURES:
2557 hci_cc_read_local_features(hdev, skb);
2558 break;
2559
Andre Guedes971e3a42011-06-30 19:20:52 -03002560 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2561 hci_cc_read_local_ext_features(hdev, skb);
2562 break;
2563
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002564 case HCI_OP_READ_BUFFER_SIZE:
2565 hci_cc_read_buffer_size(hdev, skb);
2566 break;
2567
2568 case HCI_OP_READ_BD_ADDR:
2569 hci_cc_read_bd_addr(hdev, skb);
2570 break;
2571
Johan Hedbergf332ec62013-03-15 17:07:11 -05002572 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2573 hci_cc_read_page_scan_activity(hdev, skb);
2574 break;
2575
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002576 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2577 hci_cc_write_page_scan_activity(hdev, skb);
2578 break;
2579
Johan Hedbergf332ec62013-03-15 17:07:11 -05002580 case HCI_OP_READ_PAGE_SCAN_TYPE:
2581 hci_cc_read_page_scan_type(hdev, skb);
2582 break;
2583
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002584 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2585 hci_cc_write_page_scan_type(hdev, skb);
2586 break;
2587
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002588 case HCI_OP_READ_DATA_BLOCK_SIZE:
2589 hci_cc_read_data_block_size(hdev, skb);
2590 break;
2591
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002592 case HCI_OP_READ_FLOW_CONTROL_MODE:
2593 hci_cc_read_flow_control_mode(hdev, skb);
2594 break;
2595
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002596 case HCI_OP_READ_LOCAL_AMP_INFO:
2597 hci_cc_read_local_amp_info(hdev, skb);
2598 break;
2599
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002600 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2601 hci_cc_read_local_amp_assoc(hdev, skb);
2602 break;
2603
Johan Hedbergd5859e22011-01-25 01:19:58 +02002604 case HCI_OP_READ_INQ_RSP_TX_POWER:
2605 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2606 break;
2607
Johan Hedberg980e1a52011-01-22 06:10:07 +02002608 case HCI_OP_PIN_CODE_REPLY:
2609 hci_cc_pin_code_reply(hdev, skb);
2610 break;
2611
2612 case HCI_OP_PIN_CODE_NEG_REPLY:
2613 hci_cc_pin_code_neg_reply(hdev, skb);
2614 break;
2615
Szymon Jancc35938b2011-03-22 13:12:21 +01002616 case HCI_OP_READ_LOCAL_OOB_DATA:
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08002617 hci_cc_read_local_oob_data(hdev, skb);
2618 break;
2619
2620 case HCI_OP_READ_LOCAL_OOB_EXT_DATA:
2621 hci_cc_read_local_oob_ext_data(hdev, skb);
Szymon Jancc35938b2011-03-22 13:12:21 +01002622 break;
2623
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002624 case HCI_OP_LE_READ_BUFFER_SIZE:
2625 hci_cc_le_read_buffer_size(hdev, skb);
2626 break;
2627
Johan Hedberg60e77322013-01-22 14:01:59 +02002628 case HCI_OP_LE_READ_LOCAL_FEATURES:
2629 hci_cc_le_read_local_features(hdev, skb);
2630 break;
2631
Johan Hedberg8fa19092012-10-19 20:57:49 +03002632 case HCI_OP_LE_READ_ADV_TX_POWER:
2633 hci_cc_le_read_adv_tx_power(hdev, skb);
2634 break;
2635
Johan Hedberga5c29682011-02-19 12:05:57 -03002636 case HCI_OP_USER_CONFIRM_REPLY:
2637 hci_cc_user_confirm_reply(hdev, skb);
2638 break;
2639
2640 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2641 hci_cc_user_confirm_neg_reply(hdev, skb);
2642 break;
2643
Brian Gix1143d452011-11-23 08:28:34 -08002644 case HCI_OP_USER_PASSKEY_REPLY:
2645 hci_cc_user_passkey_reply(hdev, skb);
2646 break;
2647
2648 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2649 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002650 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002651
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08002652 case HCI_OP_LE_SET_RANDOM_ADDR:
2653 hci_cc_le_set_random_addr(hdev, skb);
2654 break;
2655
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01002656 case HCI_OP_LE_SET_ADV_ENABLE:
2657 hci_cc_le_set_adv_enable(hdev, skb);
2658 break;
2659
Marcel Holtmann533553f2014-03-21 12:18:10 -07002660 case HCI_OP_LE_SET_SCAN_PARAM:
2661 hci_cc_le_set_scan_param(hdev, skb);
2662 break;
2663
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002664 case HCI_OP_LE_SET_SCAN_ENABLE:
2665 hci_cc_le_set_scan_enable(hdev, skb);
2666 break;
2667
Johan Hedbergcf1d0812013-01-22 14:02:00 +02002668 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2669 hci_cc_le_read_white_list_size(hdev, skb);
2670 break;
2671
Marcel Holtmann0f36b582014-02-27 20:37:31 -08002672 case HCI_OP_LE_CLEAR_WHITE_LIST:
2673 hci_cc_le_clear_white_list(hdev, skb);
2674 break;
2675
2676 case HCI_OP_LE_ADD_TO_WHITE_LIST:
2677 hci_cc_le_add_to_white_list(hdev, skb);
2678 break;
2679
2680 case HCI_OP_LE_DEL_FROM_WHITE_LIST:
2681 hci_cc_le_del_from_white_list(hdev, skb);
2682 break;
2683
Johan Hedberg9b008c02013-01-22 14:02:01 +02002684 case HCI_OP_LE_READ_SUPPORTED_STATES:
2685 hci_cc_le_read_supported_states(hdev, skb);
2686 break;
2687
Andre Guedesf9b49302011-06-30 19:20:53 -03002688 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2689 hci_cc_write_le_host_supported(hdev, skb);
2690 break;
2691
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02002692 case HCI_OP_LE_SET_ADV_PARAM:
2693 hci_cc_set_adv_param(hdev, skb);
2694 break;
2695
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03002696 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2697 hci_cc_write_remote_amp_assoc(hdev, skb);
2698 break;
2699
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02002700 case HCI_OP_READ_RSSI:
2701 hci_cc_read_rssi(hdev, skb);
2702 break;
2703
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02002704 case HCI_OP_READ_TX_POWER:
2705 hci_cc_read_tx_power(hdev, skb);
2706 break;
2707
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002708 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002709 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002710 break;
2711 }
2712
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002713 if (opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02002714 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02002715
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002716 hci_req_cmd_complete(hdev, opcode, status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002717
Szymon Jancdbccd792012-12-11 08:51:19 +01002718 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002719 atomic_set(&hdev->cmd_cnt, 1);
2720 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002721 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002722 }
2723}
2724
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002725static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002726{
2727 struct hci_ev_cmd_status *ev = (void *) skb->data;
2728 __u16 opcode;
2729
2730 skb_pull(skb, sizeof(*ev));
2731
2732 opcode = __le16_to_cpu(ev->opcode);
2733
2734 switch (opcode) {
2735 case HCI_OP_INQUIRY:
2736 hci_cs_inquiry(hdev, ev->status);
2737 break;
2738
2739 case HCI_OP_CREATE_CONN:
2740 hci_cs_create_conn(hdev, ev->status);
2741 break;
2742
2743 case HCI_OP_ADD_SCO:
2744 hci_cs_add_sco(hdev, ev->status);
2745 break;
2746
Marcel Holtmannf8558552008-07-14 20:13:49 +02002747 case HCI_OP_AUTH_REQUESTED:
2748 hci_cs_auth_requested(hdev, ev->status);
2749 break;
2750
2751 case HCI_OP_SET_CONN_ENCRYPT:
2752 hci_cs_set_conn_encrypt(hdev, ev->status);
2753 break;
2754
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002755 case HCI_OP_REMOTE_NAME_REQ:
2756 hci_cs_remote_name_req(hdev, ev->status);
2757 break;
2758
Marcel Holtmann769be972008-07-14 20:13:49 +02002759 case HCI_OP_READ_REMOTE_FEATURES:
2760 hci_cs_read_remote_features(hdev, ev->status);
2761 break;
2762
2763 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2764 hci_cs_read_remote_ext_features(hdev, ev->status);
2765 break;
2766
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002767 case HCI_OP_SETUP_SYNC_CONN:
2768 hci_cs_setup_sync_conn(hdev, ev->status);
2769 break;
2770
2771 case HCI_OP_SNIFF_MODE:
2772 hci_cs_sniff_mode(hdev, ev->status);
2773 break;
2774
2775 case HCI_OP_EXIT_SNIFF_MODE:
2776 hci_cs_exit_sniff_mode(hdev, ev->status);
2777 break;
2778
Johan Hedberg8962ee72011-01-20 12:40:27 +02002779 case HCI_OP_DISCONNECT:
Johan Hedberg88c3df12012-02-09 14:27:38 +02002780 hci_cs_disconnect(hdev, ev->status);
Johan Hedberg8962ee72011-01-20 12:40:27 +02002781 break;
2782
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03002783 case HCI_OP_CREATE_PHY_LINK:
2784 hci_cs_create_phylink(hdev, ev->status);
2785 break;
2786
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03002787 case HCI_OP_ACCEPT_PHY_LINK:
2788 hci_cs_accept_phylink(hdev, ev->status);
2789 break;
2790
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02002791 case HCI_OP_LE_CREATE_CONN:
2792 hci_cs_le_create_conn(hdev, ev->status);
2793 break;
2794
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02002795 case HCI_OP_LE_START_ENC:
2796 hci_cs_le_start_enc(hdev, ev->status);
2797 break;
2798
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002799 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002800 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002801 break;
2802 }
2803
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002804 if (opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02002805 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02002806
Johan Hedberg02350a72013-04-03 21:50:29 +03002807 if (ev->status ||
2808 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
2809 hci_req_cmd_complete(hdev, opcode, ev->status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002810
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002811 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002812 atomic_set(&hdev->cmd_cnt, 1);
2813 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002814 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002815 }
2816}
2817
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002818static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002819{
2820 struct hci_ev_role_change *ev = (void *) skb->data;
2821 struct hci_conn *conn;
2822
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002823 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002824
2825 hci_dev_lock(hdev);
2826
2827 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2828 if (conn) {
2829 if (!ev->status) {
2830 if (ev->role)
2831 conn->link_mode &= ~HCI_LM_MASTER;
2832 else
2833 conn->link_mode |= HCI_LM_MASTER;
2834 }
2835
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002836 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002837
2838 hci_role_switch_cfm(conn, ev->status, ev->role);
2839 }
2840
2841 hci_dev_unlock(hdev);
2842}
2843
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002844static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002845{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002846 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002847 int i;
2848
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02002849 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2850 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2851 return;
2852 }
2853
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002854 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002855 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002856 BT_DBG("%s bad parameters", hdev->name);
2857 return;
2858 }
2859
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002860 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2861
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002862 for (i = 0; i < ev->num_hndl; i++) {
2863 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002864 struct hci_conn *conn;
2865 __u16 handle, count;
2866
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002867 handle = __le16_to_cpu(info->handle);
2868 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002869
2870 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002871 if (!conn)
2872 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002873
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002874 conn->sent -= count;
2875
2876 switch (conn->type) {
2877 case ACL_LINK:
2878 hdev->acl_cnt += count;
2879 if (hdev->acl_cnt > hdev->acl_pkts)
2880 hdev->acl_cnt = hdev->acl_pkts;
2881 break;
2882
2883 case LE_LINK:
2884 if (hdev->le_pkts) {
2885 hdev->le_cnt += count;
2886 if (hdev->le_cnt > hdev->le_pkts)
2887 hdev->le_cnt = hdev->le_pkts;
2888 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002889 hdev->acl_cnt += count;
2890 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002891 hdev->acl_cnt = hdev->acl_pkts;
2892 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002893 break;
2894
2895 case SCO_LINK:
2896 hdev->sco_cnt += count;
2897 if (hdev->sco_cnt > hdev->sco_pkts)
2898 hdev->sco_cnt = hdev->sco_pkts;
2899 break;
2900
2901 default:
2902 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2903 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002904 }
2905 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002906
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02002907 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002908}
2909
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002910static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
2911 __u16 handle)
2912{
2913 struct hci_chan *chan;
2914
2915 switch (hdev->dev_type) {
2916 case HCI_BREDR:
2917 return hci_conn_hash_lookup_handle(hdev, handle);
2918 case HCI_AMP:
2919 chan = hci_chan_lookup_handle(hdev, handle);
2920 if (chan)
2921 return chan->conn;
2922 break;
2923 default:
2924 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
2925 break;
2926 }
2927
2928 return NULL;
2929}
2930
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002931static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002932{
2933 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2934 int i;
2935
2936 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2937 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2938 return;
2939 }
2940
2941 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002942 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002943 BT_DBG("%s bad parameters", hdev->name);
2944 return;
2945 }
2946
2947 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002948 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002949
2950 for (i = 0; i < ev->num_hndl; i++) {
2951 struct hci_comp_blocks_info *info = &ev->handles[i];
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002952 struct hci_conn *conn = NULL;
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002953 __u16 handle, block_count;
2954
2955 handle = __le16_to_cpu(info->handle);
2956 block_count = __le16_to_cpu(info->blocks);
2957
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002958 conn = __hci_conn_lookup_handle(hdev, handle);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002959 if (!conn)
2960 continue;
2961
2962 conn->sent -= block_count;
2963
2964 switch (conn->type) {
2965 case ACL_LINK:
Andrei Emeltchenkobd1eb662012-10-10 17:38:30 +03002966 case AMP_LINK:
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002967 hdev->block_cnt += block_count;
2968 if (hdev->block_cnt > hdev->num_blocks)
2969 hdev->block_cnt = hdev->num_blocks;
2970 break;
2971
2972 default:
2973 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2974 break;
2975 }
2976 }
2977
2978 queue_work(hdev->workqueue, &hdev->tx_work);
2979}
2980
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002981static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002982{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002983 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002984 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002985
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002986 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002987
2988 hci_dev_lock(hdev);
2989
Marcel Holtmann04837f62006-07-03 10:02:33 +02002990 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2991 if (conn) {
2992 conn->mode = ev->mode;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002993
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002994 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2995 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02002996 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002997 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002998 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02002999 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003000 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003001
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003002 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003003 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003004 }
3005
3006 hci_dev_unlock(hdev);
3007}
3008
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003009static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003010{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003011 struct hci_ev_pin_code_req *ev = (void *) skb->data;
3012 struct hci_conn *conn;
3013
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003014 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003015
3016 hci_dev_lock(hdev);
3017
3018 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003019 if (!conn)
3020 goto unlock;
3021
3022 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003023 hci_conn_hold(conn);
3024 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003025 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003026 }
3027
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003028 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003029 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003030 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003031 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003032 u8 secure;
3033
3034 if (conn->pending_sec_level == BT_SECURITY_HIGH)
3035 secure = 1;
3036 else
3037 secure = 0;
3038
Johan Hedberg744cf192011-11-08 20:40:14 +02003039 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003040 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02003041
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003042unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003043 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003044}
3045
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003046static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003047{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003048 struct hci_ev_link_key_req *ev = (void *) skb->data;
3049 struct hci_cp_link_key_reply cp;
3050 struct hci_conn *conn;
3051 struct link_key *key;
3052
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003053 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003054
Andrei Emeltchenko034cbea2013-05-14 11:44:16 +03003055 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003056 return;
3057
3058 hci_dev_lock(hdev);
3059
3060 key = hci_find_link_key(hdev, &ev->bdaddr);
3061 if (!key) {
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003062 BT_DBG("%s link key not found for %pMR", hdev->name,
3063 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003064 goto not_found;
3065 }
3066
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003067 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
3068 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003069
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003070 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003071 if (conn) {
Marcel Holtmann66138ce2014-01-10 02:07:20 -08003072 if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
3073 key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003074 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003075 BT_DBG("%s ignoring unauthenticated key", hdev->name);
3076 goto not_found;
3077 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003078
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003079 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Johan Hedbergf3fb0b52014-06-02 10:12:44 +03003080 (conn->pending_sec_level == BT_SECURITY_HIGH ||
3081 conn->pending_sec_level == BT_SECURITY_FIPS)) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003082 BT_DBG("%s ignoring key unauthenticated for high security",
3083 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003084 goto not_found;
3085 }
3086
3087 conn->key_type = key->type;
3088 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003089 }
3090
3091 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03003092 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003093
3094 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
3095
3096 hci_dev_unlock(hdev);
3097
3098 return;
3099
3100not_found:
3101 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
3102 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003103}
3104
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003105static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003106{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003107 struct hci_ev_link_key_notify *ev = (void *) skb->data;
3108 struct hci_conn *conn;
Johan Hedberg7652ff62014-06-24 13:15:49 +03003109 struct link_key *key;
3110 bool persistent;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003111 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003112
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003113 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003114
3115 hci_dev_lock(hdev);
3116
3117 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3118 if (conn) {
3119 hci_conn_hold(conn);
3120 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02003121 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02003122
3123 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
3124 conn->key_type = ev->key_type;
3125
David Herrmann76a68ba2013-04-06 20:28:37 +02003126 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003127 }
3128
Johan Hedberg7652ff62014-06-24 13:15:49 +03003129 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
3130 goto unlock;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003131
Johan Hedberg7652ff62014-06-24 13:15:49 +03003132 key = hci_add_link_key(hdev, conn, &ev->bdaddr, ev->link_key,
3133 ev->key_type, pin_len, &persistent);
3134 if (!key)
3135 goto unlock;
3136
3137 mgmt_new_link_key(hdev, key, persistent);
3138
Johan Hedberg6d5650c2014-06-24 13:15:51 +03003139 /* Keep debug keys around only if the HCI_KEEP_DEBUG_KEYS flag
3140 * is set. If it's not set simply remove the key from the kernel
3141 * list (we've still notified user space about it but with
3142 * store_hint being 0).
3143 */
3144 if (key->type == HCI_LK_DEBUG_COMBINATION &&
3145 !test_bit(HCI_KEEP_DEBUG_KEYS, &hdev->dev_flags)) {
3146 list_del(&key->list);
3147 kfree(key);
3148 } else if (conn) {
Johan Hedbergaf6a9c32014-06-24 13:15:53 +03003149 if (persistent)
3150 clear_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3151 else
3152 set_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
Johan Hedberg6d5650c2014-06-24 13:15:51 +03003153 }
Johan Hedberg7652ff62014-06-24 13:15:49 +03003154
3155unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003156 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003157}
3158
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003159static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02003160{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003161 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003162 struct hci_conn *conn;
3163
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003164 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003165
3166 hci_dev_lock(hdev);
3167
3168 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003169 if (conn && !ev->status) {
3170 struct inquiry_entry *ie;
3171
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003172 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3173 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003174 ie->data.clock_offset = ev->clock_offset;
3175 ie->timestamp = jiffies;
3176 }
3177 }
3178
3179 hci_dev_unlock(hdev);
3180}
3181
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003182static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02003183{
3184 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
3185 struct hci_conn *conn;
3186
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003187 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02003188
3189 hci_dev_lock(hdev);
3190
3191 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3192 if (conn && !ev->status)
3193 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
3194
3195 hci_dev_unlock(hdev);
3196}
3197
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003198static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003199{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003200 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003201 struct inquiry_entry *ie;
3202
3203 BT_DBG("%s", hdev->name);
3204
3205 hci_dev_lock(hdev);
3206
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003207 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3208 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003209 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
3210 ie->timestamp = jiffies;
3211 }
3212
3213 hci_dev_unlock(hdev);
3214}
3215
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003216static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
3217 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003218{
3219 struct inquiry_data data;
3220 int num_rsp = *((__u8 *) skb->data);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003221 bool name_known, ssp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003222
3223 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3224
3225 if (!num_rsp)
3226 return;
3227
Andre Guedes1519cc12012-03-21 00:03:38 -03003228 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3229 return;
3230
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003231 hci_dev_lock(hdev);
3232
3233 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01003234 struct inquiry_info_with_rssi_and_pscan_mode *info;
3235 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003236
Johan Hedberge17acd42011-03-30 23:57:16 +03003237 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003238 bacpy(&data.bdaddr, &info->bdaddr);
3239 data.pscan_rep_mode = info->pscan_rep_mode;
3240 data.pscan_period_mode = info->pscan_period_mode;
3241 data.pscan_mode = info->pscan_mode;
3242 memcpy(data.dev_class, info->dev_class, 3);
3243 data.clock_offset = info->clock_offset;
3244 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003245 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02003246
3247 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003248 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02003249 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003250 info->dev_class, info->rssi,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02003251 !name_known, ssp, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003252 }
3253 } else {
3254 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
3255
Johan Hedberge17acd42011-03-30 23:57:16 +03003256 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003257 bacpy(&data.bdaddr, &info->bdaddr);
3258 data.pscan_rep_mode = info->pscan_rep_mode;
3259 data.pscan_period_mode = info->pscan_period_mode;
3260 data.pscan_mode = 0x00;
3261 memcpy(data.dev_class, info->dev_class, 3);
3262 data.clock_offset = info->clock_offset;
3263 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003264 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02003265 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003266 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02003267 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003268 info->dev_class, info->rssi,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02003269 !name_known, ssp, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003270 }
3271 }
3272
3273 hci_dev_unlock(hdev);
3274}
3275
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003276static void hci_remote_ext_features_evt(struct hci_dev *hdev,
3277 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003278{
Marcel Holtmann41a96212008-07-14 20:13:48 +02003279 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
3280 struct hci_conn *conn;
3281
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003282 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003283
Marcel Holtmann41a96212008-07-14 20:13:48 +02003284 hci_dev_lock(hdev);
3285
3286 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02003287 if (!conn)
3288 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003289
Johan Hedbergcad718e2013-04-17 15:00:51 +03003290 if (ev->page < HCI_MAX_PAGES)
3291 memcpy(conn->features[ev->page], ev->features, 8);
3292
Johan Hedbergccd556f2010-11-10 17:11:51 +02003293 if (!ev->status && ev->page == 0x01) {
3294 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003295
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003296 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3297 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003298 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02003299
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303300 if (ev->features[0] & LMP_HOST_SSP) {
Johan Hedberg58a681e2012-01-16 06:47:28 +02003301 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303302 } else {
3303 /* It is mandatory by the Bluetooth specification that
3304 * Extended Inquiry Results are only used when Secure
3305 * Simple Pairing is enabled, but some devices violate
3306 * this.
3307 *
3308 * To make these devices work, the internal SSP
3309 * enabled flag needs to be cleared if the remote host
3310 * features do not indicate SSP support */
3311 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
3312 }
Marcel Holtmanneb9a8f32014-01-15 22:37:38 -08003313
3314 if (ev->features[0] & LMP_HOST_SC)
3315 set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003316 }
3317
Johan Hedbergccd556f2010-11-10 17:11:51 +02003318 if (conn->state != BT_CONFIG)
3319 goto unlock;
3320
Johan Hedberg671267b2012-05-12 16:11:50 -03003321 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02003322 struct hci_cp_remote_name_req cp;
3323 memset(&cp, 0, sizeof(cp));
3324 bacpy(&cp.bdaddr, &conn->dst);
3325 cp.pscan_rep_mode = 0x02;
3326 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003327 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3328 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003329 conn->dst_type, 0, NULL, 0,
3330 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02003331
Johan Hedberg127178d2010-11-18 22:22:29 +02003332 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02003333 conn->state = BT_CONNECTED;
3334 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003335 hci_conn_drop(conn);
Johan Hedbergccd556f2010-11-10 17:11:51 +02003336 }
3337
3338unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02003339 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003340}
3341
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003342static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3343 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003344{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003345 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3346 struct hci_conn *conn;
3347
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003348 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003349
3350 hci_dev_lock(hdev);
3351
3352 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003353 if (!conn) {
3354 if (ev->link_type == ESCO_LINK)
3355 goto unlock;
3356
3357 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3358 if (!conn)
3359 goto unlock;
3360
3361 conn->type = SCO_LINK;
3362 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003363
Marcel Holtmann732547f2009-04-19 19:14:14 +02003364 switch (ev->status) {
3365 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003366 conn->handle = __le16_to_cpu(ev->handle);
3367 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003368
3369 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02003370 break;
3371
Frédéric Dalleau1a4c9582013-08-19 14:24:02 +02003372 case 0x0d: /* Connection Rejected due to Limited Resources */
Stephen Coe705e5712010-02-16 11:29:44 -05003373 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003374 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08003375 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003376 case 0x1f: /* Unspecified error */
Andrew Earl27539bc2014-03-10 10:31:04 +00003377 case 0x20: /* Unsupported LMP Parameter value */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003378 if (conn->out) {
Marcel Holtmann732547f2009-04-19 19:14:14 +02003379 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3380 (hdev->esco_type & EDR_ESCO_MASK);
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003381 if (hci_setup_sync(conn, conn->link->handle))
3382 goto unlock;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003383 }
3384 /* fall through */
3385
3386 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003387 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003388 break;
3389 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003390
3391 hci_proto_connect_cfm(conn, ev->status);
3392 if (ev->status)
3393 hci_conn_del(conn);
3394
3395unlock:
3396 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003397}
3398
Marcel Holtmannefdcf8e2013-10-15 10:31:12 -07003399static inline size_t eir_get_length(u8 *eir, size_t eir_len)
3400{
3401 size_t parsed = 0;
3402
3403 while (parsed < eir_len) {
3404 u8 field_len = eir[0];
3405
3406 if (field_len == 0)
3407 return parsed;
3408
3409 parsed += field_len + 1;
3410 eir += field_len + 1;
3411 }
3412
3413 return eir_len;
3414}
3415
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003416static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3417 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003418{
3419 struct inquiry_data data;
3420 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3421 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303422 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003423
3424 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3425
3426 if (!num_rsp)
3427 return;
3428
Andre Guedes1519cc12012-03-21 00:03:38 -03003429 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3430 return;
3431
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003432 hci_dev_lock(hdev);
3433
Johan Hedberge17acd42011-03-30 23:57:16 +03003434 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003435 bool name_known, ssp;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003436
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003437 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01003438 data.pscan_rep_mode = info->pscan_rep_mode;
3439 data.pscan_period_mode = info->pscan_period_mode;
3440 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003441 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01003442 data.clock_offset = info->clock_offset;
3443 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003444 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003445
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003446 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02003447 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003448 sizeof(info->data),
3449 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02003450 else
3451 name_known = true;
3452
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003453 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003454 &ssp);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303455 eir_len = eir_get_length(info->data, sizeof(info->data));
Johan Hedberg48264f02011-11-09 13:58:58 +02003456 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003457 info->dev_class, info->rssi, !name_known,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02003458 ssp, info->data, eir_len, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003459 }
3460
3461 hci_dev_unlock(hdev);
3462}
3463
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003464static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3465 struct sk_buff *skb)
3466{
3467 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3468 struct hci_conn *conn;
3469
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003470 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003471 __le16_to_cpu(ev->handle));
3472
3473 hci_dev_lock(hdev);
3474
3475 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3476 if (!conn)
3477 goto unlock;
3478
Johan Hedberg9eb1fbf2014-04-11 12:02:31 -07003479 /* For BR/EDR the necessary steps are taken through the
3480 * auth_complete event.
3481 */
3482 if (conn->type != LE_LINK)
3483 goto unlock;
3484
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003485 if (!ev->status)
3486 conn->sec_level = conn->pending_sec_level;
3487
3488 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3489
3490 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03003491 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02003492 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003493 goto unlock;
3494 }
3495
3496 if (conn->state == BT_CONFIG) {
3497 if (!ev->status)
3498 conn->state = BT_CONNECTED;
3499
3500 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003501 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003502 } else {
3503 hci_auth_cfm(conn, ev->status);
3504
3505 hci_conn_hold(conn);
3506 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003507 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003508 }
3509
3510unlock:
3511 hci_dev_unlock(hdev);
3512}
3513
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003514static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003515{
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003516 /* If remote requests no-bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02003517 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3518 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003519 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003520
Mikel Astizb7f94c82014-04-08 14:21:31 +02003521 /* If both remote and local have enough IO capabilities, require
3522 * MITM protection
3523 */
3524 if (conn->remote_cap != HCI_IO_NO_INPUT_OUTPUT &&
3525 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT)
3526 return conn->remote_auth | 0x01;
3527
Timo Mueller7e741702014-04-08 14:21:33 +02003528 /* No MITM protection possible so ignore remote requirement */
3529 return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003530}
3531
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003532static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003533{
3534 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3535 struct hci_conn *conn;
3536
3537 BT_DBG("%s", hdev->name);
3538
3539 hci_dev_lock(hdev);
3540
3541 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003542 if (!conn)
3543 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003544
Johan Hedberg03b555e2011-01-04 15:40:05 +02003545 hci_conn_hold(conn);
3546
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003547 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003548 goto unlock;
3549
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003550 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003551 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003552 struct hci_cp_io_capability_reply cp;
3553
3554 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303555 /* Change the IO capability from KeyboardDisplay
3556 * to DisplayYesNo as it is not supported by BT spec. */
3557 cp.capability = (conn->io_capability == 0x04) ?
Mikel Astiza7676312013-06-28 10:56:29 +02003558 HCI_IO_DISPLAY_YESNO : conn->io_capability;
Mikel Astizb7f94c82014-04-08 14:21:31 +02003559
3560 /* If we are initiators, there is no remote information yet */
3561 if (conn->remote_auth == 0xff) {
3562 cp.authentication = conn->auth_type;
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003563
Mikel Astizb16c6602014-04-08 14:21:34 +02003564 /* Request MITM protection if our IO caps allow it
Johan Hedberg4ad51a72014-06-09 14:41:25 +03003565 * except for the no-bonding case.
3566 * conn->auth_type is not updated here since
3567 * that might cause the user confirmation to be
3568 * rejected in case the remote doesn't have the
3569 * IO capabilities for MITM.
Mikel Astizb16c6602014-04-08 14:21:34 +02003570 */
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003571 if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
Mikel Astizb16c6602014-04-08 14:21:34 +02003572 cp.authentication != HCI_AT_NO_BONDING)
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003573 cp.authentication |= 0x01;
Mikel Astizb7f94c82014-04-08 14:21:31 +02003574 } else {
3575 conn->auth_type = hci_get_auth_req(conn);
3576 cp.authentication = conn->auth_type;
3577 }
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003578
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003579 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3580 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
Szymon Jancce85ee12011-03-22 13:12:23 +01003581 cp.oob_data = 0x01;
3582 else
3583 cp.oob_data = 0x00;
3584
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003585 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003586 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003587 } else {
3588 struct hci_cp_io_capability_neg_reply cp;
3589
3590 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02003591 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003592
3593 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003594 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003595 }
3596
3597unlock:
3598 hci_dev_unlock(hdev);
3599}
3600
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003601static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02003602{
3603 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3604 struct hci_conn *conn;
3605
3606 BT_DBG("%s", hdev->name);
3607
3608 hci_dev_lock(hdev);
3609
3610 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3611 if (!conn)
3612 goto unlock;
3613
Johan Hedberg03b555e2011-01-04 15:40:05 +02003614 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003615 conn->remote_auth = ev->authentication;
Johan Hedberg58a681e2012-01-16 06:47:28 +02003616 if (ev->oob_data)
3617 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003618
3619unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003620 hci_dev_unlock(hdev);
3621}
3622
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003623static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3624 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003625{
3626 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003627 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07003628 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03003629
3630 BT_DBG("%s", hdev->name);
3631
3632 hci_dev_lock(hdev);
3633
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003634 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg7a828902011-04-28 11:28:53 -07003635 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03003636
Johan Hedberg7a828902011-04-28 11:28:53 -07003637 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3638 if (!conn)
3639 goto unlock;
3640
3641 loc_mitm = (conn->auth_type & 0x01);
3642 rem_mitm = (conn->remote_auth & 0x01);
3643
3644 /* If we require MITM but the remote device can't provide that
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003645 * (it has NoInputNoOutput) then reject the confirmation request
3646 */
3647 if (loc_mitm && conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
Johan Hedberg7a828902011-04-28 11:28:53 -07003648 BT_DBG("Rejecting request: remote device can't provide MITM");
3649 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003650 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003651 goto unlock;
3652 }
3653
3654 /* If no side requires MITM protection; auto-accept */
Mikel Astiza7676312013-06-28 10:56:29 +02003655 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
3656 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003657
3658 /* If we're not the initiators request authorization to
3659 * proceed from user space (mgmt_user_confirm with
Johan Hedbergba15a582014-06-09 13:58:14 +03003660 * confirm_hint set to 1). The exception is if neither
3661 * side had MITM in which case we do auto-accept.
3662 */
3663 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
3664 (loc_mitm || rem_mitm)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003665 BT_DBG("Confirming auto-accept as acceptor");
3666 confirm_hint = 1;
3667 goto confirm;
3668 }
3669
Johan Hedberg9f616562011-04-28 11:28:54 -07003670 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03003671 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003672
3673 if (hdev->auto_accept_delay > 0) {
3674 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
Johan Hedberg7bc18d92013-10-16 18:11:39 +03003675 queue_delayed_work(conn->hdev->workqueue,
3676 &conn->auto_accept_work, delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003677 goto unlock;
3678 }
3679
Johan Hedberg7a828902011-04-28 11:28:53 -07003680 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003681 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003682 goto unlock;
3683 }
3684
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003685confirm:
Johan Hedberg39adbff2014-03-20 08:18:14 +02003686 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
3687 le32_to_cpu(ev->passkey), confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07003688
3689unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03003690 hci_dev_unlock(hdev);
3691}
3692
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003693static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3694 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08003695{
3696 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3697
3698 BT_DBG("%s", hdev->name);
3699
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003700 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02003701 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08003702}
3703
Johan Hedberg92a25252012-09-06 18:39:26 +03003704static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3705 struct sk_buff *skb)
3706{
3707 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3708 struct hci_conn *conn;
3709
3710 BT_DBG("%s", hdev->name);
3711
3712 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3713 if (!conn)
3714 return;
3715
3716 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3717 conn->passkey_entered = 0;
3718
3719 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3720 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3721 conn->dst_type, conn->passkey_notify,
3722 conn->passkey_entered);
3723}
3724
3725static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3726{
3727 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3728 struct hci_conn *conn;
3729
3730 BT_DBG("%s", hdev->name);
3731
3732 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3733 if (!conn)
3734 return;
3735
3736 switch (ev->type) {
3737 case HCI_KEYPRESS_STARTED:
3738 conn->passkey_entered = 0;
3739 return;
3740
3741 case HCI_KEYPRESS_ENTERED:
3742 conn->passkey_entered++;
3743 break;
3744
3745 case HCI_KEYPRESS_ERASED:
3746 conn->passkey_entered--;
3747 break;
3748
3749 case HCI_KEYPRESS_CLEARED:
3750 conn->passkey_entered = 0;
3751 break;
3752
3753 case HCI_KEYPRESS_COMPLETED:
3754 return;
3755 }
3756
3757 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3758 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3759 conn->dst_type, conn->passkey_notify,
3760 conn->passkey_entered);
3761}
3762
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003763static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3764 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003765{
3766 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3767 struct hci_conn *conn;
3768
3769 BT_DBG("%s", hdev->name);
3770
3771 hci_dev_lock(hdev);
3772
3773 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003774 if (!conn)
3775 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003776
Johan Hedberg2a611692011-02-19 12:06:00 -03003777 /* To avoid duplicate auth_failed events to user space we check
3778 * the HCI_CONN_AUTH_PEND flag which will be set if we
3779 * initiated the authentication. A traditional auth_complete
3780 * event gets always produced as initiator and is also mapped to
3781 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02003782 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003783 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003784 ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003785
David Herrmann76a68ba2013-04-06 20:28:37 +02003786 hci_conn_drop(conn);
Johan Hedberg2a611692011-02-19 12:06:00 -03003787
3788unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003789 hci_dev_unlock(hdev);
3790}
3791
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003792static void hci_remote_host_features_evt(struct hci_dev *hdev,
3793 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003794{
3795 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3796 struct inquiry_entry *ie;
Johan Hedbergcad718e2013-04-17 15:00:51 +03003797 struct hci_conn *conn;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003798
3799 BT_DBG("%s", hdev->name);
3800
3801 hci_dev_lock(hdev);
3802
Johan Hedbergcad718e2013-04-17 15:00:51 +03003803 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3804 if (conn)
3805 memcpy(conn->features[1], ev->features, 8);
3806
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003807 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3808 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003809 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003810
3811 hci_dev_unlock(hdev);
3812}
3813
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003814static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3815 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01003816{
3817 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3818 struct oob_data *data;
3819
3820 BT_DBG("%s", hdev->name);
3821
3822 hci_dev_lock(hdev);
3823
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003824 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Szymon Jance1ba1f12011-04-06 13:01:59 +02003825 goto unlock;
3826
Szymon Janc2763eda2011-03-22 13:12:22 +01003827 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3828 if (data) {
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003829 if (test_bit(HCI_SC_ENABLED, &hdev->dev_flags)) {
3830 struct hci_cp_remote_oob_ext_data_reply cp;
Szymon Janc2763eda2011-03-22 13:12:22 +01003831
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003832 bacpy(&cp.bdaddr, &ev->bdaddr);
3833 memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
3834 memcpy(cp.randomizer192, data->randomizer192,
3835 sizeof(cp.randomizer192));
3836 memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
3837 memcpy(cp.randomizer256, data->randomizer256,
3838 sizeof(cp.randomizer256));
Szymon Janc2763eda2011-03-22 13:12:22 +01003839
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003840 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
3841 sizeof(cp), &cp);
3842 } else {
3843 struct hci_cp_remote_oob_data_reply cp;
3844
3845 bacpy(&cp.bdaddr, &ev->bdaddr);
3846 memcpy(cp.hash, data->hash192, sizeof(cp.hash));
3847 memcpy(cp.randomizer, data->randomizer192,
3848 sizeof(cp.randomizer));
3849
3850 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
3851 sizeof(cp), &cp);
3852 }
Szymon Janc2763eda2011-03-22 13:12:22 +01003853 } else {
3854 struct hci_cp_remote_oob_data_neg_reply cp;
3855
3856 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003857 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
3858 sizeof(cp), &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003859 }
3860
Szymon Jance1ba1f12011-04-06 13:01:59 +02003861unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003862 hci_dev_unlock(hdev);
3863}
3864
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003865static void hci_phy_link_complete_evt(struct hci_dev *hdev,
3866 struct sk_buff *skb)
3867{
3868 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
3869 struct hci_conn *hcon, *bredr_hcon;
3870
3871 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
3872 ev->status);
3873
3874 hci_dev_lock(hdev);
3875
3876 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3877 if (!hcon) {
3878 hci_dev_unlock(hdev);
3879 return;
3880 }
3881
3882 if (ev->status) {
3883 hci_conn_del(hcon);
3884 hci_dev_unlock(hdev);
3885 return;
3886 }
3887
3888 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
3889
3890 hcon->state = BT_CONNECTED;
3891 bacpy(&hcon->dst, &bredr_hcon->dst);
3892
3893 hci_conn_hold(hcon);
3894 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003895 hci_conn_drop(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003896
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003897 hci_conn_add_sysfs(hcon);
3898
Andrei Emeltchenkocf70ff22012-10-31 15:46:36 +02003899 amp_physical_cfm(bredr_hcon, hcon);
3900
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003901 hci_dev_unlock(hdev);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003902}
3903
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003904static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3905{
3906 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
3907 struct hci_conn *hcon;
3908 struct hci_chan *hchan;
3909 struct amp_mgr *mgr;
3910
3911 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
3912 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
3913 ev->status);
3914
3915 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3916 if (!hcon)
3917 return;
3918
3919 /* Create AMP hchan */
3920 hchan = hci_chan_create(hcon);
3921 if (!hchan)
3922 return;
3923
3924 hchan->handle = le16_to_cpu(ev->handle);
3925
3926 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
3927
3928 mgr = hcon->amp_mgr;
3929 if (mgr && mgr->bredr_chan) {
3930 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
3931
3932 l2cap_chan_lock(bredr_chan);
3933
3934 bredr_chan->conn->mtu = hdev->block_mtu;
3935 l2cap_logical_cfm(bredr_chan, hchan, 0);
3936 hci_conn_hold(hcon);
3937
3938 l2cap_chan_unlock(bredr_chan);
3939 }
3940}
3941
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003942static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
3943 struct sk_buff *skb)
3944{
3945 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
3946 struct hci_chan *hchan;
3947
3948 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
3949 le16_to_cpu(ev->handle), ev->status);
3950
3951 if (ev->status)
3952 return;
3953
3954 hci_dev_lock(hdev);
3955
3956 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
3957 if (!hchan)
3958 goto unlock;
3959
3960 amp_destroy_logical_link(hchan, ev->reason);
3961
3962unlock:
3963 hci_dev_unlock(hdev);
3964}
3965
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003966static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
3967 struct sk_buff *skb)
3968{
3969 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
3970 struct hci_conn *hcon;
3971
3972 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3973
3974 if (ev->status)
3975 return;
3976
3977 hci_dev_lock(hdev);
3978
3979 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3980 if (hcon) {
3981 hcon->state = BT_CLOSED;
3982 hci_conn_del(hcon);
3983 }
3984
3985 hci_dev_unlock(hdev);
3986}
3987
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003988static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003989{
3990 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3991 struct hci_conn *conn;
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02003992 struct smp_irk *irk;
Ville Tervofcd89c02011-02-10 22:38:47 -03003993
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003994 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003995
3996 hci_dev_lock(hdev);
3997
Andre Guedesb47a09b2012-07-27 15:10:15 -03003998 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03003999 if (!conn) {
4000 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
4001 if (!conn) {
4002 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03004003 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03004004 }
Andre Guedes29b79882011-05-31 14:20:54 -03004005
4006 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03004007
4008 if (ev->role == LE_CONN_ROLE_MASTER) {
4009 conn->out = true;
4010 conn->link_mode |= HCI_LM_MASTER;
4011 }
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004012
4013 /* If we didn't have a hci_conn object previously
4014 * but we're in master role this must be something
4015 * initiated using a white list. Since white list based
4016 * connections are not "first class citizens" we don't
4017 * have full tracking of them. Therefore, we go ahead
4018 * with a "best effort" approach of determining the
4019 * initiator address based on the HCI_PRIVACY flag.
4020 */
4021 if (conn->out) {
4022 conn->resp_addr_type = ev->bdaddr_type;
4023 bacpy(&conn->resp_addr, &ev->bdaddr);
4024 if (test_bit(HCI_PRIVACY, &hdev->dev_flags)) {
4025 conn->init_addr_type = ADDR_LE_DEV_RANDOM;
4026 bacpy(&conn->init_addr, &hdev->rpa);
4027 } else {
4028 hci_copy_identity_address(hdev,
4029 &conn->init_addr,
4030 &conn->init_addr_type);
4031 }
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004032 }
Johan Hedberg9489eca2014-02-28 17:45:46 +02004033 } else {
4034 cancel_delayed_work(&conn->le_conn_timeout);
Ville Tervob62f3282011-02-10 22:38:50 -03004035 }
Ville Tervofcd89c02011-02-10 22:38:47 -03004036
Johan Hedberg80c24ab2014-03-24 20:21:51 +02004037 if (!conn->out) {
4038 /* Set the responder (our side) address type based on
4039 * the advertising address type.
4040 */
4041 conn->resp_addr_type = hdev->adv_addr_type;
4042 if (hdev->adv_addr_type == ADDR_LE_DEV_RANDOM)
4043 bacpy(&conn->resp_addr, &hdev->random_addr);
4044 else
4045 bacpy(&conn->resp_addr, &hdev->bdaddr);
4046
4047 conn->init_addr_type = ev->bdaddr_type;
4048 bacpy(&conn->init_addr, &ev->bdaddr);
Marcel Holtmanna720d732014-06-23 12:14:51 +02004049
4050 /* For incoming connections, set the default minimum
4051 * and maximum connection interval. They will be used
4052 * to check if the parameters are in range and if not
4053 * trigger the connection update procedure.
4054 */
4055 conn->le_conn_min_interval = hdev->le_conn_min_interval;
4056 conn->le_conn_max_interval = hdev->le_conn_max_interval;
Johan Hedberg80c24ab2014-03-24 20:21:51 +02004057 }
Johan Hedberg7be2edb2014-02-23 19:42:17 +02004058
Marcel Holtmannedb4b462014-02-18 15:13:43 -08004059 /* Lookup the identity address from the stored connection
4060 * address and address type.
4061 *
4062 * When establishing connections to an identity address, the
4063 * connection procedure will store the resolvable random
4064 * address first. Now if it can be converted back into the
4065 * identity address, start using the identity address from
4066 * now on.
4067 */
4068 irk = hci_get_irk(hdev, &conn->dst, conn->dst_type);
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02004069 if (irk) {
4070 bacpy(&conn->dst, &irk->bdaddr);
4071 conn->dst_type = irk->addr_type;
4072 }
4073
Andre Guedescd17dec2012-07-27 15:10:16 -03004074 if (ev->status) {
Andre Guedes06c053f2014-02-26 20:21:41 -03004075 hci_le_conn_failed(conn, ev->status);
Andre Guedescd17dec2012-07-27 15:10:16 -03004076 goto unlock;
4077 }
4078
Johan Hedbergb644ba32012-01-17 21:48:47 +02004079 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Marcel Holtmann01fdb0f2014-02-18 14:22:19 -08004080 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03004081 conn->dst_type, 0, NULL, 0, NULL);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03004082
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03004083 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03004084 conn->handle = __le16_to_cpu(ev->handle);
4085 conn->state = BT_CONNECTED;
4086
Marcel Holtmanne04fde62014-06-23 11:40:04 +02004087 conn->le_conn_interval = le16_to_cpu(ev->interval);
4088 conn->le_conn_latency = le16_to_cpu(ev->latency);
4089 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4090
Ville Tervofcd89c02011-02-10 22:38:47 -03004091 hci_conn_add_sysfs(conn);
4092
4093 hci_proto_connect_cfm(conn, ev->status);
4094
Andre Guedesa4790db2014-02-26 20:21:47 -03004095 hci_pend_le_conn_del(hdev, &conn->dst, conn->dst_type);
4096
Ville Tervofcd89c02011-02-10 22:38:47 -03004097unlock:
4098 hci_dev_unlock(hdev);
4099}
4100
Marcel Holtmann1855d922014-06-23 11:40:05 +02004101static void hci_le_conn_update_complete_evt(struct hci_dev *hdev,
4102 struct sk_buff *skb)
4103{
4104 struct hci_ev_le_conn_update_complete *ev = (void *) skb->data;
4105 struct hci_conn *conn;
4106
4107 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4108
4109 if (ev->status)
4110 return;
4111
4112 hci_dev_lock(hdev);
4113
4114 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4115 if (conn) {
4116 conn->le_conn_interval = le16_to_cpu(ev->interval);
4117 conn->le_conn_latency = le16_to_cpu(ev->latency);
4118 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4119 }
4120
4121 hci_dev_unlock(hdev);
4122}
4123
Andre Guedesa4790db2014-02-26 20:21:47 -03004124/* This function requires the caller holds hdev->lock */
4125static void check_pending_le_conn(struct hci_dev *hdev, bdaddr_t *addr,
4126 u8 addr_type)
4127{
4128 struct hci_conn *conn;
Andre Guedes5b906a82014-02-26 20:21:53 -03004129 struct smp_irk *irk;
4130
4131 /* If this is a resolvable address, we should resolve it and then
4132 * update address and address type variables.
4133 */
4134 irk = hci_get_irk(hdev, addr, addr_type);
4135 if (irk) {
4136 addr = &irk->bdaddr;
4137 addr_type = irk->addr_type;
4138 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004139
4140 if (!hci_pend_le_conn_lookup(hdev, addr, addr_type))
4141 return;
4142
4143 conn = hci_connect_le(hdev, addr, addr_type, BT_SECURITY_LOW,
4144 HCI_AT_NO_BONDING);
4145 if (!IS_ERR(conn))
4146 return;
4147
4148 switch (PTR_ERR(conn)) {
4149 case -EBUSY:
4150 /* If hci_connect() returns -EBUSY it means there is already
4151 * an LE connection attempt going on. Since controllers don't
4152 * support more than one connection attempt at the time, we
4153 * don't consider this an error case.
4154 */
4155 break;
4156 default:
4157 BT_DBG("Failed to connect: err %ld", PTR_ERR(conn));
4158 }
4159}
4160
Johan Hedberg4af605d2014-03-24 10:48:00 +02004161static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
4162 u8 bdaddr_type, s8 rssi, u8 *data, u8 len)
4163{
Johan Hedbergb9a63282014-03-25 10:51:52 +02004164 struct discovery_state *d = &hdev->discovery;
Johan Hedberg474ee062014-03-25 14:34:59 +02004165 bool match;
Johan Hedbergb9a63282014-03-25 10:51:52 +02004166
Johan Hedbergca5c4be2014-03-25 10:30:46 +02004167 /* Passive scanning shouldn't trigger any device found events */
4168 if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
4169 if (type == LE_ADV_IND || type == LE_ADV_DIRECT_IND)
4170 check_pending_le_conn(hdev, bdaddr, bdaddr_type);
4171 return;
4172 }
Johan Hedberg4af605d2014-03-24 10:48:00 +02004173
Johan Hedbergb9a63282014-03-25 10:51:52 +02004174 /* If there's nothing pending either store the data from this
4175 * event or send an immediate device found event if the data
4176 * should not be stored for later.
4177 */
4178 if (!has_pending_adv_report(hdev)) {
4179 /* If the report will trigger a SCAN_REQ store it for
4180 * later merging.
4181 */
4182 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4183 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004184 rssi, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004185 return;
4186 }
4187
4188 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4189 rssi, 0, 1, data, len, NULL, 0);
4190 return;
4191 }
4192
Johan Hedberg474ee062014-03-25 14:34:59 +02004193 /* Check if the pending report is for the same device as the new one */
4194 match = (!bacmp(bdaddr, &d->last_adv_addr) &&
4195 bdaddr_type == d->last_adv_addr_type);
4196
Johan Hedbergb9a63282014-03-25 10:51:52 +02004197 /* If the pending data doesn't match this report or this isn't a
4198 * scan response (e.g. we got a duplicate ADV_IND) then force
4199 * sending of the pending data.
4200 */
Johan Hedberg474ee062014-03-25 14:34:59 +02004201 if (type != LE_ADV_SCAN_RSP || !match) {
4202 /* Send out whatever is in the cache, but skip duplicates */
4203 if (!match)
4204 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004205 d->last_adv_addr_type, NULL,
4206 d->last_adv_rssi, 0, 1,
4207 d->last_adv_data,
Johan Hedberg474ee062014-03-25 14:34:59 +02004208 d->last_adv_data_len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004209
4210 /* If the new report will trigger a SCAN_REQ store it for
4211 * later merging.
4212 */
4213 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4214 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004215 rssi, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004216 return;
4217 }
4218
4219 /* The advertising reports cannot be merged, so clear
4220 * the pending report and send out a device found event.
4221 */
4222 clear_pending_adv_report(hdev);
Johan Hedberg5c5b93e2014-03-29 08:39:53 +02004223 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4224 rssi, 0, 1, data, len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004225 return;
4226 }
4227
4228 /* If we get here we've got a pending ADV_IND or ADV_SCAN_IND and
4229 * the new event is a SCAN_RSP. We can therefore proceed with
4230 * sending a merged device found event.
4231 */
4232 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
4233 d->last_adv_addr_type, NULL, rssi, 0, 1, data, len,
4234 d->last_adv_data, d->last_adv_data_len);
4235 clear_pending_adv_report(hdev);
Johan Hedberg4af605d2014-03-24 10:48:00 +02004236}
4237
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004238static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03004239{
Andre Guedese95beb42011-09-26 20:48:35 -03004240 u8 num_reports = skb->data[0];
4241 void *ptr = &skb->data[1];
Andre Guedes9aa04c92011-05-26 16:23:51 -03004242
Andre Guedesa4790db2014-02-26 20:21:47 -03004243 hci_dev_lock(hdev);
4244
Andre Guedese95beb42011-09-26 20:48:35 -03004245 while (num_reports--) {
4246 struct hci_ev_le_advertising_info *ev = ptr;
Johan Hedberg4af605d2014-03-24 10:48:00 +02004247 s8 rssi;
Andre Guedesa4790db2014-02-26 20:21:47 -03004248
Andre Guedes3c9e9192012-01-10 18:20:50 -03004249 rssi = ev->data[ev->length];
Johan Hedberg4af605d2014-03-24 10:48:00 +02004250 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
4251 ev->bdaddr_type, rssi, ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03004252
Andre Guedese95beb42011-09-26 20:48:35 -03004253 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03004254 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004255
4256 hci_dev_unlock(hdev);
Andre Guedes9aa04c92011-05-26 16:23:51 -03004257}
4258
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004259static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004260{
4261 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
4262 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004263 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004264 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004265 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004266
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03004267 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004268
4269 hci_dev_lock(hdev);
4270
4271 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004272 if (conn == NULL)
4273 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004274
Marcel Holtmannfe39c7b2014-02-27 16:00:28 -08004275 ltk = hci_find_ltk(hdev, ev->ediv, ev->rand, conn->out);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004276 if (ltk == NULL)
4277 goto not_found;
4278
4279 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004280 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004281
4282 if (ltk->authenticated)
Andre Guedesf8776212013-07-31 16:25:28 -03004283 conn->pending_sec_level = BT_SECURITY_HIGH;
4284 else
4285 conn->pending_sec_level = BT_SECURITY_MEDIUM;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004286
Andre Guedes89cbb4d2013-07-31 16:25:29 -03004287 conn->enc_key_size = ltk->enc_size;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004288
4289 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
4290
Claudio Takahasi5981a882013-07-25 16:34:24 -03004291 /* Ref. Bluetooth Core SPEC pages 1975 and 2004. STK is a
4292 * temporary key used to encrypt a connection following
4293 * pairing. It is used during the Encrypted Session Setup to
4294 * distribute the keys. Later, security can be re-established
4295 * using a distributed LTK.
4296 */
Johan Hedberg2ceba532014-06-16 19:25:16 +03004297 if (ltk->type == SMP_STK) {
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004298 list_del(&ltk->list);
4299 kfree(ltk);
4300 }
4301
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004302 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004303
4304 return;
4305
4306not_found:
4307 neg.handle = ev->handle;
4308 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
4309 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004310}
4311
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004312static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03004313{
4314 struct hci_ev_le_meta *le_ev = (void *) skb->data;
4315
4316 skb_pull(skb, sizeof(*le_ev));
4317
4318 switch (le_ev->subevent) {
4319 case HCI_EV_LE_CONN_COMPLETE:
4320 hci_le_conn_complete_evt(hdev, skb);
4321 break;
4322
Marcel Holtmann1855d922014-06-23 11:40:05 +02004323 case HCI_EV_LE_CONN_UPDATE_COMPLETE:
4324 hci_le_conn_update_complete_evt(hdev, skb);
4325 break;
4326
Andre Guedes9aa04c92011-05-26 16:23:51 -03004327 case HCI_EV_LE_ADVERTISING_REPORT:
4328 hci_le_adv_report_evt(hdev, skb);
4329 break;
4330
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004331 case HCI_EV_LE_LTK_REQ:
4332 hci_le_ltk_request_evt(hdev, skb);
4333 break;
4334
Ville Tervofcd89c02011-02-10 22:38:47 -03004335 default:
4336 break;
4337 }
4338}
4339
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03004340static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
4341{
4342 struct hci_ev_channel_selected *ev = (void *) skb->data;
4343 struct hci_conn *hcon;
4344
4345 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
4346
4347 skb_pull(skb, sizeof(*ev));
4348
4349 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4350 if (!hcon)
4351 return;
4352
4353 amp_read_loc_assoc_final_data(hdev, hcon);
4354}
4355
Linus Torvalds1da177e2005-04-16 15:20:36 -07004356void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
4357{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004358 struct hci_event_hdr *hdr = (void *) skb->data;
4359 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004360
Johan Hedbergb6ddb632013-04-02 13:34:31 +03004361 hci_dev_lock(hdev);
4362
4363 /* Received events are (currently) only needed when a request is
4364 * ongoing so avoid unnecessary memory allocation.
4365 */
4366 if (hdev->req_status == HCI_REQ_PEND) {
4367 kfree_skb(hdev->recv_evt);
4368 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
4369 }
4370
4371 hci_dev_unlock(hdev);
4372
Linus Torvalds1da177e2005-04-16 15:20:36 -07004373 skb_pull(skb, HCI_EVENT_HDR_SIZE);
4374
Johan Hedberg02350a72013-04-03 21:50:29 +03004375 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02004376 struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
4377 u16 opcode = __le16_to_cpu(cmd_hdr->opcode);
Johan Hedberg02350a72013-04-03 21:50:29 +03004378
4379 hci_req_cmd_complete(hdev, opcode, 0);
4380 }
4381
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004382 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004383 case HCI_EV_INQUIRY_COMPLETE:
4384 hci_inquiry_complete_evt(hdev, skb);
4385 break;
4386
4387 case HCI_EV_INQUIRY_RESULT:
4388 hci_inquiry_result_evt(hdev, skb);
4389 break;
4390
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004391 case HCI_EV_CONN_COMPLETE:
4392 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02004393 break;
4394
Linus Torvalds1da177e2005-04-16 15:20:36 -07004395 case HCI_EV_CONN_REQUEST:
4396 hci_conn_request_evt(hdev, skb);
4397 break;
4398
Linus Torvalds1da177e2005-04-16 15:20:36 -07004399 case HCI_EV_DISCONN_COMPLETE:
4400 hci_disconn_complete_evt(hdev, skb);
4401 break;
4402
Linus Torvalds1da177e2005-04-16 15:20:36 -07004403 case HCI_EV_AUTH_COMPLETE:
4404 hci_auth_complete_evt(hdev, skb);
4405 break;
4406
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004407 case HCI_EV_REMOTE_NAME:
4408 hci_remote_name_evt(hdev, skb);
4409 break;
4410
Linus Torvalds1da177e2005-04-16 15:20:36 -07004411 case HCI_EV_ENCRYPT_CHANGE:
4412 hci_encrypt_change_evt(hdev, skb);
4413 break;
4414
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004415 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
4416 hci_change_link_key_complete_evt(hdev, skb);
4417 break;
4418
4419 case HCI_EV_REMOTE_FEATURES:
4420 hci_remote_features_evt(hdev, skb);
4421 break;
4422
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004423 case HCI_EV_CMD_COMPLETE:
4424 hci_cmd_complete_evt(hdev, skb);
4425 break;
4426
4427 case HCI_EV_CMD_STATUS:
4428 hci_cmd_status_evt(hdev, skb);
4429 break;
4430
4431 case HCI_EV_ROLE_CHANGE:
4432 hci_role_change_evt(hdev, skb);
4433 break;
4434
4435 case HCI_EV_NUM_COMP_PKTS:
4436 hci_num_comp_pkts_evt(hdev, skb);
4437 break;
4438
4439 case HCI_EV_MODE_CHANGE:
4440 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004441 break;
4442
4443 case HCI_EV_PIN_CODE_REQ:
4444 hci_pin_code_request_evt(hdev, skb);
4445 break;
4446
4447 case HCI_EV_LINK_KEY_REQ:
4448 hci_link_key_request_evt(hdev, skb);
4449 break;
4450
4451 case HCI_EV_LINK_KEY_NOTIFY:
4452 hci_link_key_notify_evt(hdev, skb);
4453 break;
4454
4455 case HCI_EV_CLOCK_OFFSET:
4456 hci_clock_offset_evt(hdev, skb);
4457 break;
4458
Marcel Holtmanna8746412008-07-14 20:13:46 +02004459 case HCI_EV_PKT_TYPE_CHANGE:
4460 hci_pkt_type_change_evt(hdev, skb);
4461 break;
4462
Marcel Holtmann85a1e932005-08-09 20:28:02 -07004463 case HCI_EV_PSCAN_REP_MODE:
4464 hci_pscan_rep_mode_evt(hdev, skb);
4465 break;
4466
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004467 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
4468 hci_inquiry_result_with_rssi_evt(hdev, skb);
4469 break;
4470
4471 case HCI_EV_REMOTE_EXT_FEATURES:
4472 hci_remote_ext_features_evt(hdev, skb);
4473 break;
4474
4475 case HCI_EV_SYNC_CONN_COMPLETE:
4476 hci_sync_conn_complete_evt(hdev, skb);
4477 break;
4478
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004479 case HCI_EV_EXTENDED_INQUIRY_RESULT:
4480 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004481 break;
4482
Johan Hedberg1c2e0042012-06-08 23:31:13 +08004483 case HCI_EV_KEY_REFRESH_COMPLETE:
4484 hci_key_refresh_complete_evt(hdev, skb);
4485 break;
4486
Marcel Holtmann04936842008-07-14 20:13:48 +02004487 case HCI_EV_IO_CAPA_REQUEST:
4488 hci_io_capa_request_evt(hdev, skb);
4489 break;
4490
Johan Hedberg03b555e2011-01-04 15:40:05 +02004491 case HCI_EV_IO_CAPA_REPLY:
4492 hci_io_capa_reply_evt(hdev, skb);
4493 break;
4494
Johan Hedberga5c29682011-02-19 12:05:57 -03004495 case HCI_EV_USER_CONFIRM_REQUEST:
4496 hci_user_confirm_request_evt(hdev, skb);
4497 break;
4498
Brian Gix1143d452011-11-23 08:28:34 -08004499 case HCI_EV_USER_PASSKEY_REQUEST:
4500 hci_user_passkey_request_evt(hdev, skb);
4501 break;
4502
Johan Hedberg92a25252012-09-06 18:39:26 +03004503 case HCI_EV_USER_PASSKEY_NOTIFY:
4504 hci_user_passkey_notify_evt(hdev, skb);
4505 break;
4506
4507 case HCI_EV_KEYPRESS_NOTIFY:
4508 hci_keypress_notify_evt(hdev, skb);
4509 break;
4510
Marcel Holtmann04936842008-07-14 20:13:48 +02004511 case HCI_EV_SIMPLE_PAIR_COMPLETE:
4512 hci_simple_pair_complete_evt(hdev, skb);
4513 break;
4514
Marcel Holtmann41a96212008-07-14 20:13:48 +02004515 case HCI_EV_REMOTE_HOST_FEATURES:
4516 hci_remote_host_features_evt(hdev, skb);
4517 break;
4518
Ville Tervofcd89c02011-02-10 22:38:47 -03004519 case HCI_EV_LE_META:
4520 hci_le_meta_evt(hdev, skb);
4521 break;
4522
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03004523 case HCI_EV_CHANNEL_SELECTED:
4524 hci_chan_selected_evt(hdev, skb);
4525 break;
4526
Szymon Janc2763eda2011-03-22 13:12:22 +01004527 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
4528 hci_remote_oob_data_request_evt(hdev, skb);
4529 break;
4530
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004531 case HCI_EV_PHY_LINK_COMPLETE:
4532 hci_phy_link_complete_evt(hdev, skb);
4533 break;
4534
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03004535 case HCI_EV_LOGICAL_LINK_COMPLETE:
4536 hci_loglink_complete_evt(hdev, skb);
4537 break;
4538
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02004539 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
4540 hci_disconn_loglink_complete_evt(hdev, skb);
4541 break;
4542
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02004543 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
4544 hci_disconn_phylink_complete_evt(hdev, skb);
4545 break;
4546
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02004547 case HCI_EV_NUM_COMP_BLOCKS:
4548 hci_num_comp_blocks_evt(hdev, skb);
4549 break;
4550
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004551 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03004552 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004553 break;
4554 }
4555
4556 kfree_skb(skb);
4557 hdev->stat.evt_rx++;
4558}