blob: bd06ef95693d26c3326b4c64e9b3634e0f035014 [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
Gustavo Padovan8c520a52012-05-23 04:04:22 -030027#include <linux/export.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070028#include <asm/unaligned.h>
29
30#include <net/bluetooth/bluetooth.h>
31#include <net/bluetooth/hci_core.h>
Mikel Astizf0d6a0e2012-08-09 09:52:30 +020032#include <net/bluetooth/mgmt.h>
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +030033#include <net/bluetooth/a2mp.h>
Andrei Emeltchenko903e4542012-09-27 17:26:09 +030034#include <net/bluetooth/amp.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070035
Linus Torvalds1da177e2005-04-16 15:20:36 -070036/* Handle HCI Event packets */
37
Marcel Holtmanna9de9242007-10-20 13:33:56 +020038static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070039{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020040 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070041
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030042 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
Andre Guedese6d465c2011-11-09 17:14:26 -030044 if (status) {
45 hci_dev_lock(hdev);
46 mgmt_stop_discovery_failed(hdev, status);
47 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020048 return;
Andre Guedese6d465c2011-11-09 17:14:26 -030049 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
Andre Guedes89352e72011-11-04 14:16:53 -030051 clear_bit(HCI_INQUIRY, &hdev->flags);
52
Johan Hedberg56e5cb82011-11-08 20:40:16 +020053 hci_dev_lock(hdev);
Johan Hedbergff9ef572012-01-04 14:23:45 +020054 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Johan Hedberg56e5cb82011-11-08 20:40:16 +020055 hci_dev_unlock(hdev);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010056
Johan Hedberg23bb5762010-12-21 23:01:27 +020057 hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010058
Marcel Holtmanna9de9242007-10-20 13:33:56 +020059 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070060}
61
Andre Guedes4d934832012-03-21 00:03:35 -030062static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
63{
64 __u8 status = *((__u8 *) skb->data);
65
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030066 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesae854a72012-03-21 00:03:36 -030067
68 if (status)
69 return;
70
71 set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
Andre Guedes4d934832012-03-21 00:03:35 -030072}
73
Marcel Holtmanna9de9242007-10-20 13:33:56 +020074static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070075{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020076 __u8 status = *((__u8 *) skb->data);
77
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030078 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020079
80 if (status)
81 return;
82
Andre Guedesae854a72012-03-21 00:03:36 -030083 clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
84
Marcel Holtmanna9de9242007-10-20 13:33:56 +020085 hci_conn_check_pending(hdev);
86}
87
Gustavo Padovan807deac2012-05-17 00:36:24 -030088static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
89 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020090{
91 BT_DBG("%s", hdev->name);
92}
93
94static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
95{
96 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070097 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030099 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200101 if (rp->status)
102 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200104 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200106 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
107 if (conn) {
108 if (rp->role)
109 conn->link_mode &= ~HCI_LM_MASTER;
110 else
111 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200113
114 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115}
116
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200117static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
118{
119 struct hci_rp_read_link_policy *rp = (void *) skb->data;
120 struct hci_conn *conn;
121
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300122 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200123
124 if (rp->status)
125 return;
126
127 hci_dev_lock(hdev);
128
129 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
130 if (conn)
131 conn->link_policy = __le16_to_cpu(rp->policy);
132
133 hci_dev_unlock(hdev);
134}
135
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200136static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200138 struct hci_rp_write_link_policy *rp = (void *) skb->data;
139 struct hci_conn *conn;
140 void *sent;
141
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300142 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200143
144 if (rp->status)
145 return;
146
147 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
148 if (!sent)
149 return;
150
151 hci_dev_lock(hdev);
152
153 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200154 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700155 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200156
157 hci_dev_unlock(hdev);
158}
159
Gustavo Padovan807deac2012-05-17 00:36:24 -0300160static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
161 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200162{
163 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
164
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300165 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200166
167 if (rp->status)
168 return;
169
170 hdev->link_policy = __le16_to_cpu(rp->policy);
171}
172
Gustavo Padovan807deac2012-05-17 00:36:24 -0300173static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
174 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200175{
176 __u8 status = *((__u8 *) skb->data);
177 void *sent;
178
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300179 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200180
181 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
182 if (!sent)
183 return;
184
185 if (!status)
186 hdev->link_policy = get_unaligned_le16(sent);
187
Johan Hedberg23bb5762010-12-21 23:01:27 +0200188 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200189}
190
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200191static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
192{
193 __u8 status = *((__u8 *) skb->data);
194
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300195 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200196
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300197 clear_bit(HCI_RESET, &hdev->flags);
198
Johan Hedberg23bb5762010-12-21 23:01:27 +0200199 hci_req_complete(hdev, HCI_OP_RESET, status);
Andre Guedesd23264a2011-11-25 20:53:38 -0300200
Johan Hedberga297e972012-02-21 17:55:47 +0200201 /* Reset all non-persistent flags */
Andre Guedesae854a72012-03-21 00:03:36 -0300202 hdev->dev_flags &= ~(BIT(HCI_LE_SCAN) | BIT(HCI_PENDING_CLASS) |
203 BIT(HCI_PERIODIC_INQ));
Andre Guedes69775ff2012-02-23 16:50:05 +0200204
205 hdev->discovery.state = DISCOVERY_STOPPED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200206}
207
208static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
209{
210 __u8 status = *((__u8 *) skb->data);
211 void *sent;
212
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300213 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200214
215 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
216 if (!sent)
217 return;
218
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200219 hci_dev_lock(hdev);
220
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200221 if (test_bit(HCI_MGMT, &hdev->dev_flags))
222 mgmt_set_local_name_complete(hdev, sent, status);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +0200223 else if (!status)
224 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200225
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200226 hci_dev_unlock(hdev);
Johan Hedberg3159d382012-02-24 13:47:56 +0200227
228 hci_req_complete(hdev, HCI_OP_WRITE_LOCAL_NAME, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200229}
230
231static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
232{
233 struct hci_rp_read_local_name *rp = (void *) skb->data;
234
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300235 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200236
237 if (rp->status)
238 return;
239
Johan Hedbergdb99b5f2012-02-22 20:14:22 +0200240 if (test_bit(HCI_SETUP, &hdev->dev_flags))
241 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200242}
243
244static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
245{
246 __u8 status = *((__u8 *) skb->data);
247 void *sent;
248
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300249 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200250
251 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
252 if (!sent)
253 return;
254
255 if (!status) {
256 __u8 param = *((__u8 *) sent);
257
258 if (param == AUTH_ENABLED)
259 set_bit(HCI_AUTH, &hdev->flags);
260 else
261 clear_bit(HCI_AUTH, &hdev->flags);
262 }
263
Johan Hedberg33ef95e2012-02-16 23:56:27 +0200264 if (test_bit(HCI_MGMT, &hdev->dev_flags))
265 mgmt_auth_enable_complete(hdev, status);
266
Johan Hedberg23bb5762010-12-21 23:01:27 +0200267 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, 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 }
289
Johan Hedberg23bb5762010-12-21 23:01:27 +0200290 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200291}
292
293static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
294{
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200295 __u8 param, status = *((__u8 *) skb->data);
296 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200297 void *sent;
298
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300299 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200300
301 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
302 if (!sent)
303 return;
304
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200305 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200306
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200307 hci_dev_lock(hdev);
308
Mikel Astizfa1bd912012-08-09 09:52:29 +0200309 if (status) {
Johan Hedberg744cf192011-11-08 20:40:14 +0200310 mgmt_write_scan_failed(hdev, param, status);
Johan Hedberg2d7cee52011-11-07 22:16:03 +0200311 hdev->discov_timeout = 0;
312 goto done;
313 }
314
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200315 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
316 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200317
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200318 if (param & SCAN_INQUIRY) {
319 set_bit(HCI_ISCAN, &hdev->flags);
320 if (!old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200321 mgmt_discoverable(hdev, 1);
Johan Hedberg16ab91a2011-11-07 22:16:02 +0200322 if (hdev->discov_timeout > 0) {
323 int to = msecs_to_jiffies(hdev->discov_timeout * 1000);
324 queue_delayed_work(hdev->workqueue, &hdev->discov_off,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300325 to);
Johan Hedberg16ab91a2011-11-07 22:16:02 +0200326 }
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200327 } else if (old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200328 mgmt_discoverable(hdev, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200329
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200330 if (param & SCAN_PAGE) {
331 set_bit(HCI_PSCAN, &hdev->flags);
332 if (!old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200333 mgmt_connectable(hdev, 1);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200334 } else if (old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200335 mgmt_connectable(hdev, 0);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200336
337done:
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200338 hci_dev_unlock(hdev);
Johan Hedberg23bb5762010-12-21 23:01:27 +0200339 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200340}
341
342static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
343{
344 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
345
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300346 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200347
348 if (rp->status)
349 return;
350
351 memcpy(hdev->dev_class, rp->dev_class, 3);
352
353 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300354 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200355}
356
357static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
358{
359 __u8 status = *((__u8 *) skb->data);
360 void *sent;
361
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300362 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200363
364 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
365 if (!sent)
366 return;
367
Marcel Holtmann7f9a9032012-02-22 18:38:01 +0100368 hci_dev_lock(hdev);
369
370 if (status == 0)
371 memcpy(hdev->dev_class, sent, 3);
372
373 if (test_bit(HCI_MGMT, &hdev->dev_flags))
374 mgmt_set_class_of_dev_complete(hdev, sent, status);
375
376 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200377}
378
379static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
380{
381 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200383
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300384 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200385
386 if (rp->status)
387 return;
388
389 setting = __le16_to_cpu(rp->voice_setting);
390
Marcel Holtmannf383f272008-07-14 20:13:47 +0200391 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200392 return;
393
394 hdev->voice_setting = setting;
395
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300396 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200397
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200398 if (hdev->notify)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200399 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200400}
401
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300402static void hci_cc_write_voice_setting(struct hci_dev *hdev,
403 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200404{
405 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200406 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407 void *sent;
408
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300409 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410
Marcel Holtmannf383f272008-07-14 20:13:47 +0200411 if (status)
412 return;
413
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200414 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
415 if (!sent)
416 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417
Marcel Holtmannf383f272008-07-14 20:13:47 +0200418 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419
Marcel Holtmannf383f272008-07-14 20:13:47 +0200420 if (hdev->voice_setting == setting)
421 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422
Marcel Holtmannf383f272008-07-14 20:13:47 +0200423 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300425 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200426
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200427 if (hdev->notify)
Marcel Holtmannf383f272008-07-14 20:13:47 +0200428 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429}
430
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200431static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200433 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700434
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300435 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436
Johan Hedberg23bb5762010-12-21 23:01:27 +0200437 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438}
439
Marcel Holtmann333140b2008-07-14 20:13:48 +0200440static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
441{
442 __u8 status = *((__u8 *) skb->data);
443 void *sent;
444
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300445 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann333140b2008-07-14 20:13:48 +0200446
Marcel Holtmann333140b2008-07-14 20:13:48 +0200447 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
448 if (!sent)
449 return;
450
Johan Hedberged2c4ee2012-02-17 00:56:28 +0200451 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200452 mgmt_ssp_enable_complete(hdev, *((u8 *) sent), status);
453 else if (!status) {
454 if (*((u8 *) sent))
455 set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
456 else
457 clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
458 }
Marcel Holtmann333140b2008-07-14 20:13:48 +0200459}
460
Johan Hedbergd5859e22011-01-25 01:19:58 +0200461static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
462{
463 if (hdev->features[6] & LMP_EXT_INQ)
464 return 2;
465
466 if (hdev->features[3] & LMP_RSSI_INQ)
467 return 1;
468
469 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
Gustavo Padovan807deac2012-05-17 00:36:24 -0300470 hdev->lmp_subver == 0x0757)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200471 return 1;
472
473 if (hdev->manufacturer == 15) {
474 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
475 return 1;
476 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
477 return 1;
478 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
479 return 1;
480 }
481
482 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
Gustavo Padovan807deac2012-05-17 00:36:24 -0300483 hdev->lmp_subver == 0x1805)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200484 return 1;
485
486 return 0;
487}
488
489static void hci_setup_inquiry_mode(struct hci_dev *hdev)
490{
491 u8 mode;
492
493 mode = hci_get_inquiry_mode(hdev);
494
495 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
496}
497
498static void hci_setup_event_mask(struct hci_dev *hdev)
499{
500 /* The second byte is 0xff instead of 0x9f (two reserved bits
501 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
502 * command otherwise */
503 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
504
Ville Tervo6de6c182011-05-27 11:16:21 +0300505 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
506 * any event mask for pre 1.2 devices */
Andrei Emeltchenko5a13b092011-12-01 14:33:28 +0200507 if (hdev->hci_ver < BLUETOOTH_VER_1_2)
Ville Tervo6de6c182011-05-27 11:16:21 +0300508 return;
509
510 events[4] |= 0x01; /* Flow Specification Complete */
511 events[4] |= 0x02; /* Inquiry Result with RSSI */
512 events[4] |= 0x04; /* Read Remote Extended Features Complete */
513 events[5] |= 0x08; /* Synchronous Connection Complete */
514 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200515
516 if (hdev->features[3] & LMP_RSSI_INQ)
Johan Hedberga24299e2012-04-26 09:47:46 +0300517 events[4] |= 0x02; /* Inquiry Result with RSSI */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200518
Andre Guedes999dcd12012-07-24 15:03:52 -0300519 if (lmp_sniffsubr_capable(hdev))
Johan Hedbergd5859e22011-01-25 01:19:58 +0200520 events[5] |= 0x20; /* Sniff Subrating */
521
522 if (hdev->features[5] & LMP_PAUSE_ENC)
523 events[5] |= 0x80; /* Encryption Key Refresh Complete */
524
525 if (hdev->features[6] & LMP_EXT_INQ)
526 events[5] |= 0x40; /* Extended Inquiry Result */
527
Andre Guedesc58e8102012-07-24 15:03:53 -0300528 if (lmp_no_flush_capable(hdev))
Johan Hedbergd5859e22011-01-25 01:19:58 +0200529 events[7] |= 0x01; /* Enhanced Flush Complete */
530
531 if (hdev->features[7] & LMP_LSTO)
532 events[6] |= 0x80; /* Link Supervision Timeout Changed */
533
Andre Guedes9a1a1992012-07-24 15:03:48 -0300534 if (lmp_ssp_capable(hdev)) {
Johan Hedbergd5859e22011-01-25 01:19:58 +0200535 events[6] |= 0x01; /* IO Capability Request */
536 events[6] |= 0x02; /* IO Capability Response */
537 events[6] |= 0x04; /* User Confirmation Request */
538 events[6] |= 0x08; /* User Passkey Request */
539 events[6] |= 0x10; /* Remote OOB Data Request */
540 events[6] |= 0x20; /* Simple Pairing Complete */
541 events[7] |= 0x04; /* User Passkey Notification */
542 events[7] |= 0x08; /* Keypress Notification */
543 events[7] |= 0x10; /* Remote Host Supported
544 * Features Notification */
545 }
546
Andre Guedesc383ddc2012-07-24 15:03:47 -0300547 if (lmp_le_capable(hdev))
Johan Hedbergd5859e22011-01-25 01:19:58 +0200548 events[7] |= 0x20; /* LE Meta-Event */
549
550 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
551}
552
553static void hci_setup(struct hci_dev *hdev)
554{
Andrei Emeltchenkoe61ef4992011-12-19 16:31:27 +0200555 if (hdev->dev_type != HCI_BREDR)
556 return;
557
Johan Hedbergd5859e22011-01-25 01:19:58 +0200558 hci_setup_event_mask(hdev);
559
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +0200560 if (hdev->hci_ver > BLUETOOTH_VER_1_1)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200561 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
562
Gustavo Padovan6d3c7302012-05-24 03:36:37 -0300563 if (lmp_ssp_capable(hdev)) {
Johan Hedberg54d04db2012-02-22 15:47:48 +0200564 if (test_bit(HCI_SSP_ENABLED, &hdev->dev_flags)) {
565 u8 mode = 0x01;
566 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300567 sizeof(mode), &mode);
Johan Hedberg54d04db2012-02-22 15:47:48 +0200568 } else {
569 struct hci_cp_write_eir cp;
570
571 memset(hdev->eir, 0, sizeof(hdev->eir));
572 memset(&cp, 0, sizeof(cp));
573
574 hci_send_cmd(hdev, HCI_OP_WRITE_EIR, sizeof(cp), &cp);
575 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200576 }
577
578 if (hdev->features[3] & LMP_RSSI_INQ)
579 hci_setup_inquiry_mode(hdev);
580
581 if (hdev->features[7] & LMP_INQ_TX_PWR)
582 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
Andre Guedes971e3a42011-06-30 19:20:52 -0300583
584 if (hdev->features[7] & LMP_EXTFEATURES) {
585 struct hci_cp_read_local_ext_features cp;
586
587 cp.page = 0x01;
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300588 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp),
589 &cp);
Andre Guedes971e3a42011-06-30 19:20:52 -0300590 }
Andre Guedese6100a22011-06-30 19:20:54 -0300591
Johan Hedberg47990ea2012-02-22 11:58:37 +0200592 if (test_bit(HCI_LINK_SECURITY, &hdev->dev_flags)) {
593 u8 enable = 1;
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300594 hci_send_cmd(hdev, HCI_OP_WRITE_AUTH_ENABLE, sizeof(enable),
595 &enable);
Johan Hedberg47990ea2012-02-22 11:58:37 +0200596 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200597}
598
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200599static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
600{
601 struct hci_rp_read_local_version *rp = (void *) skb->data;
602
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300603 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200604
605 if (rp->status)
Andrei Emeltchenko28b8df72012-02-24 12:45:44 +0200606 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200607
608 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200609 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200610 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200611 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200612 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200613
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300614 BT_DBG("%s manufacturer 0x%4.4x hci ver %d:%d", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300615 hdev->manufacturer, hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200616
617 if (test_bit(HCI_INIT, &hdev->flags))
618 hci_setup(hdev);
Andrei Emeltchenko28b8df72012-02-24 12:45:44 +0200619
620done:
621 hci_req_complete(hdev, HCI_OP_READ_LOCAL_VERSION, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200622}
623
624static void hci_setup_link_policy(struct hci_dev *hdev)
625{
Andrei Emeltchenko035100c2012-03-12 15:59:32 +0200626 struct hci_cp_write_def_link_policy cp;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200627 u16 link_policy = 0;
628
Andre Guedes9f92ebf2012-07-24 15:03:50 -0300629 if (lmp_rswitch_capable(hdev))
Johan Hedbergd5859e22011-01-25 01:19:58 +0200630 link_policy |= HCI_LP_RSWITCH;
631 if (hdev->features[0] & LMP_HOLD)
632 link_policy |= HCI_LP_HOLD;
Andre Guedes6eded102012-07-24 15:03:51 -0300633 if (lmp_sniff_capable(hdev))
Johan Hedbergd5859e22011-01-25 01:19:58 +0200634 link_policy |= HCI_LP_SNIFF;
635 if (hdev->features[1] & LMP_PARK)
636 link_policy |= HCI_LP_PARK;
637
Andrei Emeltchenko035100c2012-03-12 15:59:32 +0200638 cp.policy = cpu_to_le16(link_policy);
639 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200640}
641
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300642static void hci_cc_read_local_commands(struct hci_dev *hdev,
643 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200644{
645 struct hci_rp_read_local_commands *rp = (void *) skb->data;
646
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300647 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200648
649 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200650 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200651
652 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200653
654 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
655 hci_setup_link_policy(hdev);
656
657done:
658 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200659}
660
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300661static void hci_cc_read_local_features(struct hci_dev *hdev,
662 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200663{
664 struct hci_rp_read_local_features *rp = (void *) skb->data;
665
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300666 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200667
668 if (rp->status)
669 return;
670
671 memcpy(hdev->features, rp->features, 8);
672
673 /* Adjust default settings according to features
674 * supported by device. */
675
676 if (hdev->features[0] & LMP_3SLOT)
677 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
678
679 if (hdev->features[0] & LMP_5SLOT)
680 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
681
682 if (hdev->features[1] & LMP_HV2) {
683 hdev->pkt_type |= (HCI_HV2);
684 hdev->esco_type |= (ESCO_HV2);
685 }
686
687 if (hdev->features[1] & LMP_HV3) {
688 hdev->pkt_type |= (HCI_HV3);
689 hdev->esco_type |= (ESCO_HV3);
690 }
691
Andre Guedes45db810f2012-07-24 15:03:49 -0300692 if (lmp_esco_capable(hdev))
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200693 hdev->esco_type |= (ESCO_EV3);
694
695 if (hdev->features[4] & LMP_EV4)
696 hdev->esco_type |= (ESCO_EV4);
697
698 if (hdev->features[4] & LMP_EV5)
699 hdev->esco_type |= (ESCO_EV5);
700
Marcel Holtmannefc76882009-02-06 09:13:37 +0100701 if (hdev->features[5] & LMP_EDR_ESCO_2M)
702 hdev->esco_type |= (ESCO_2EV3);
703
704 if (hdev->features[5] & LMP_EDR_ESCO_3M)
705 hdev->esco_type |= (ESCO_3EV3);
706
707 if (hdev->features[5] & LMP_EDR_3S_ESCO)
708 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
709
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200710 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300711 hdev->features[0], hdev->features[1],
712 hdev->features[2], hdev->features[3],
713 hdev->features[4], hdev->features[5],
714 hdev->features[6], hdev->features[7]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200715}
716
Johan Hedberg8f984df2012-02-28 01:07:22 +0200717static void hci_set_le_support(struct hci_dev *hdev)
718{
719 struct hci_cp_write_le_host_supported cp;
720
721 memset(&cp, 0, sizeof(cp));
722
Marcel Holtmann9d428202012-05-03 07:12:31 +0200723 if (test_bit(HCI_LE_ENABLED, &hdev->dev_flags)) {
Johan Hedberg8f984df2012-02-28 01:07:22 +0200724 cp.le = 1;
725 cp.simul = !!(hdev->features[6] & LMP_SIMUL_LE_BR);
726 }
727
728 if (cp.le != !!(hdev->host_features[0] & LMP_HOST_LE))
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300729 hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(cp),
730 &cp);
Johan Hedberg8f984df2012-02-28 01:07:22 +0200731}
732
Andre Guedes971e3a42011-06-30 19:20:52 -0300733static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300734 struct sk_buff *skb)
Andre Guedes971e3a42011-06-30 19:20:52 -0300735{
736 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
737
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300738 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andre Guedes971e3a42011-06-30 19:20:52 -0300739
740 if (rp->status)
Johan Hedberg8f984df2012-02-28 01:07:22 +0200741 goto done;
Andre Guedes971e3a42011-06-30 19:20:52 -0300742
Andre Guedesb5b32b62011-12-30 10:34:04 -0300743 switch (rp->page) {
744 case 0:
745 memcpy(hdev->features, rp->features, 8);
746 break;
747 case 1:
748 memcpy(hdev->host_features, rp->features, 8);
749 break;
750 }
Andre Guedes971e3a42011-06-30 19:20:52 -0300751
Andre Guedesc383ddc2012-07-24 15:03:47 -0300752 if (test_bit(HCI_INIT, &hdev->flags) && lmp_le_capable(hdev))
Johan Hedberg8f984df2012-02-28 01:07:22 +0200753 hci_set_le_support(hdev);
754
755done:
Andre Guedes971e3a42011-06-30 19:20:52 -0300756 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
757}
758
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200759static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300760 struct sk_buff *skb)
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200761{
762 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
763
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300764 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200765
766 if (rp->status)
767 return;
768
769 hdev->flow_ctl_mode = rp->mode;
770
771 hci_req_complete(hdev, HCI_OP_READ_FLOW_CONTROL_MODE, rp->status);
772}
773
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200774static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
775{
776 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
777
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300778 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200779
780 if (rp->status)
781 return;
782
783 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
784 hdev->sco_mtu = rp->sco_mtu;
785 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
786 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
787
788 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
789 hdev->sco_mtu = 64;
790 hdev->sco_pkts = 8;
791 }
792
793 hdev->acl_cnt = hdev->acl_pkts;
794 hdev->sco_cnt = hdev->sco_pkts;
795
Gustavo Padovan807deac2012-05-17 00:36:24 -0300796 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
797 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200798}
799
800static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
801{
802 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
803
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300804 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200805
806 if (!rp->status)
807 bacpy(&hdev->bdaddr, &rp->bdaddr);
808
Johan Hedberg23bb5762010-12-21 23:01:27 +0200809 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
810}
811
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200812static void hci_cc_read_data_block_size(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300813 struct sk_buff *skb)
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200814{
815 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
816
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300817 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200818
819 if (rp->status)
820 return;
821
822 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
823 hdev->block_len = __le16_to_cpu(rp->block_len);
824 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
825
826 hdev->block_cnt = hdev->num_blocks;
827
828 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300829 hdev->block_cnt, hdev->block_len);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200830
831 hci_req_complete(hdev, HCI_OP_READ_DATA_BLOCK_SIZE, rp->status);
832}
833
Johan Hedberg23bb5762010-12-21 23:01:27 +0200834static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
835{
836 __u8 status = *((__u8 *) skb->data);
837
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300838 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg23bb5762010-12-21 23:01:27 +0200839
840 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200841}
842
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300843static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300844 struct sk_buff *skb)
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300845{
846 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
847
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300848 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300849
850 if (rp->status)
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300851 goto a2mp_rsp;
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300852
853 hdev->amp_status = rp->amp_status;
854 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
855 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
856 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
857 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
858 hdev->amp_type = rp->amp_type;
859 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
860 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
861 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
862 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
863
864 hci_req_complete(hdev, HCI_OP_READ_LOCAL_AMP_INFO, rp->status);
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300865
866a2mp_rsp:
867 a2mp_send_getinfo_rsp(hdev);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300868}
869
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300870static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
871 struct sk_buff *skb)
872{
873 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
874 struct amp_assoc *assoc = &hdev->loc_assoc;
875 size_t rem_len, frag_len;
876
877 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
878
879 if (rp->status)
880 goto a2mp_rsp;
881
882 frag_len = skb->len - sizeof(*rp);
883 rem_len = __le16_to_cpu(rp->rem_len);
884
885 if (rem_len > frag_len) {
886 BT_DBG("frag_len %d rem_len %d", frag_len, rem_len);
887
888 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
889 assoc->offset += frag_len;
890
891 /* Read other fragments */
892 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
893
894 return;
895 }
896
897 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
898 assoc->len = assoc->offset + rem_len;
899 assoc->offset = 0;
900
901a2mp_rsp:
902 /* Send A2MP Rsp when all fragments are received */
903 a2mp_send_getampassoc_rsp(hdev, rp->status);
904}
905
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200906static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300907 struct sk_buff *skb)
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200908{
909 __u8 status = *((__u8 *) skb->data);
910
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300911 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200912
913 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
914}
915
Johan Hedbergd5859e22011-01-25 01:19:58 +0200916static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
917{
918 __u8 status = *((__u8 *) skb->data);
919
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300920 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200921
922 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
923}
924
925static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300926 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200927{
928 __u8 status = *((__u8 *) skb->data);
929
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300930 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200931
932 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
933}
934
935static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300936 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200937{
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700938 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200939
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300940 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200941
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700942 if (!rp->status)
943 hdev->inq_tx_power = rp->tx_power;
944
945 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200946}
947
948static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
949{
950 __u8 status = *((__u8 *) skb->data);
951
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300952 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200953
954 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
955}
956
Johan Hedberg980e1a52011-01-22 06:10:07 +0200957static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
958{
959 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
960 struct hci_cp_pin_code_reply *cp;
961 struct hci_conn *conn;
962
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300963 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200964
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200965 hci_dev_lock(hdev);
966
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200967 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200968 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200969
Mikel Astizfa1bd912012-08-09 09:52:29 +0200970 if (rp->status)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200971 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200972
973 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
974 if (!cp)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200975 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200976
977 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
978 if (conn)
979 conn->pin_length = cp->pin_len;
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200980
981unlock:
982 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200983}
984
985static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
986{
987 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
988
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300989 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200990
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200991 hci_dev_lock(hdev);
992
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200993 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200994 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300995 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200996
997 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200998}
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200999
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001000static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
1001 struct sk_buff *skb)
1002{
1003 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
1004
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001005 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001006
1007 if (rp->status)
1008 return;
1009
1010 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
1011 hdev->le_pkts = rp->le_max_pkt;
1012
1013 hdev->le_cnt = hdev->le_pkts;
1014
1015 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
1016
1017 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
1018}
Johan Hedberg980e1a52011-01-22 06:10:07 +02001019
Johan Hedberga5c29682011-02-19 12:05:57 -03001020static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
1021{
1022 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
1023
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001024 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -03001025
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001026 hci_dev_lock(hdev);
1027
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001028 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001029 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
1030 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001031
1032 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -03001033}
1034
1035static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001036 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03001037{
1038 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
1039
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001040 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -03001041
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001042 hci_dev_lock(hdev);
1043
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001044 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +02001045 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001046 ACL_LINK, 0, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001047
1048 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -03001049}
1050
Brian Gix1143d452011-11-23 08:28:34 -08001051static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
1052{
1053 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
1054
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001055 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001056
1057 hci_dev_lock(hdev);
1058
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001059 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02001060 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001061 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001062
1063 hci_dev_unlock(hdev);
1064}
1065
1066static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001067 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08001068{
1069 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
1070
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001071 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001072
1073 hci_dev_lock(hdev);
1074
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001075 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Brian Gix1143d452011-11-23 08:28:34 -08001076 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001077 ACL_LINK, 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001078
1079 hci_dev_unlock(hdev);
1080}
1081
Szymon Jancc35938b2011-03-22 13:12:21 +01001082static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001083 struct sk_buff *skb)
Szymon Jancc35938b2011-03-22 13:12:21 +01001084{
1085 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
1086
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001087 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Szymon Jancc35938b2011-03-22 13:12:21 +01001088
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001089 hci_dev_lock(hdev);
Johan Hedberg744cf192011-11-08 20:40:14 +02001090 mgmt_read_local_oob_data_reply_complete(hdev, rp->hash,
Szymon Jancc35938b2011-03-22 13:12:21 +01001091 rp->randomizer, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001092 hci_dev_unlock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +01001093}
1094
Andre Guedes07f7fa52011-12-02 21:13:31 +09001095static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
1096{
1097 __u8 status = *((__u8 *) skb->data);
1098
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001099 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedes7ba8b4b2012-02-03 17:47:59 -03001100
1101 hci_req_complete(hdev, HCI_OP_LE_SET_SCAN_PARAM, status);
Andre Guedes3fd24152012-02-03 17:48:01 -03001102
1103 if (status) {
1104 hci_dev_lock(hdev);
1105 mgmt_start_discovery_failed(hdev, status);
1106 hci_dev_unlock(hdev);
1107 return;
1108 }
Andre Guedes07f7fa52011-12-02 21:13:31 +09001109}
1110
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001111static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001112 struct sk_buff *skb)
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001113{
1114 struct hci_cp_le_set_scan_enable *cp;
1115 __u8 status = *((__u8 *) skb->data);
1116
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001117 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001118
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001119 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
1120 if (!cp)
1121 return;
1122
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001123 switch (cp->enable) {
1124 case LE_SCANNING_ENABLED:
Andre Guedes7ba8b4b2012-02-03 17:47:59 -03001125 hci_req_complete(hdev, HCI_OP_LE_SET_SCAN_ENABLE, status);
1126
Andre Guedes3fd24152012-02-03 17:48:01 -03001127 if (status) {
1128 hci_dev_lock(hdev);
1129 mgmt_start_discovery_failed(hdev, status);
1130 hci_dev_unlock(hdev);
Andre Guedes7ba8b4b2012-02-03 17:47:59 -03001131 return;
Andre Guedes3fd24152012-02-03 17:48:01 -03001132 }
Andre Guedes7ba8b4b2012-02-03 17:47:59 -03001133
Andre Guedesd23264a2011-11-25 20:53:38 -03001134 set_bit(HCI_LE_SCAN, &hdev->dev_flags);
1135
Andre Guedesa8f13c82011-09-09 18:56:24 -03001136 hci_dev_lock(hdev);
Andre Guedes343f9352012-02-17 20:39:37 -03001137 hci_discovery_set_state(hdev, DISCOVERY_FINDING);
Andre Guedesa8f13c82011-09-09 18:56:24 -03001138 hci_dev_unlock(hdev);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001139 break;
1140
1141 case LE_SCANNING_DISABLED:
Andre Guedesc9ecc482012-03-15 16:52:08 -03001142 if (status) {
1143 hci_dev_lock(hdev);
1144 mgmt_stop_discovery_failed(hdev, status);
1145 hci_dev_unlock(hdev);
Andre Guedes7ba8b4b2012-02-03 17:47:59 -03001146 return;
Andre Guedesc9ecc482012-03-15 16:52:08 -03001147 }
Andre Guedes7ba8b4b2012-02-03 17:47:59 -03001148
Andre Guedesd23264a2011-11-25 20:53:38 -03001149 clear_bit(HCI_LE_SCAN, &hdev->dev_flags);
1150
Andre Guedesbc3dd332012-03-06 19:37:06 -03001151 if (hdev->discovery.type == DISCOV_TYPE_INTERLEAVED &&
1152 hdev->discovery.state == DISCOVERY_FINDING) {
Andre Guedes5e0452c2012-02-17 20:39:38 -03001153 mgmt_interleaved_discovery(hdev);
1154 } else {
1155 hci_dev_lock(hdev);
1156 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1157 hci_dev_unlock(hdev);
1158 }
1159
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001160 break;
1161
1162 default:
1163 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1164 break;
Andre Guedes35815082011-05-26 16:23:53 -03001165 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001166}
1167
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001168static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
1169{
1170 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
1171
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001172 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001173
1174 if (rp->status)
1175 return;
1176
1177 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
1178}
1179
1180static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
1181{
1182 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
1183
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001184 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001185
1186 if (rp->status)
1187 return;
1188
1189 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
1190}
1191
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001192static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1193 struct sk_buff *skb)
Andre Guedesf9b49302011-06-30 19:20:53 -03001194{
Johan Hedberg06199cf2012-02-22 16:37:11 +02001195 struct hci_cp_write_le_host_supported *sent;
Andre Guedesf9b49302011-06-30 19:20:53 -03001196 __u8 status = *((__u8 *) skb->data);
1197
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001198 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001199
Johan Hedberg06199cf2012-02-22 16:37:11 +02001200 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001201 if (!sent)
Andre Guedesf9b49302011-06-30 19:20:53 -03001202 return;
1203
Johan Hedberg8f984df2012-02-28 01:07:22 +02001204 if (!status) {
1205 if (sent->le)
1206 hdev->host_features[0] |= LMP_HOST_LE;
1207 else
1208 hdev->host_features[0] &= ~LMP_HOST_LE;
1209 }
1210
1211 if (test_bit(HCI_MGMT, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001212 !test_bit(HCI_INIT, &hdev->flags))
Johan Hedberg8f984df2012-02-28 01:07:22 +02001213 mgmt_le_enable_complete(hdev, sent->le, status);
1214
1215 hci_req_complete(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001216}
1217
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001218static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001219{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001220 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001221
1222 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +02001223 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001224 hci_conn_check_pending(hdev);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001225 hci_dev_lock(hdev);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001226 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Andre Guedes7a135102011-11-09 17:14:25 -03001227 mgmt_start_discovery_failed(hdev, status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001228 hci_dev_unlock(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001229 return;
1230 }
1231
Andre Guedes89352e72011-11-04 14:16:53 -03001232 set_bit(HCI_INQUIRY, &hdev->flags);
1233
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001234 hci_dev_lock(hdev);
Andre Guedes343f9352012-02-17 20:39:37 -03001235 hci_discovery_set_state(hdev, DISCOVERY_FINDING);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001236 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001237}
1238
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001239static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001241 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001243
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001244 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001245
1246 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001247 if (!cp)
1248 return;
1249
1250 hci_dev_lock(hdev);
1251
1252 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1253
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001254 BT_DBG("%s bdaddr %s hcon %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001255
1256 if (status) {
1257 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001258 if (status != 0x0c || conn->attempt > 2) {
1259 conn->state = BT_CLOSED;
1260 hci_proto_connect_cfm(conn, status);
1261 hci_conn_del(conn);
1262 } else
1263 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001264 }
1265 } else {
1266 if (!conn) {
1267 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1268 if (conn) {
Johan Hedberga0c808b2012-01-16 09:49:58 +02001269 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001270 conn->link_mode |= HCI_LM_MASTER;
1271 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001272 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001273 }
1274 }
1275
1276 hci_dev_unlock(hdev);
1277}
1278
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001279static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001280{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001281 struct hci_cp_add_sco *cp;
1282 struct hci_conn *acl, *sco;
1283 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001284
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001285 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001286
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001287 if (!status)
1288 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001290 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1291 if (!cp)
1292 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001293
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001294 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001296 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001297
1298 hci_dev_lock(hdev);
1299
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001300 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001301 if (acl) {
1302 sco = acl->link;
1303 if (sco) {
1304 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001305
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001306 hci_proto_connect_cfm(sco, status);
1307 hci_conn_del(sco);
1308 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001309 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001310
1311 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312}
1313
Marcel Holtmannf8558552008-07-14 20:13:49 +02001314static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1315{
1316 struct hci_cp_auth_requested *cp;
1317 struct hci_conn *conn;
1318
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001319 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001320
1321 if (!status)
1322 return;
1323
1324 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1325 if (!cp)
1326 return;
1327
1328 hci_dev_lock(hdev);
1329
1330 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1331 if (conn) {
1332 if (conn->state == BT_CONFIG) {
1333 hci_proto_connect_cfm(conn, status);
1334 hci_conn_put(conn);
1335 }
1336 }
1337
1338 hci_dev_unlock(hdev);
1339}
1340
1341static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1342{
1343 struct hci_cp_set_conn_encrypt *cp;
1344 struct hci_conn *conn;
1345
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001346 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001347
1348 if (!status)
1349 return;
1350
1351 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1352 if (!cp)
1353 return;
1354
1355 hci_dev_lock(hdev);
1356
1357 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1358 if (conn) {
1359 if (conn->state == BT_CONFIG) {
1360 hci_proto_connect_cfm(conn, status);
1361 hci_conn_put(conn);
1362 }
1363 }
1364
1365 hci_dev_unlock(hdev);
1366}
1367
Johan Hedberg127178d2010-11-18 22:22:29 +02001368static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001369 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001370{
Johan Hedberg392599b2010-11-18 22:22:28 +02001371 if (conn->state != BT_CONFIG || !conn->out)
1372 return 0;
1373
Johan Hedberg765c2a92011-01-19 12:06:52 +05301374 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001375 return 0;
1376
1377 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001378 * devices with sec_level HIGH or if MITM protection is requested */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001379 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
1380 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001381 return 0;
1382
Johan Hedberg392599b2010-11-18 22:22:28 +02001383 return 1;
1384}
1385
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001386static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001387 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001388{
1389 struct hci_cp_remote_name_req cp;
1390
1391 memset(&cp, 0, sizeof(cp));
1392
1393 bacpy(&cp.bdaddr, &e->data.bdaddr);
1394 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1395 cp.pscan_mode = e->data.pscan_mode;
1396 cp.clock_offset = e->data.clock_offset;
1397
1398 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1399}
1400
Johan Hedbergb644ba32012-01-17 21:48:47 +02001401static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001402{
1403 struct discovery_state *discov = &hdev->discovery;
1404 struct inquiry_entry *e;
1405
Johan Hedbergb644ba32012-01-17 21:48:47 +02001406 if (list_empty(&discov->resolve))
1407 return false;
1408
1409 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001410 if (!e)
1411 return false;
1412
Johan Hedbergb644ba32012-01-17 21:48:47 +02001413 if (hci_resolve_name(hdev, e) == 0) {
1414 e->name_state = NAME_PENDING;
1415 return true;
1416 }
1417
1418 return false;
1419}
1420
1421static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001422 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001423{
1424 struct discovery_state *discov = &hdev->discovery;
1425 struct inquiry_entry *e;
1426
1427 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001428 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1429 name_len, conn->dev_class);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001430
1431 if (discov->state == DISCOVERY_STOPPED)
1432 return;
1433
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001434 if (discov->state == DISCOVERY_STOPPING)
1435 goto discov_complete;
1436
1437 if (discov->state != DISCOVERY_RESOLVING)
1438 return;
1439
1440 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001441 /* If the device was not found in a list of found devices names of which
1442 * are pending. there is no need to continue resolving a next name as it
1443 * will be done upon receiving another Remote Name Request Complete
1444 * Event */
1445 if (!e)
1446 return;
1447
1448 list_del(&e->list);
1449 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001450 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001451 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1452 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001453 } else {
1454 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001455 }
1456
Johan Hedbergb644ba32012-01-17 21:48:47 +02001457 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001458 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001459
1460discov_complete:
1461 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1462}
1463
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001464static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1465{
Johan Hedberg127178d2010-11-18 22:22:29 +02001466 struct hci_cp_remote_name_req *cp;
1467 struct hci_conn *conn;
1468
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001469 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001470
1471 /* If successful wait for the name req complete event before
1472 * checking for the need to do authentication */
1473 if (!status)
1474 return;
1475
1476 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1477 if (!cp)
1478 return;
1479
1480 hci_dev_lock(hdev);
1481
1482 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001483
1484 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1485 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1486
Johan Hedberg79c6c702011-04-28 11:28:55 -07001487 if (!conn)
1488 goto unlock;
1489
1490 if (!hci_outgoing_auth_needed(hdev, conn))
1491 goto unlock;
1492
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001493 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001494 struct hci_cp_auth_requested cp;
1495 cp.handle = __cpu_to_le16(conn->handle);
1496 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1497 }
1498
Johan Hedberg79c6c702011-04-28 11:28:55 -07001499unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001500 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001501}
1502
Marcel Holtmann769be972008-07-14 20:13:49 +02001503static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1504{
1505 struct hci_cp_read_remote_features *cp;
1506 struct hci_conn *conn;
1507
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001508 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001509
1510 if (!status)
1511 return;
1512
1513 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1514 if (!cp)
1515 return;
1516
1517 hci_dev_lock(hdev);
1518
1519 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1520 if (conn) {
1521 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001522 hci_proto_connect_cfm(conn, status);
1523 hci_conn_put(conn);
1524 }
1525 }
1526
1527 hci_dev_unlock(hdev);
1528}
1529
1530static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1531{
1532 struct hci_cp_read_remote_ext_features *cp;
1533 struct hci_conn *conn;
1534
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001535 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001536
1537 if (!status)
1538 return;
1539
1540 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1541 if (!cp)
1542 return;
1543
1544 hci_dev_lock(hdev);
1545
1546 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1547 if (conn) {
1548 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001549 hci_proto_connect_cfm(conn, status);
1550 hci_conn_put(conn);
1551 }
1552 }
1553
1554 hci_dev_unlock(hdev);
1555}
1556
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001557static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1558{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001559 struct hci_cp_setup_sync_conn *cp;
1560 struct hci_conn *acl, *sco;
1561 __u16 handle;
1562
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001563 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001564
1565 if (!status)
1566 return;
1567
1568 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1569 if (!cp)
1570 return;
1571
1572 handle = __le16_to_cpu(cp->handle);
1573
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001574 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001575
1576 hci_dev_lock(hdev);
1577
1578 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001579 if (acl) {
1580 sco = acl->link;
1581 if (sco) {
1582 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001583
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001584 hci_proto_connect_cfm(sco, status);
1585 hci_conn_del(sco);
1586 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001587 }
1588
1589 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001590}
1591
1592static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1593{
1594 struct hci_cp_sniff_mode *cp;
1595 struct hci_conn *conn;
1596
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001597 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001598
1599 if (!status)
1600 return;
1601
1602 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1603 if (!cp)
1604 return;
1605
1606 hci_dev_lock(hdev);
1607
1608 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001609 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001610 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001611
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001612 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001613 hci_sco_setup(conn, status);
1614 }
1615
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001616 hci_dev_unlock(hdev);
1617}
1618
1619static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1620{
1621 struct hci_cp_exit_sniff_mode *cp;
1622 struct hci_conn *conn;
1623
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001624 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001625
1626 if (!status)
1627 return;
1628
1629 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1630 if (!cp)
1631 return;
1632
1633 hci_dev_lock(hdev);
1634
1635 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001636 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001637 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001638
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001639 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001640 hci_sco_setup(conn, status);
1641 }
1642
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001643 hci_dev_unlock(hdev);
1644}
1645
Johan Hedberg88c3df12012-02-09 14:27:38 +02001646static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1647{
1648 struct hci_cp_disconnect *cp;
1649 struct hci_conn *conn;
1650
1651 if (!status)
1652 return;
1653
1654 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1655 if (!cp)
1656 return;
1657
1658 hci_dev_lock(hdev);
1659
1660 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1661 if (conn)
1662 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001663 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001664
1665 hci_dev_unlock(hdev);
1666}
1667
Ville Tervofcd89c02011-02-10 22:38:47 -03001668static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1669{
Ville Tervofcd89c02011-02-10 22:38:47 -03001670 struct hci_conn *conn;
1671
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001672 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Ville Tervofcd89c02011-02-10 22:38:47 -03001673
Ville Tervofcd89c02011-02-10 22:38:47 -03001674 if (status) {
Andre Guedesf00a06a2012-07-27 15:10:13 -03001675 hci_dev_lock(hdev);
Ville Tervofcd89c02011-02-10 22:38:47 -03001676
Andre Guedes0c95ab72012-07-27 15:10:14 -03001677 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001678 if (!conn) {
1679 hci_dev_unlock(hdev);
1680 return;
1681 }
1682
Andre Guedes0c95ab72012-07-27 15:10:14 -03001683 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&conn->dst),
Andre Guedesf00a06a2012-07-27 15:10:13 -03001684 conn);
1685
1686 conn->state = BT_CLOSED;
Andre Guedes0c95ab72012-07-27 15:10:14 -03001687 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Andre Guedesf00a06a2012-07-27 15:10:13 -03001688 conn->dst_type, status);
1689 hci_proto_connect_cfm(conn, status);
1690 hci_conn_del(conn);
1691
1692 hci_dev_unlock(hdev);
1693 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001694}
1695
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001696static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1697{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001698 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001699}
1700
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001701static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1702{
1703 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1704}
1705
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001706static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001707{
1708 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001709 struct discovery_state *discov = &hdev->discovery;
1710 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001711
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001712 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001713
Johan Hedberg23bb5762010-12-21 23:01:27 +02001714 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001715
1716 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001717
1718 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1719 return;
1720
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001721 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001722 return;
1723
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001724 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001725
Andre Guedes343f9352012-02-17 20:39:37 -03001726 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001727 goto unlock;
1728
1729 if (list_empty(&discov->resolve)) {
1730 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1731 goto unlock;
1732 }
1733
1734 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1735 if (e && hci_resolve_name(hdev, e) == 0) {
1736 e->name_state = NAME_PENDING;
1737 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1738 } else {
1739 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1740 }
1741
1742unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001743 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001744}
1745
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001746static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001747{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001748 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001749 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001750 int num_rsp = *((__u8 *) skb->data);
1751
1752 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1753
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001754 if (!num_rsp)
1755 return;
1756
Andre Guedes1519cc12012-03-21 00:03:38 -03001757 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1758 return;
1759
Linus Torvalds1da177e2005-04-16 15:20:36 -07001760 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001761
Johan Hedberge17acd42011-03-30 23:57:16 +03001762 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001763 bool name_known, ssp;
Johan Hedberg31754052012-01-04 13:39:52 +02001764
Linus Torvalds1da177e2005-04-16 15:20:36 -07001765 bacpy(&data.bdaddr, &info->bdaddr);
1766 data.pscan_rep_mode = info->pscan_rep_mode;
1767 data.pscan_period_mode = info->pscan_period_mode;
1768 data.pscan_mode = info->pscan_mode;
1769 memcpy(data.dev_class, info->dev_class, 3);
1770 data.clock_offset = info->clock_offset;
1771 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001772 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02001773
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001774 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02001775 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001776 info->dev_class, 0, !name_known, ssp, NULL,
1777 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001778 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001779
Linus Torvalds1da177e2005-04-16 15:20:36 -07001780 hci_dev_unlock(hdev);
1781}
1782
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001783static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001784{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001785 struct hci_ev_conn_complete *ev = (void *) skb->data;
1786 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001787
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001788 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001789
Linus Torvalds1da177e2005-04-16 15:20:36 -07001790 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001791
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001792 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001793 if (!conn) {
1794 if (ev->link_type != SCO_LINK)
1795 goto unlock;
1796
1797 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1798 if (!conn)
1799 goto unlock;
1800
1801 conn->type = SCO_LINK;
1802 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001803
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001804 if (!ev->status) {
1805 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001806
1807 if (conn->type == ACL_LINK) {
1808 conn->state = BT_CONFIG;
1809 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02001810
1811 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1812 !hci_find_link_key(hdev, &ev->bdaddr))
1813 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1814 else
1815 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02001816 } else
1817 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001818
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001819 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001820 hci_conn_add_sysfs(conn);
1821
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001822 if (test_bit(HCI_AUTH, &hdev->flags))
1823 conn->link_mode |= HCI_LM_AUTH;
1824
1825 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1826 conn->link_mode |= HCI_LM_ENCRYPT;
1827
1828 /* Get remote features */
1829 if (conn->type == ACL_LINK) {
1830 struct hci_cp_read_remote_features cp;
1831 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001832 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001833 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001834 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001835
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001836 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02001837 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001838 struct hci_cp_change_conn_ptype cp;
1839 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001840 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001841 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
1842 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001843 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001844 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001845 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001846 if (conn->type == ACL_LINK)
Johan Hedberg744cf192011-11-08 20:40:14 +02001847 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001848 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02001849 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001850
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001851 if (conn->type == ACL_LINK)
1852 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001853
Marcel Holtmann769be972008-07-14 20:13:49 +02001854 if (ev->status) {
1855 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001856 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001857 } else if (ev->link_type != ACL_LINK)
1858 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001859
1860unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001861 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001862
1863 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001864}
1865
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001866static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001867{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001868 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001869 int mask = hdev->link_mode;
1870
Gustavo Padovan807deac2012-05-17 00:36:24 -03001871 BT_DBG("%s bdaddr %s type 0x%x", hdev->name, batostr(&ev->bdaddr),
1872 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001873
1874 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1875
Szymon Janc138d22e2011-02-17 16:44:23 +01001876 if ((mask & HCI_LM_ACCEPT) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001877 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001878 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001879 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001880 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001881
1882 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001883
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001884 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1885 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001886 memcpy(ie->data.dev_class, ev->dev_class, 3);
1887
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03001888 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
1889 &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001890 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001891 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1892 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001893 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001894 hci_dev_unlock(hdev);
1895 return;
1896 }
1897 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001898
Linus Torvalds1da177e2005-04-16 15:20:36 -07001899 memcpy(conn->dev_class, ev->dev_class, 3);
1900 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001901
Linus Torvalds1da177e2005-04-16 15:20:36 -07001902 hci_dev_unlock(hdev);
1903
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001904 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1905 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001906
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001907 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001908
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001909 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1910 cp.role = 0x00; /* Become master */
1911 else
1912 cp.role = 0x01; /* Remain slave */
1913
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001914 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
1915 &cp);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001916 } else {
1917 struct hci_cp_accept_sync_conn_req cp;
1918
1919 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001920 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001921
Andrei Emeltchenko82781e62012-05-25 11:38:27 +03001922 cp.tx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1923 cp.rx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1924 cp.max_latency = __constant_cpu_to_le16(0xffff);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001925 cp.content_format = cpu_to_le16(hdev->voice_setting);
1926 cp.retrans_effort = 0xff;
1927
1928 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001929 sizeof(cp), &cp);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001930 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001931 } else {
1932 /* Connection rejected */
1933 struct hci_cp_reject_conn_req cp;
1934
1935 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02001936 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001937 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001938 }
1939}
1940
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001941static u8 hci_to_mgmt_reason(u8 err)
1942{
1943 switch (err) {
1944 case HCI_ERROR_CONNECTION_TIMEOUT:
1945 return MGMT_DEV_DISCONN_TIMEOUT;
1946 case HCI_ERROR_REMOTE_USER_TERM:
1947 case HCI_ERROR_REMOTE_LOW_RESOURCES:
1948 case HCI_ERROR_REMOTE_POWER_OFF:
1949 return MGMT_DEV_DISCONN_REMOTE;
1950 case HCI_ERROR_LOCAL_HOST_TERM:
1951 return MGMT_DEV_DISCONN_LOCAL_HOST;
1952 default:
1953 return MGMT_DEV_DISCONN_UNKNOWN;
1954 }
1955}
1956
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001957static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001958{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001959 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001960 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001961
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001962 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001963
Linus Torvalds1da177e2005-04-16 15:20:36 -07001964 hci_dev_lock(hdev);
1965
Marcel Holtmann04837f62006-07-03 10:02:33 +02001966 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001967 if (!conn)
1968 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001969
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001970 if (ev->status == 0)
1971 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972
Johan Hedbergb644ba32012-01-17 21:48:47 +02001973 if (test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001974 (conn->type == ACL_LINK || conn->type == LE_LINK)) {
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001975 if (ev->status) {
Johan Hedberg88c3df12012-02-09 14:27:38 +02001976 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001977 conn->dst_type, ev->status);
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001978 } else {
1979 u8 reason = hci_to_mgmt_reason(ev->reason);
1980
Johan Hedbergafc747a2012-01-15 18:11:07 +02001981 mgmt_device_disconnected(hdev, &conn->dst, conn->type,
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001982 conn->dst_type, reason);
1983 }
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001984 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001985
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001986 if (ev->status == 0) {
Vishal Agarwal6ec5bca2012-04-16 14:44:44 +05301987 if (conn->type == ACL_LINK && conn->flush_key)
1988 hci_remove_link_key(hdev, &conn->dst);
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001989 hci_proto_disconn_cfm(conn, ev->reason);
1990 hci_conn_del(conn);
1991 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001992
1993unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001994 hci_dev_unlock(hdev);
1995}
1996
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001997static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001998{
1999 struct hci_ev_auth_complete *ev = (void *) skb->data;
2000 struct hci_conn *conn;
2001
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002002 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002003
2004 hci_dev_lock(hdev);
2005
2006 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002007 if (!conn)
2008 goto unlock;
2009
2010 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002011 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002012 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002013 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03002014 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002015 conn->link_mode |= HCI_LM_AUTH;
2016 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03002017 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002018 } else {
Johan Hedbergbab73cb2012-02-09 16:07:29 +02002019 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002020 ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002021 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002022
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002023 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
2024 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002025
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002026 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002027 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002028 struct hci_cp_set_conn_encrypt cp;
2029 cp.handle = ev->handle;
2030 cp.encrypt = 0x01;
2031 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002032 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002033 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002034 conn->state = BT_CONNECTED;
2035 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002036 hci_conn_put(conn);
2037 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002038 } else {
2039 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002040
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002041 hci_conn_hold(conn);
2042 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
2043 hci_conn_put(conn);
2044 }
2045
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002046 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002047 if (!ev->status) {
2048 struct hci_cp_set_conn_encrypt cp;
2049 cp.handle = ev->handle;
2050 cp.encrypt = 0x01;
2051 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002052 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002053 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002054 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002055 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002056 }
2057 }
2058
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002059unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002060 hci_dev_unlock(hdev);
2061}
2062
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002063static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002064{
Johan Hedberg127178d2010-11-18 22:22:29 +02002065 struct hci_ev_remote_name *ev = (void *) skb->data;
2066 struct hci_conn *conn;
2067
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002068 BT_DBG("%s", hdev->name);
2069
2070 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02002071
2072 hci_dev_lock(hdev);
2073
2074 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002075
2076 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
2077 goto check_auth;
2078
2079 if (ev->status == 0)
2080 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002081 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02002082 else
2083 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2084
2085check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07002086 if (!conn)
2087 goto unlock;
2088
2089 if (!hci_outgoing_auth_needed(hdev, conn))
2090 goto unlock;
2091
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002092 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002093 struct hci_cp_auth_requested cp;
2094 cp.handle = __cpu_to_le16(conn->handle);
2095 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2096 }
2097
Johan Hedberg79c6c702011-04-28 11:28:55 -07002098unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02002099 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002100}
2101
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002102static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002103{
2104 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2105 struct hci_conn *conn;
2106
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002107 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002108
2109 hci_dev_lock(hdev);
2110
2111 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2112 if (conn) {
2113 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02002114 if (ev->encrypt) {
2115 /* Encryption implies authentication */
2116 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002117 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03002118 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02002119 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002120 conn->link_mode &= ~HCI_LM_ENCRYPT;
2121 }
2122
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002123 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002124
Gustavo Padovana7d77232012-05-13 03:20:07 -03002125 if (ev->status && conn->state == BT_CONNECTED) {
Gustavo Padovand839c812012-05-16 12:17:12 -03002126 hci_acl_disconn(conn, HCI_ERROR_AUTH_FAILURE);
Gustavo Padovana7d77232012-05-13 03:20:07 -03002127 hci_conn_put(conn);
2128 goto unlock;
2129 }
2130
Marcel Holtmannf8558552008-07-14 20:13:49 +02002131 if (conn->state == BT_CONFIG) {
2132 if (!ev->status)
2133 conn->state = BT_CONNECTED;
2134
2135 hci_proto_connect_cfm(conn, ev->status);
2136 hci_conn_put(conn);
2137 } else
2138 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002139 }
2140
Gustavo Padovana7d77232012-05-13 03:20:07 -03002141unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002142 hci_dev_unlock(hdev);
2143}
2144
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002145static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2146 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002147{
2148 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2149 struct hci_conn *conn;
2150
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002151 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002152
2153 hci_dev_lock(hdev);
2154
2155 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2156 if (conn) {
2157 if (!ev->status)
2158 conn->link_mode |= HCI_LM_SECURE;
2159
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002160 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002161
2162 hci_key_change_cfm(conn, ev->status);
2163 }
2164
2165 hci_dev_unlock(hdev);
2166}
2167
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002168static void hci_remote_features_evt(struct hci_dev *hdev,
2169 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002170{
2171 struct hci_ev_remote_features *ev = (void *) skb->data;
2172 struct hci_conn *conn;
2173
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002174 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002175
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002176 hci_dev_lock(hdev);
2177
2178 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002179 if (!conn)
2180 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002181
Johan Hedbergccd556f2010-11-10 17:11:51 +02002182 if (!ev->status)
2183 memcpy(conn->features, ev->features, 8);
2184
2185 if (conn->state != BT_CONFIG)
2186 goto unlock;
2187
2188 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2189 struct hci_cp_read_remote_ext_features cp;
2190 cp.handle = ev->handle;
2191 cp.page = 0x01;
2192 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002193 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002194 goto unlock;
2195 }
2196
Johan Hedberg671267b2012-05-12 16:11:50 -03002197 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002198 struct hci_cp_remote_name_req cp;
2199 memset(&cp, 0, sizeof(cp));
2200 bacpy(&cp.bdaddr, &conn->dst);
2201 cp.pscan_rep_mode = 0x02;
2202 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002203 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2204 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002205 conn->dst_type, 0, NULL, 0,
2206 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002207
Johan Hedberg127178d2010-11-18 22:22:29 +02002208 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002209 conn->state = BT_CONNECTED;
2210 hci_proto_connect_cfm(conn, ev->status);
2211 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002212 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002213
Johan Hedbergccd556f2010-11-10 17:11:51 +02002214unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002215 hci_dev_unlock(hdev);
2216}
2217
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002218static void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002219{
2220 BT_DBG("%s", hdev->name);
2221}
2222
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002223static void hci_qos_setup_complete_evt(struct hci_dev *hdev,
2224 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002225{
2226 BT_DBG("%s", hdev->name);
2227}
2228
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002229static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002230{
2231 struct hci_ev_cmd_complete *ev = (void *) skb->data;
2232 __u16 opcode;
2233
2234 skb_pull(skb, sizeof(*ev));
2235
2236 opcode = __le16_to_cpu(ev->opcode);
2237
2238 switch (opcode) {
2239 case HCI_OP_INQUIRY_CANCEL:
2240 hci_cc_inquiry_cancel(hdev, skb);
2241 break;
2242
Andre Guedes4d934832012-03-21 00:03:35 -03002243 case HCI_OP_PERIODIC_INQ:
2244 hci_cc_periodic_inq(hdev, skb);
2245 break;
2246
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002247 case HCI_OP_EXIT_PERIODIC_INQ:
2248 hci_cc_exit_periodic_inq(hdev, skb);
2249 break;
2250
2251 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2252 hci_cc_remote_name_req_cancel(hdev, skb);
2253 break;
2254
2255 case HCI_OP_ROLE_DISCOVERY:
2256 hci_cc_role_discovery(hdev, skb);
2257 break;
2258
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002259 case HCI_OP_READ_LINK_POLICY:
2260 hci_cc_read_link_policy(hdev, skb);
2261 break;
2262
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002263 case HCI_OP_WRITE_LINK_POLICY:
2264 hci_cc_write_link_policy(hdev, skb);
2265 break;
2266
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002267 case HCI_OP_READ_DEF_LINK_POLICY:
2268 hci_cc_read_def_link_policy(hdev, skb);
2269 break;
2270
2271 case HCI_OP_WRITE_DEF_LINK_POLICY:
2272 hci_cc_write_def_link_policy(hdev, skb);
2273 break;
2274
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002275 case HCI_OP_RESET:
2276 hci_cc_reset(hdev, skb);
2277 break;
2278
2279 case HCI_OP_WRITE_LOCAL_NAME:
2280 hci_cc_write_local_name(hdev, skb);
2281 break;
2282
2283 case HCI_OP_READ_LOCAL_NAME:
2284 hci_cc_read_local_name(hdev, skb);
2285 break;
2286
2287 case HCI_OP_WRITE_AUTH_ENABLE:
2288 hci_cc_write_auth_enable(hdev, skb);
2289 break;
2290
2291 case HCI_OP_WRITE_ENCRYPT_MODE:
2292 hci_cc_write_encrypt_mode(hdev, skb);
2293 break;
2294
2295 case HCI_OP_WRITE_SCAN_ENABLE:
2296 hci_cc_write_scan_enable(hdev, skb);
2297 break;
2298
2299 case HCI_OP_READ_CLASS_OF_DEV:
2300 hci_cc_read_class_of_dev(hdev, skb);
2301 break;
2302
2303 case HCI_OP_WRITE_CLASS_OF_DEV:
2304 hci_cc_write_class_of_dev(hdev, skb);
2305 break;
2306
2307 case HCI_OP_READ_VOICE_SETTING:
2308 hci_cc_read_voice_setting(hdev, skb);
2309 break;
2310
2311 case HCI_OP_WRITE_VOICE_SETTING:
2312 hci_cc_write_voice_setting(hdev, skb);
2313 break;
2314
2315 case HCI_OP_HOST_BUFFER_SIZE:
2316 hci_cc_host_buffer_size(hdev, skb);
2317 break;
2318
Marcel Holtmann333140b2008-07-14 20:13:48 +02002319 case HCI_OP_WRITE_SSP_MODE:
2320 hci_cc_write_ssp_mode(hdev, skb);
2321 break;
2322
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002323 case HCI_OP_READ_LOCAL_VERSION:
2324 hci_cc_read_local_version(hdev, skb);
2325 break;
2326
2327 case HCI_OP_READ_LOCAL_COMMANDS:
2328 hci_cc_read_local_commands(hdev, skb);
2329 break;
2330
2331 case HCI_OP_READ_LOCAL_FEATURES:
2332 hci_cc_read_local_features(hdev, skb);
2333 break;
2334
Andre Guedes971e3a42011-06-30 19:20:52 -03002335 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2336 hci_cc_read_local_ext_features(hdev, skb);
2337 break;
2338
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002339 case HCI_OP_READ_BUFFER_SIZE:
2340 hci_cc_read_buffer_size(hdev, skb);
2341 break;
2342
2343 case HCI_OP_READ_BD_ADDR:
2344 hci_cc_read_bd_addr(hdev, skb);
2345 break;
2346
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002347 case HCI_OP_READ_DATA_BLOCK_SIZE:
2348 hci_cc_read_data_block_size(hdev, skb);
2349 break;
2350
Johan Hedberg23bb5762010-12-21 23:01:27 +02002351 case HCI_OP_WRITE_CA_TIMEOUT:
2352 hci_cc_write_ca_timeout(hdev, skb);
2353 break;
2354
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002355 case HCI_OP_READ_FLOW_CONTROL_MODE:
2356 hci_cc_read_flow_control_mode(hdev, skb);
2357 break;
2358
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002359 case HCI_OP_READ_LOCAL_AMP_INFO:
2360 hci_cc_read_local_amp_info(hdev, skb);
2361 break;
2362
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002363 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2364 hci_cc_read_local_amp_assoc(hdev, skb);
2365 break;
2366
Johan Hedbergb0916ea2011-01-10 13:44:55 +02002367 case HCI_OP_DELETE_STORED_LINK_KEY:
2368 hci_cc_delete_stored_link_key(hdev, skb);
2369 break;
2370
Johan Hedbergd5859e22011-01-25 01:19:58 +02002371 case HCI_OP_SET_EVENT_MASK:
2372 hci_cc_set_event_mask(hdev, skb);
2373 break;
2374
2375 case HCI_OP_WRITE_INQUIRY_MODE:
2376 hci_cc_write_inquiry_mode(hdev, skb);
2377 break;
2378
2379 case HCI_OP_READ_INQ_RSP_TX_POWER:
2380 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2381 break;
2382
2383 case HCI_OP_SET_EVENT_FLT:
2384 hci_cc_set_event_flt(hdev, skb);
2385 break;
2386
Johan Hedberg980e1a52011-01-22 06:10:07 +02002387 case HCI_OP_PIN_CODE_REPLY:
2388 hci_cc_pin_code_reply(hdev, skb);
2389 break;
2390
2391 case HCI_OP_PIN_CODE_NEG_REPLY:
2392 hci_cc_pin_code_neg_reply(hdev, skb);
2393 break;
2394
Szymon Jancc35938b2011-03-22 13:12:21 +01002395 case HCI_OP_READ_LOCAL_OOB_DATA:
2396 hci_cc_read_local_oob_data_reply(hdev, skb);
2397 break;
2398
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002399 case HCI_OP_LE_READ_BUFFER_SIZE:
2400 hci_cc_le_read_buffer_size(hdev, skb);
2401 break;
2402
Johan Hedberga5c29682011-02-19 12:05:57 -03002403 case HCI_OP_USER_CONFIRM_REPLY:
2404 hci_cc_user_confirm_reply(hdev, skb);
2405 break;
2406
2407 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2408 hci_cc_user_confirm_neg_reply(hdev, skb);
2409 break;
2410
Brian Gix1143d452011-11-23 08:28:34 -08002411 case HCI_OP_USER_PASSKEY_REPLY:
2412 hci_cc_user_passkey_reply(hdev, skb);
2413 break;
2414
2415 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2416 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002417 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002418
2419 case HCI_OP_LE_SET_SCAN_PARAM:
2420 hci_cc_le_set_scan_param(hdev, skb);
Brian Gix1143d452011-11-23 08:28:34 -08002421 break;
2422
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002423 case HCI_OP_LE_SET_SCAN_ENABLE:
2424 hci_cc_le_set_scan_enable(hdev, skb);
2425 break;
2426
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002427 case HCI_OP_LE_LTK_REPLY:
2428 hci_cc_le_ltk_reply(hdev, skb);
2429 break;
2430
2431 case HCI_OP_LE_LTK_NEG_REPLY:
2432 hci_cc_le_ltk_neg_reply(hdev, skb);
2433 break;
2434
Andre Guedesf9b49302011-06-30 19:20:53 -03002435 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2436 hci_cc_write_le_host_supported(hdev, skb);
2437 break;
2438
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002439 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002440 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002441 break;
2442 }
2443
Ville Tervo6bd32322011-02-16 16:32:41 +02002444 if (ev->opcode != HCI_OP_NOP)
2445 del_timer(&hdev->cmd_timer);
2446
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002447 if (ev->ncmd) {
2448 atomic_set(&hdev->cmd_cnt, 1);
2449 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002450 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002451 }
2452}
2453
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002454static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002455{
2456 struct hci_ev_cmd_status *ev = (void *) skb->data;
2457 __u16 opcode;
2458
2459 skb_pull(skb, sizeof(*ev));
2460
2461 opcode = __le16_to_cpu(ev->opcode);
2462
2463 switch (opcode) {
2464 case HCI_OP_INQUIRY:
2465 hci_cs_inquiry(hdev, ev->status);
2466 break;
2467
2468 case HCI_OP_CREATE_CONN:
2469 hci_cs_create_conn(hdev, ev->status);
2470 break;
2471
2472 case HCI_OP_ADD_SCO:
2473 hci_cs_add_sco(hdev, ev->status);
2474 break;
2475
Marcel Holtmannf8558552008-07-14 20:13:49 +02002476 case HCI_OP_AUTH_REQUESTED:
2477 hci_cs_auth_requested(hdev, ev->status);
2478 break;
2479
2480 case HCI_OP_SET_CONN_ENCRYPT:
2481 hci_cs_set_conn_encrypt(hdev, ev->status);
2482 break;
2483
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002484 case HCI_OP_REMOTE_NAME_REQ:
2485 hci_cs_remote_name_req(hdev, ev->status);
2486 break;
2487
Marcel Holtmann769be972008-07-14 20:13:49 +02002488 case HCI_OP_READ_REMOTE_FEATURES:
2489 hci_cs_read_remote_features(hdev, ev->status);
2490 break;
2491
2492 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2493 hci_cs_read_remote_ext_features(hdev, ev->status);
2494 break;
2495
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002496 case HCI_OP_SETUP_SYNC_CONN:
2497 hci_cs_setup_sync_conn(hdev, ev->status);
2498 break;
2499
2500 case HCI_OP_SNIFF_MODE:
2501 hci_cs_sniff_mode(hdev, ev->status);
2502 break;
2503
2504 case HCI_OP_EXIT_SNIFF_MODE:
2505 hci_cs_exit_sniff_mode(hdev, ev->status);
2506 break;
2507
Johan Hedberg8962ee72011-01-20 12:40:27 +02002508 case HCI_OP_DISCONNECT:
Johan Hedberg88c3df12012-02-09 14:27:38 +02002509 hci_cs_disconnect(hdev, ev->status);
Johan Hedberg8962ee72011-01-20 12:40:27 +02002510 break;
2511
Ville Tervofcd89c02011-02-10 22:38:47 -03002512 case HCI_OP_LE_CREATE_CONN:
2513 hci_cs_le_create_conn(hdev, ev->status);
2514 break;
2515
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002516 case HCI_OP_LE_START_ENC:
2517 hci_cs_le_start_enc(hdev, ev->status);
2518 break;
2519
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03002520 case HCI_OP_CREATE_PHY_LINK:
2521 hci_cs_create_phylink(hdev, ev->status);
2522 break;
2523
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002524 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002525 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002526 break;
2527 }
2528
Ville Tervo6bd32322011-02-16 16:32:41 +02002529 if (ev->opcode != HCI_OP_NOP)
2530 del_timer(&hdev->cmd_timer);
2531
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002532 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002533 atomic_set(&hdev->cmd_cnt, 1);
2534 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002535 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002536 }
2537}
2538
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002539static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002540{
2541 struct hci_ev_role_change *ev = (void *) skb->data;
2542 struct hci_conn *conn;
2543
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002544 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002545
2546 hci_dev_lock(hdev);
2547
2548 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2549 if (conn) {
2550 if (!ev->status) {
2551 if (ev->role)
2552 conn->link_mode &= ~HCI_LM_MASTER;
2553 else
2554 conn->link_mode |= HCI_LM_MASTER;
2555 }
2556
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002557 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002558
2559 hci_role_switch_cfm(conn, ev->status, ev->role);
2560 }
2561
2562 hci_dev_unlock(hdev);
2563}
2564
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002565static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002566{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002567 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002568 int i;
2569
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02002570 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2571 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2572 return;
2573 }
2574
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002575 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002576 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002577 BT_DBG("%s bad parameters", hdev->name);
2578 return;
2579 }
2580
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002581 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2582
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002583 for (i = 0; i < ev->num_hndl; i++) {
2584 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002585 struct hci_conn *conn;
2586 __u16 handle, count;
2587
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002588 handle = __le16_to_cpu(info->handle);
2589 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002590
2591 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002592 if (!conn)
2593 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002594
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002595 conn->sent -= count;
2596
2597 switch (conn->type) {
2598 case ACL_LINK:
2599 hdev->acl_cnt += count;
2600 if (hdev->acl_cnt > hdev->acl_pkts)
2601 hdev->acl_cnt = hdev->acl_pkts;
2602 break;
2603
2604 case LE_LINK:
2605 if (hdev->le_pkts) {
2606 hdev->le_cnt += count;
2607 if (hdev->le_cnt > hdev->le_pkts)
2608 hdev->le_cnt = hdev->le_pkts;
2609 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002610 hdev->acl_cnt += count;
2611 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002612 hdev->acl_cnt = hdev->acl_pkts;
2613 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002614 break;
2615
2616 case SCO_LINK:
2617 hdev->sco_cnt += count;
2618 if (hdev->sco_cnt > hdev->sco_pkts)
2619 hdev->sco_cnt = hdev->sco_pkts;
2620 break;
2621
2622 default:
2623 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2624 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002625 }
2626 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002627
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02002628 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002629}
2630
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002631static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002632{
2633 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2634 int i;
2635
2636 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2637 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2638 return;
2639 }
2640
2641 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002642 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002643 BT_DBG("%s bad parameters", hdev->name);
2644 return;
2645 }
2646
2647 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002648 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002649
2650 for (i = 0; i < ev->num_hndl; i++) {
2651 struct hci_comp_blocks_info *info = &ev->handles[i];
2652 struct hci_conn *conn;
2653 __u16 handle, block_count;
2654
2655 handle = __le16_to_cpu(info->handle);
2656 block_count = __le16_to_cpu(info->blocks);
2657
2658 conn = hci_conn_hash_lookup_handle(hdev, handle);
2659 if (!conn)
2660 continue;
2661
2662 conn->sent -= block_count;
2663
2664 switch (conn->type) {
2665 case ACL_LINK:
2666 hdev->block_cnt += block_count;
2667 if (hdev->block_cnt > hdev->num_blocks)
2668 hdev->block_cnt = hdev->num_blocks;
2669 break;
2670
2671 default:
2672 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2673 break;
2674 }
2675 }
2676
2677 queue_work(hdev->workqueue, &hdev->tx_work);
2678}
2679
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002680static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002681{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002682 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002683 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002684
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002685 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002686
2687 hci_dev_lock(hdev);
2688
Marcel Holtmann04837f62006-07-03 10:02:33 +02002689 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2690 if (conn) {
2691 conn->mode = ev->mode;
2692 conn->interval = __le16_to_cpu(ev->interval);
2693
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002694 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2695 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02002696 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002697 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002698 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02002699 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002700 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002701
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002702 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002703 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002704 }
2705
2706 hci_dev_unlock(hdev);
2707}
2708
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002709static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002710{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002711 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2712 struct hci_conn *conn;
2713
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002714 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002715
2716 hci_dev_lock(hdev);
2717
2718 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002719 if (!conn)
2720 goto unlock;
2721
2722 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002723 hci_conn_hold(conn);
2724 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2725 hci_conn_put(conn);
2726 }
2727
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002728 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02002729 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002730 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002731 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002732 u8 secure;
2733
2734 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2735 secure = 1;
2736 else
2737 secure = 0;
2738
Johan Hedberg744cf192011-11-08 20:40:14 +02002739 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002740 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002741
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002742unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002743 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002744}
2745
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002746static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002747{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002748 struct hci_ev_link_key_req *ev = (void *) skb->data;
2749 struct hci_cp_link_key_reply cp;
2750 struct hci_conn *conn;
2751 struct link_key *key;
2752
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002753 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002754
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002755 if (!test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002756 return;
2757
2758 hci_dev_lock(hdev);
2759
2760 key = hci_find_link_key(hdev, &ev->bdaddr);
2761 if (!key) {
2762 BT_DBG("%s link key not found for %s", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002763 batostr(&ev->bdaddr));
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002764 goto not_found;
2765 }
2766
2767 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002768 batostr(&ev->bdaddr));
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002769
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002770 if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002771 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002772 BT_DBG("%s ignoring debug key", hdev->name);
2773 goto not_found;
2774 }
2775
2776 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002777 if (conn) {
2778 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002779 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002780 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2781 goto not_found;
2782 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002783
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002784 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002785 conn->pending_sec_level == BT_SECURITY_HIGH) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002786 BT_DBG("%s ignoring key unauthenticated for high security",
2787 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002788 goto not_found;
2789 }
2790
2791 conn->key_type = key->type;
2792 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002793 }
2794
2795 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03002796 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002797
2798 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2799
2800 hci_dev_unlock(hdev);
2801
2802 return;
2803
2804not_found:
2805 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2806 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002807}
2808
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002809static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002810{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002811 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2812 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002813 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002814
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002815 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002816
2817 hci_dev_lock(hdev);
2818
2819 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2820 if (conn) {
2821 hci_conn_hold(conn);
2822 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002823 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002824
2825 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2826 conn->key_type = ev->key_type;
2827
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002828 hci_conn_put(conn);
2829 }
2830
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002831 if (test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002832 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002833 ev->key_type, pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002834
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002835 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002836}
2837
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002838static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02002839{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002840 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002841 struct hci_conn *conn;
2842
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002843 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002844
2845 hci_dev_lock(hdev);
2846
2847 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002848 if (conn && !ev->status) {
2849 struct inquiry_entry *ie;
2850
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002851 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2852 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002853 ie->data.clock_offset = ev->clock_offset;
2854 ie->timestamp = jiffies;
2855 }
2856 }
2857
2858 hci_dev_unlock(hdev);
2859}
2860
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002861static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02002862{
2863 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2864 struct hci_conn *conn;
2865
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002866 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02002867
2868 hci_dev_lock(hdev);
2869
2870 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2871 if (conn && !ev->status)
2872 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2873
2874 hci_dev_unlock(hdev);
2875}
2876
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002877static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002878{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002879 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002880 struct inquiry_entry *ie;
2881
2882 BT_DBG("%s", hdev->name);
2883
2884 hci_dev_lock(hdev);
2885
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002886 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2887 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002888 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2889 ie->timestamp = jiffies;
2890 }
2891
2892 hci_dev_unlock(hdev);
2893}
2894
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002895static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
2896 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002897{
2898 struct inquiry_data data;
2899 int num_rsp = *((__u8 *) skb->data);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002900 bool name_known, ssp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002901
2902 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2903
2904 if (!num_rsp)
2905 return;
2906
Andre Guedes1519cc12012-03-21 00:03:38 -03002907 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2908 return;
2909
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002910 hci_dev_lock(hdev);
2911
2912 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002913 struct inquiry_info_with_rssi_and_pscan_mode *info;
2914 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002915
Johan Hedberge17acd42011-03-30 23:57:16 +03002916 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002917 bacpy(&data.bdaddr, &info->bdaddr);
2918 data.pscan_rep_mode = info->pscan_rep_mode;
2919 data.pscan_period_mode = info->pscan_period_mode;
2920 data.pscan_mode = info->pscan_mode;
2921 memcpy(data.dev_class, info->dev_class, 3);
2922 data.clock_offset = info->clock_offset;
2923 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002924 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002925
2926 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002927 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002928 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002929 info->dev_class, info->rssi,
2930 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002931 }
2932 } else {
2933 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2934
Johan Hedberge17acd42011-03-30 23:57:16 +03002935 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002936 bacpy(&data.bdaddr, &info->bdaddr);
2937 data.pscan_rep_mode = info->pscan_rep_mode;
2938 data.pscan_period_mode = info->pscan_period_mode;
2939 data.pscan_mode = 0x00;
2940 memcpy(data.dev_class, info->dev_class, 3);
2941 data.clock_offset = info->clock_offset;
2942 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002943 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002944 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002945 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002946 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002947 info->dev_class, info->rssi,
2948 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002949 }
2950 }
2951
2952 hci_dev_unlock(hdev);
2953}
2954
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002955static void hci_remote_ext_features_evt(struct hci_dev *hdev,
2956 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002957{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002958 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2959 struct hci_conn *conn;
2960
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002961 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002962
Marcel Holtmann41a96212008-07-14 20:13:48 +02002963 hci_dev_lock(hdev);
2964
2965 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002966 if (!conn)
2967 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002968
Johan Hedbergccd556f2010-11-10 17:11:51 +02002969 if (!ev->status && ev->page == 0x01) {
2970 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002971
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002972 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2973 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02002974 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02002975
Johan Hedberg02b7cc62012-02-28 02:28:43 +02002976 if (ev->features[0] & LMP_HOST_SSP)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002977 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002978 }
2979
Johan Hedbergccd556f2010-11-10 17:11:51 +02002980 if (conn->state != BT_CONFIG)
2981 goto unlock;
2982
Johan Hedberg671267b2012-05-12 16:11:50 -03002983 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002984 struct hci_cp_remote_name_req cp;
2985 memset(&cp, 0, sizeof(cp));
2986 bacpy(&cp.bdaddr, &conn->dst);
2987 cp.pscan_rep_mode = 0x02;
2988 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002989 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2990 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002991 conn->dst_type, 0, NULL, 0,
2992 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002993
Johan Hedberg127178d2010-11-18 22:22:29 +02002994 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002995 conn->state = BT_CONNECTED;
2996 hci_proto_connect_cfm(conn, ev->status);
2997 hci_conn_put(conn);
2998 }
2999
3000unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02003001 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003002}
3003
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003004static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3005 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003006{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003007 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3008 struct hci_conn *conn;
3009
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003010 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003011
3012 hci_dev_lock(hdev);
3013
3014 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003015 if (!conn) {
3016 if (ev->link_type == ESCO_LINK)
3017 goto unlock;
3018
3019 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3020 if (!conn)
3021 goto unlock;
3022
3023 conn->type = SCO_LINK;
3024 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003025
Marcel Holtmann732547f2009-04-19 19:14:14 +02003026 switch (ev->status) {
3027 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003028 conn->handle = __le16_to_cpu(ev->handle);
3029 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003030
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07003031 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003032 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02003033 break;
3034
Stephen Coe705e5712010-02-16 11:29:44 -05003035 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003036 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08003037 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003038 case 0x1f: /* Unspecified error */
3039 if (conn->out && conn->attempt < 2) {
3040 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3041 (hdev->esco_type & EDR_ESCO_MASK);
3042 hci_setup_sync(conn, conn->link->handle);
3043 goto unlock;
3044 }
3045 /* fall through */
3046
3047 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003048 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003049 break;
3050 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003051
3052 hci_proto_connect_cfm(conn, ev->status);
3053 if (ev->status)
3054 hci_conn_del(conn);
3055
3056unlock:
3057 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003058}
3059
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003060static void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003061{
3062 BT_DBG("%s", hdev->name);
3063}
3064
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003065static void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02003066{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003067 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003068
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003069 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003070}
3071
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003072static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3073 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003074{
3075 struct inquiry_data data;
3076 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3077 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303078 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003079
3080 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3081
3082 if (!num_rsp)
3083 return;
3084
Andre Guedes1519cc12012-03-21 00:03:38 -03003085 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3086 return;
3087
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003088 hci_dev_lock(hdev);
3089
Johan Hedberge17acd42011-03-30 23:57:16 +03003090 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003091 bool name_known, ssp;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003092
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003093 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01003094 data.pscan_rep_mode = info->pscan_rep_mode;
3095 data.pscan_period_mode = info->pscan_period_mode;
3096 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003097 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01003098 data.clock_offset = info->clock_offset;
3099 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003100 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003101
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003102 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02003103 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003104 sizeof(info->data),
3105 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02003106 else
3107 name_known = true;
3108
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003109 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003110 &ssp);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303111 eir_len = eir_get_length(info->data, sizeof(info->data));
Johan Hedberg48264f02011-11-09 13:58:58 +02003112 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003113 info->dev_class, info->rssi, !name_known,
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303114 ssp, info->data, eir_len);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003115 }
3116
3117 hci_dev_unlock(hdev);
3118}
3119
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003120static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3121 struct sk_buff *skb)
3122{
3123 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3124 struct hci_conn *conn;
3125
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003126 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003127 __le16_to_cpu(ev->handle));
3128
3129 hci_dev_lock(hdev);
3130
3131 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3132 if (!conn)
3133 goto unlock;
3134
3135 if (!ev->status)
3136 conn->sec_level = conn->pending_sec_level;
3137
3138 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3139
3140 if (ev->status && conn->state == BT_CONNECTED) {
3141 hci_acl_disconn(conn, HCI_ERROR_AUTH_FAILURE);
3142 hci_conn_put(conn);
3143 goto unlock;
3144 }
3145
3146 if (conn->state == BT_CONFIG) {
3147 if (!ev->status)
3148 conn->state = BT_CONNECTED;
3149
3150 hci_proto_connect_cfm(conn, ev->status);
3151 hci_conn_put(conn);
3152 } else {
3153 hci_auth_cfm(conn, ev->status);
3154
3155 hci_conn_hold(conn);
3156 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
3157 hci_conn_put(conn);
3158 }
3159
3160unlock:
3161 hci_dev_unlock(hdev);
3162}
3163
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003164static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003165{
3166 /* If remote requests dedicated bonding follow that lead */
3167 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
3168 /* If both remote and local IO capabilities allow MITM
3169 * protection then require it, otherwise don't */
3170 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
3171 return 0x02;
3172 else
3173 return 0x03;
3174 }
3175
3176 /* If remote requests no-bonding follow that lead */
3177 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003178 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003179
3180 return conn->auth_type;
3181}
3182
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003183static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003184{
3185 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3186 struct hci_conn *conn;
3187
3188 BT_DBG("%s", hdev->name);
3189
3190 hci_dev_lock(hdev);
3191
3192 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003193 if (!conn)
3194 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003195
Johan Hedberg03b555e2011-01-04 15:40:05 +02003196 hci_conn_hold(conn);
3197
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003198 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003199 goto unlock;
3200
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003201 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003202 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003203 struct hci_cp_io_capability_reply cp;
3204
3205 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303206 /* Change the IO capability from KeyboardDisplay
3207 * to DisplayYesNo as it is not supported by BT spec. */
3208 cp.capability = (conn->io_capability == 0x04) ?
3209 0x01 : conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07003210 conn->auth_type = hci_get_auth_req(conn);
3211 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003212
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003213 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3214 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
Szymon Jancce85ee12011-03-22 13:12:23 +01003215 cp.oob_data = 0x01;
3216 else
3217 cp.oob_data = 0x00;
3218
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003219 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003220 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003221 } else {
3222 struct hci_cp_io_capability_neg_reply cp;
3223
3224 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02003225 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003226
3227 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003228 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003229 }
3230
3231unlock:
3232 hci_dev_unlock(hdev);
3233}
3234
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003235static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02003236{
3237 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3238 struct hci_conn *conn;
3239
3240 BT_DBG("%s", hdev->name);
3241
3242 hci_dev_lock(hdev);
3243
3244 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3245 if (!conn)
3246 goto unlock;
3247
Johan Hedberg03b555e2011-01-04 15:40:05 +02003248 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003249 conn->remote_auth = ev->authentication;
Johan Hedberg58a681e2012-01-16 06:47:28 +02003250 if (ev->oob_data)
3251 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003252
3253unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003254 hci_dev_unlock(hdev);
3255}
3256
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003257static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3258 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003259{
3260 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003261 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07003262 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03003263
3264 BT_DBG("%s", hdev->name);
3265
3266 hci_dev_lock(hdev);
3267
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003268 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg7a828902011-04-28 11:28:53 -07003269 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03003270
Johan Hedberg7a828902011-04-28 11:28:53 -07003271 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3272 if (!conn)
3273 goto unlock;
3274
3275 loc_mitm = (conn->auth_type & 0x01);
3276 rem_mitm = (conn->remote_auth & 0x01);
3277
3278 /* If we require MITM but the remote device can't provide that
3279 * (it has NoInputNoOutput) then reject the confirmation
3280 * request. The only exception is when we're dedicated bonding
3281 * initiators (connect_cfm_cb set) since then we always have the MITM
3282 * bit set. */
3283 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
3284 BT_DBG("Rejecting request: remote device can't provide MITM");
3285 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003286 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003287 goto unlock;
3288 }
3289
3290 /* If no side requires MITM protection; auto-accept */
3291 if ((!loc_mitm || conn->remote_cap == 0x03) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003292 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003293
3294 /* If we're not the initiators request authorization to
3295 * proceed from user space (mgmt_user_confirm with
3296 * confirm_hint set to 1). */
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003297 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003298 BT_DBG("Confirming auto-accept as acceptor");
3299 confirm_hint = 1;
3300 goto confirm;
3301 }
3302
Johan Hedberg9f616562011-04-28 11:28:54 -07003303 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03003304 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003305
3306 if (hdev->auto_accept_delay > 0) {
3307 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
3308 mod_timer(&conn->auto_accept_timer, jiffies + delay);
3309 goto unlock;
3310 }
3311
Johan Hedberg7a828902011-04-28 11:28:53 -07003312 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003313 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003314 goto unlock;
3315 }
3316
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003317confirm:
Johan Hedberg272d90d2012-02-09 15:26:12 +02003318 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0, ev->passkey,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003319 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07003320
3321unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03003322 hci_dev_unlock(hdev);
3323}
3324
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003325static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3326 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08003327{
3328 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3329
3330 BT_DBG("%s", hdev->name);
3331
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003332 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02003333 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08003334}
3335
Johan Hedberg92a25252012-09-06 18:39:26 +03003336static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3337 struct sk_buff *skb)
3338{
3339 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3340 struct hci_conn *conn;
3341
3342 BT_DBG("%s", hdev->name);
3343
3344 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3345 if (!conn)
3346 return;
3347
3348 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3349 conn->passkey_entered = 0;
3350
3351 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3352 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3353 conn->dst_type, conn->passkey_notify,
3354 conn->passkey_entered);
3355}
3356
3357static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3358{
3359 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3360 struct hci_conn *conn;
3361
3362 BT_DBG("%s", hdev->name);
3363
3364 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3365 if (!conn)
3366 return;
3367
3368 switch (ev->type) {
3369 case HCI_KEYPRESS_STARTED:
3370 conn->passkey_entered = 0;
3371 return;
3372
3373 case HCI_KEYPRESS_ENTERED:
3374 conn->passkey_entered++;
3375 break;
3376
3377 case HCI_KEYPRESS_ERASED:
3378 conn->passkey_entered--;
3379 break;
3380
3381 case HCI_KEYPRESS_CLEARED:
3382 conn->passkey_entered = 0;
3383 break;
3384
3385 case HCI_KEYPRESS_COMPLETED:
3386 return;
3387 }
3388
3389 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3390 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3391 conn->dst_type, conn->passkey_notify,
3392 conn->passkey_entered);
3393}
3394
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003395static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3396 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003397{
3398 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3399 struct hci_conn *conn;
3400
3401 BT_DBG("%s", hdev->name);
3402
3403 hci_dev_lock(hdev);
3404
3405 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003406 if (!conn)
3407 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003408
Johan Hedberg2a611692011-02-19 12:06:00 -03003409 /* To avoid duplicate auth_failed events to user space we check
3410 * the HCI_CONN_AUTH_PEND flag which will be set if we
3411 * initiated the authentication. A traditional auth_complete
3412 * event gets always produced as initiator and is also mapped to
3413 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02003414 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003415 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003416 ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003417
3418 hci_conn_put(conn);
3419
3420unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003421 hci_dev_unlock(hdev);
3422}
3423
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003424static void hci_remote_host_features_evt(struct hci_dev *hdev,
3425 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003426{
3427 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3428 struct inquiry_entry *ie;
3429
3430 BT_DBG("%s", hdev->name);
3431
3432 hci_dev_lock(hdev);
3433
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003434 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3435 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003436 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003437
3438 hci_dev_unlock(hdev);
3439}
3440
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003441static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3442 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01003443{
3444 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3445 struct oob_data *data;
3446
3447 BT_DBG("%s", hdev->name);
3448
3449 hci_dev_lock(hdev);
3450
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003451 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Szymon Jance1ba1f12011-04-06 13:01:59 +02003452 goto unlock;
3453
Szymon Janc2763eda2011-03-22 13:12:22 +01003454 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3455 if (data) {
3456 struct hci_cp_remote_oob_data_reply cp;
3457
3458 bacpy(&cp.bdaddr, &ev->bdaddr);
3459 memcpy(cp.hash, data->hash, sizeof(cp.hash));
3460 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
3461
3462 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003463 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003464 } else {
3465 struct hci_cp_remote_oob_data_neg_reply cp;
3466
3467 bacpy(&cp.bdaddr, &ev->bdaddr);
3468 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003469 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003470 }
3471
Szymon Jance1ba1f12011-04-06 13:01:59 +02003472unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003473 hci_dev_unlock(hdev);
3474}
3475
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003476static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003477{
3478 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3479 struct hci_conn *conn;
3480
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003481 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003482
3483 hci_dev_lock(hdev);
3484
Andre Guedesb47a09b2012-07-27 15:10:15 -03003485 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03003486 if (!conn) {
3487 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
3488 if (!conn) {
3489 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03003490 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03003491 }
Andre Guedes29b79882011-05-31 14:20:54 -03003492
3493 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03003494
3495 if (ev->role == LE_CONN_ROLE_MASTER) {
3496 conn->out = true;
3497 conn->link_mode |= HCI_LM_MASTER;
3498 }
Ville Tervob62f3282011-02-10 22:38:50 -03003499 }
Ville Tervofcd89c02011-02-10 22:38:47 -03003500
Andre Guedescd17dec2012-07-27 15:10:16 -03003501 if (ev->status) {
3502 mgmt_connect_failed(hdev, &conn->dst, conn->type,
3503 conn->dst_type, ev->status);
3504 hci_proto_connect_cfm(conn, ev->status);
3505 conn->state = BT_CLOSED;
3506 hci_conn_del(conn);
3507 goto unlock;
3508 }
3509
Johan Hedbergb644ba32012-01-17 21:48:47 +02003510 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3511 mgmt_device_connected(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003512 conn->dst_type, 0, NULL, 0, NULL);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03003513
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03003514 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03003515 conn->handle = __le16_to_cpu(ev->handle);
3516 conn->state = BT_CONNECTED;
3517
3518 hci_conn_hold_device(conn);
3519 hci_conn_add_sysfs(conn);
3520
3521 hci_proto_connect_cfm(conn, ev->status);
3522
3523unlock:
3524 hci_dev_unlock(hdev);
3525}
3526
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003527static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03003528{
Andre Guedese95beb42011-09-26 20:48:35 -03003529 u8 num_reports = skb->data[0];
3530 void *ptr = &skb->data[1];
Andre Guedes3c9e9192012-01-10 18:20:50 -03003531 s8 rssi;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003532
3533 hci_dev_lock(hdev);
3534
Andre Guedese95beb42011-09-26 20:48:35 -03003535 while (num_reports--) {
3536 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003537
Andre Guedes3c9e9192012-01-10 18:20:50 -03003538 rssi = ev->data[ev->length];
3539 mgmt_device_found(hdev, &ev->bdaddr, LE_LINK, ev->bdaddr_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003540 NULL, rssi, 0, 1, ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03003541
Andre Guedese95beb42011-09-26 20:48:35 -03003542 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003543 }
3544
3545 hci_dev_unlock(hdev);
3546}
3547
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003548static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003549{
3550 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
3551 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003552 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003553 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003554 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003555
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003556 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003557
3558 hci_dev_lock(hdev);
3559
3560 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003561 if (conn == NULL)
3562 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003563
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003564 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
3565 if (ltk == NULL)
3566 goto not_found;
3567
3568 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003569 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003570
3571 if (ltk->authenticated)
3572 conn->sec_level = BT_SECURITY_HIGH;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003573
3574 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
3575
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003576 if (ltk->type & HCI_SMP_STK) {
3577 list_del(&ltk->list);
3578 kfree(ltk);
3579 }
3580
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003581 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003582
3583 return;
3584
3585not_found:
3586 neg.handle = ev->handle;
3587 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
3588 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003589}
3590
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003591static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003592{
3593 struct hci_ev_le_meta *le_ev = (void *) skb->data;
3594
3595 skb_pull(skb, sizeof(*le_ev));
3596
3597 switch (le_ev->subevent) {
3598 case HCI_EV_LE_CONN_COMPLETE:
3599 hci_le_conn_complete_evt(hdev, skb);
3600 break;
3601
Andre Guedes9aa04c92011-05-26 16:23:51 -03003602 case HCI_EV_LE_ADVERTISING_REPORT:
3603 hci_le_adv_report_evt(hdev, skb);
3604 break;
3605
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003606 case HCI_EV_LE_LTK_REQ:
3607 hci_le_ltk_request_evt(hdev, skb);
3608 break;
3609
Ville Tervofcd89c02011-02-10 22:38:47 -03003610 default:
3611 break;
3612 }
3613}
3614
Linus Torvalds1da177e2005-04-16 15:20:36 -07003615void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
3616{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003617 struct hci_event_hdr *hdr = (void *) skb->data;
3618 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003619
3620 skb_pull(skb, HCI_EVENT_HDR_SIZE);
3621
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003622 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003623 case HCI_EV_INQUIRY_COMPLETE:
3624 hci_inquiry_complete_evt(hdev, skb);
3625 break;
3626
3627 case HCI_EV_INQUIRY_RESULT:
3628 hci_inquiry_result_evt(hdev, skb);
3629 break;
3630
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003631 case HCI_EV_CONN_COMPLETE:
3632 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02003633 break;
3634
Linus Torvalds1da177e2005-04-16 15:20:36 -07003635 case HCI_EV_CONN_REQUEST:
3636 hci_conn_request_evt(hdev, skb);
3637 break;
3638
Linus Torvalds1da177e2005-04-16 15:20:36 -07003639 case HCI_EV_DISCONN_COMPLETE:
3640 hci_disconn_complete_evt(hdev, skb);
3641 break;
3642
Linus Torvalds1da177e2005-04-16 15:20:36 -07003643 case HCI_EV_AUTH_COMPLETE:
3644 hci_auth_complete_evt(hdev, skb);
3645 break;
3646
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003647 case HCI_EV_REMOTE_NAME:
3648 hci_remote_name_evt(hdev, skb);
3649 break;
3650
Linus Torvalds1da177e2005-04-16 15:20:36 -07003651 case HCI_EV_ENCRYPT_CHANGE:
3652 hci_encrypt_change_evt(hdev, skb);
3653 break;
3654
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003655 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3656 hci_change_link_key_complete_evt(hdev, skb);
3657 break;
3658
3659 case HCI_EV_REMOTE_FEATURES:
3660 hci_remote_features_evt(hdev, skb);
3661 break;
3662
3663 case HCI_EV_REMOTE_VERSION:
3664 hci_remote_version_evt(hdev, skb);
3665 break;
3666
3667 case HCI_EV_QOS_SETUP_COMPLETE:
3668 hci_qos_setup_complete_evt(hdev, skb);
3669 break;
3670
3671 case HCI_EV_CMD_COMPLETE:
3672 hci_cmd_complete_evt(hdev, skb);
3673 break;
3674
3675 case HCI_EV_CMD_STATUS:
3676 hci_cmd_status_evt(hdev, skb);
3677 break;
3678
3679 case HCI_EV_ROLE_CHANGE:
3680 hci_role_change_evt(hdev, skb);
3681 break;
3682
3683 case HCI_EV_NUM_COMP_PKTS:
3684 hci_num_comp_pkts_evt(hdev, skb);
3685 break;
3686
3687 case HCI_EV_MODE_CHANGE:
3688 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003689 break;
3690
3691 case HCI_EV_PIN_CODE_REQ:
3692 hci_pin_code_request_evt(hdev, skb);
3693 break;
3694
3695 case HCI_EV_LINK_KEY_REQ:
3696 hci_link_key_request_evt(hdev, skb);
3697 break;
3698
3699 case HCI_EV_LINK_KEY_NOTIFY:
3700 hci_link_key_notify_evt(hdev, skb);
3701 break;
3702
3703 case HCI_EV_CLOCK_OFFSET:
3704 hci_clock_offset_evt(hdev, skb);
3705 break;
3706
Marcel Holtmanna8746412008-07-14 20:13:46 +02003707 case HCI_EV_PKT_TYPE_CHANGE:
3708 hci_pkt_type_change_evt(hdev, skb);
3709 break;
3710
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003711 case HCI_EV_PSCAN_REP_MODE:
3712 hci_pscan_rep_mode_evt(hdev, skb);
3713 break;
3714
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003715 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3716 hci_inquiry_result_with_rssi_evt(hdev, skb);
3717 break;
3718
3719 case HCI_EV_REMOTE_EXT_FEATURES:
3720 hci_remote_ext_features_evt(hdev, skb);
3721 break;
3722
3723 case HCI_EV_SYNC_CONN_COMPLETE:
3724 hci_sync_conn_complete_evt(hdev, skb);
3725 break;
3726
3727 case HCI_EV_SYNC_CONN_CHANGED:
3728 hci_sync_conn_changed_evt(hdev, skb);
3729 break;
3730
Marcel Holtmann04837f62006-07-03 10:02:33 +02003731 case HCI_EV_SNIFF_SUBRATE:
3732 hci_sniff_subrate_evt(hdev, skb);
3733 break;
3734
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003735 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3736 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003737 break;
3738
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003739 case HCI_EV_KEY_REFRESH_COMPLETE:
3740 hci_key_refresh_complete_evt(hdev, skb);
3741 break;
3742
Marcel Holtmann04936842008-07-14 20:13:48 +02003743 case HCI_EV_IO_CAPA_REQUEST:
3744 hci_io_capa_request_evt(hdev, skb);
3745 break;
3746
Johan Hedberg03b555e2011-01-04 15:40:05 +02003747 case HCI_EV_IO_CAPA_REPLY:
3748 hci_io_capa_reply_evt(hdev, skb);
3749 break;
3750
Johan Hedberga5c29682011-02-19 12:05:57 -03003751 case HCI_EV_USER_CONFIRM_REQUEST:
3752 hci_user_confirm_request_evt(hdev, skb);
3753 break;
3754
Brian Gix1143d452011-11-23 08:28:34 -08003755 case HCI_EV_USER_PASSKEY_REQUEST:
3756 hci_user_passkey_request_evt(hdev, skb);
3757 break;
3758
Johan Hedberg92a25252012-09-06 18:39:26 +03003759 case HCI_EV_USER_PASSKEY_NOTIFY:
3760 hci_user_passkey_notify_evt(hdev, skb);
3761 break;
3762
3763 case HCI_EV_KEYPRESS_NOTIFY:
3764 hci_keypress_notify_evt(hdev, skb);
3765 break;
3766
Marcel Holtmann04936842008-07-14 20:13:48 +02003767 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3768 hci_simple_pair_complete_evt(hdev, skb);
3769 break;
3770
Marcel Holtmann41a96212008-07-14 20:13:48 +02003771 case HCI_EV_REMOTE_HOST_FEATURES:
3772 hci_remote_host_features_evt(hdev, skb);
3773 break;
3774
Ville Tervofcd89c02011-02-10 22:38:47 -03003775 case HCI_EV_LE_META:
3776 hci_le_meta_evt(hdev, skb);
3777 break;
3778
Szymon Janc2763eda2011-03-22 13:12:22 +01003779 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3780 hci_remote_oob_data_request_evt(hdev, skb);
3781 break;
3782
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003783 case HCI_EV_NUM_COMP_BLOCKS:
3784 hci_num_comp_blocks_evt(hdev, skb);
3785 break;
3786
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003787 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003788 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003789 break;
3790 }
3791
3792 kfree_skb(skb);
3793 hdev->stat.evt_rx++;
3794}