blob: 0b7ba1e39d45d4bd0e8aff1c748a6b169712b509 [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
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001218static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1219 struct sk_buff *skb)
1220{
1221 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1222
1223 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1224 hdev->name, rp->status, rp->phy_handle);
1225
1226 if (rp->status)
1227 return;
1228
1229 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1230}
1231
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001232static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001233{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001234 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001235
1236 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +02001237 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001238 hci_conn_check_pending(hdev);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001239 hci_dev_lock(hdev);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001240 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Andre Guedes7a135102011-11-09 17:14:25 -03001241 mgmt_start_discovery_failed(hdev, status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001242 hci_dev_unlock(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001243 return;
1244 }
1245
Andre Guedes89352e72011-11-04 14:16:53 -03001246 set_bit(HCI_INQUIRY, &hdev->flags);
1247
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001248 hci_dev_lock(hdev);
Andre Guedes343f9352012-02-17 20:39:37 -03001249 hci_discovery_set_state(hdev, DISCOVERY_FINDING);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001250 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001251}
1252
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001253static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001254{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001255 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001256 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001257
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001258 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001259
1260 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001261 if (!cp)
1262 return;
1263
1264 hci_dev_lock(hdev);
1265
1266 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1267
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001268 BT_DBG("%s bdaddr %s hcon %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001269
1270 if (status) {
1271 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001272 if (status != 0x0c || conn->attempt > 2) {
1273 conn->state = BT_CLOSED;
1274 hci_proto_connect_cfm(conn, status);
1275 hci_conn_del(conn);
1276 } else
1277 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001278 }
1279 } else {
1280 if (!conn) {
1281 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1282 if (conn) {
Johan Hedberga0c808b2012-01-16 09:49:58 +02001283 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001284 conn->link_mode |= HCI_LM_MASTER;
1285 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001286 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287 }
1288 }
1289
1290 hci_dev_unlock(hdev);
1291}
1292
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001293static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001295 struct hci_cp_add_sco *cp;
1296 struct hci_conn *acl, *sco;
1297 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001299 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001300
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001301 if (!status)
1302 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001303
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001304 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1305 if (!cp)
1306 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001307
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001308 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001309
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001310 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001311
1312 hci_dev_lock(hdev);
1313
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001314 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001315 if (acl) {
1316 sco = acl->link;
1317 if (sco) {
1318 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001319
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001320 hci_proto_connect_cfm(sco, status);
1321 hci_conn_del(sco);
1322 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001323 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001324
1325 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326}
1327
Marcel Holtmannf8558552008-07-14 20:13:49 +02001328static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1329{
1330 struct hci_cp_auth_requested *cp;
1331 struct hci_conn *conn;
1332
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001333 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001334
1335 if (!status)
1336 return;
1337
1338 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1339 if (!cp)
1340 return;
1341
1342 hci_dev_lock(hdev);
1343
1344 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1345 if (conn) {
1346 if (conn->state == BT_CONFIG) {
1347 hci_proto_connect_cfm(conn, status);
1348 hci_conn_put(conn);
1349 }
1350 }
1351
1352 hci_dev_unlock(hdev);
1353}
1354
1355static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1356{
1357 struct hci_cp_set_conn_encrypt *cp;
1358 struct hci_conn *conn;
1359
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001360 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001361
1362 if (!status)
1363 return;
1364
1365 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1366 if (!cp)
1367 return;
1368
1369 hci_dev_lock(hdev);
1370
1371 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1372 if (conn) {
1373 if (conn->state == BT_CONFIG) {
1374 hci_proto_connect_cfm(conn, status);
1375 hci_conn_put(conn);
1376 }
1377 }
1378
1379 hci_dev_unlock(hdev);
1380}
1381
Johan Hedberg127178d2010-11-18 22:22:29 +02001382static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001383 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001384{
Johan Hedberg392599b2010-11-18 22:22:28 +02001385 if (conn->state != BT_CONFIG || !conn->out)
1386 return 0;
1387
Johan Hedberg765c2a92011-01-19 12:06:52 +05301388 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001389 return 0;
1390
1391 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001392 * devices with sec_level HIGH or if MITM protection is requested */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001393 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
1394 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001395 return 0;
1396
Johan Hedberg392599b2010-11-18 22:22:28 +02001397 return 1;
1398}
1399
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001400static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001401 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001402{
1403 struct hci_cp_remote_name_req cp;
1404
1405 memset(&cp, 0, sizeof(cp));
1406
1407 bacpy(&cp.bdaddr, &e->data.bdaddr);
1408 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1409 cp.pscan_mode = e->data.pscan_mode;
1410 cp.clock_offset = e->data.clock_offset;
1411
1412 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1413}
1414
Johan Hedbergb644ba32012-01-17 21:48:47 +02001415static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001416{
1417 struct discovery_state *discov = &hdev->discovery;
1418 struct inquiry_entry *e;
1419
Johan Hedbergb644ba32012-01-17 21:48:47 +02001420 if (list_empty(&discov->resolve))
1421 return false;
1422
1423 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001424 if (!e)
1425 return false;
1426
Johan Hedbergb644ba32012-01-17 21:48:47 +02001427 if (hci_resolve_name(hdev, e) == 0) {
1428 e->name_state = NAME_PENDING;
1429 return true;
1430 }
1431
1432 return false;
1433}
1434
1435static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001436 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001437{
1438 struct discovery_state *discov = &hdev->discovery;
1439 struct inquiry_entry *e;
1440
1441 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001442 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1443 name_len, conn->dev_class);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001444
1445 if (discov->state == DISCOVERY_STOPPED)
1446 return;
1447
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001448 if (discov->state == DISCOVERY_STOPPING)
1449 goto discov_complete;
1450
1451 if (discov->state != DISCOVERY_RESOLVING)
1452 return;
1453
1454 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001455 /* If the device was not found in a list of found devices names of which
1456 * are pending. there is no need to continue resolving a next name as it
1457 * will be done upon receiving another Remote Name Request Complete
1458 * Event */
1459 if (!e)
1460 return;
1461
1462 list_del(&e->list);
1463 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001464 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001465 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1466 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001467 } else {
1468 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001469 }
1470
Johan Hedbergb644ba32012-01-17 21:48:47 +02001471 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001472 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001473
1474discov_complete:
1475 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1476}
1477
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001478static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1479{
Johan Hedberg127178d2010-11-18 22:22:29 +02001480 struct hci_cp_remote_name_req *cp;
1481 struct hci_conn *conn;
1482
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001483 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001484
1485 /* If successful wait for the name req complete event before
1486 * checking for the need to do authentication */
1487 if (!status)
1488 return;
1489
1490 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1491 if (!cp)
1492 return;
1493
1494 hci_dev_lock(hdev);
1495
1496 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001497
1498 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1499 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1500
Johan Hedberg79c6c702011-04-28 11:28:55 -07001501 if (!conn)
1502 goto unlock;
1503
1504 if (!hci_outgoing_auth_needed(hdev, conn))
1505 goto unlock;
1506
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001507 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001508 struct hci_cp_auth_requested cp;
1509 cp.handle = __cpu_to_le16(conn->handle);
1510 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1511 }
1512
Johan Hedberg79c6c702011-04-28 11:28:55 -07001513unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001514 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001515}
1516
Marcel Holtmann769be972008-07-14 20:13:49 +02001517static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1518{
1519 struct hci_cp_read_remote_features *cp;
1520 struct hci_conn *conn;
1521
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001522 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001523
1524 if (!status)
1525 return;
1526
1527 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1528 if (!cp)
1529 return;
1530
1531 hci_dev_lock(hdev);
1532
1533 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1534 if (conn) {
1535 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001536 hci_proto_connect_cfm(conn, status);
1537 hci_conn_put(conn);
1538 }
1539 }
1540
1541 hci_dev_unlock(hdev);
1542}
1543
1544static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1545{
1546 struct hci_cp_read_remote_ext_features *cp;
1547 struct hci_conn *conn;
1548
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001549 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001550
1551 if (!status)
1552 return;
1553
1554 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1555 if (!cp)
1556 return;
1557
1558 hci_dev_lock(hdev);
1559
1560 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1561 if (conn) {
1562 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001563 hci_proto_connect_cfm(conn, status);
1564 hci_conn_put(conn);
1565 }
1566 }
1567
1568 hci_dev_unlock(hdev);
1569}
1570
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001571static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1572{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001573 struct hci_cp_setup_sync_conn *cp;
1574 struct hci_conn *acl, *sco;
1575 __u16 handle;
1576
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001577 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001578
1579 if (!status)
1580 return;
1581
1582 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1583 if (!cp)
1584 return;
1585
1586 handle = __le16_to_cpu(cp->handle);
1587
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001588 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001589
1590 hci_dev_lock(hdev);
1591
1592 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001593 if (acl) {
1594 sco = acl->link;
1595 if (sco) {
1596 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001597
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001598 hci_proto_connect_cfm(sco, status);
1599 hci_conn_del(sco);
1600 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001601 }
1602
1603 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001604}
1605
1606static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1607{
1608 struct hci_cp_sniff_mode *cp;
1609 struct hci_conn *conn;
1610
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001611 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001612
1613 if (!status)
1614 return;
1615
1616 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1617 if (!cp)
1618 return;
1619
1620 hci_dev_lock(hdev);
1621
1622 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001623 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001624 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001625
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001626 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001627 hci_sco_setup(conn, status);
1628 }
1629
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001630 hci_dev_unlock(hdev);
1631}
1632
1633static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1634{
1635 struct hci_cp_exit_sniff_mode *cp;
1636 struct hci_conn *conn;
1637
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001638 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001639
1640 if (!status)
1641 return;
1642
1643 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1644 if (!cp)
1645 return;
1646
1647 hci_dev_lock(hdev);
1648
1649 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001650 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001651 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001652
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001653 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001654 hci_sco_setup(conn, status);
1655 }
1656
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001657 hci_dev_unlock(hdev);
1658}
1659
Johan Hedberg88c3df12012-02-09 14:27:38 +02001660static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1661{
1662 struct hci_cp_disconnect *cp;
1663 struct hci_conn *conn;
1664
1665 if (!status)
1666 return;
1667
1668 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1669 if (!cp)
1670 return;
1671
1672 hci_dev_lock(hdev);
1673
1674 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1675 if (conn)
1676 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001677 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001678
1679 hci_dev_unlock(hdev);
1680}
1681
Ville Tervofcd89c02011-02-10 22:38:47 -03001682static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1683{
Ville Tervofcd89c02011-02-10 22:38:47 -03001684 struct hci_conn *conn;
1685
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001686 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Ville Tervofcd89c02011-02-10 22:38:47 -03001687
Ville Tervofcd89c02011-02-10 22:38:47 -03001688 if (status) {
Andre Guedesf00a06a2012-07-27 15:10:13 -03001689 hci_dev_lock(hdev);
Ville Tervofcd89c02011-02-10 22:38:47 -03001690
Andre Guedes0c95ab72012-07-27 15:10:14 -03001691 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001692 if (!conn) {
1693 hci_dev_unlock(hdev);
1694 return;
1695 }
1696
Andre Guedes0c95ab72012-07-27 15:10:14 -03001697 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&conn->dst),
Andre Guedesf00a06a2012-07-27 15:10:13 -03001698 conn);
1699
1700 conn->state = BT_CLOSED;
Andre Guedes0c95ab72012-07-27 15:10:14 -03001701 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Andre Guedesf00a06a2012-07-27 15:10:13 -03001702 conn->dst_type, status);
1703 hci_proto_connect_cfm(conn, status);
1704 hci_conn_del(conn);
1705
1706 hci_dev_unlock(hdev);
1707 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001708}
1709
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001710static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1711{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001712 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001713}
1714
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001715static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1716{
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001717 struct hci_cp_create_phy_link *cp;
1718
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001719 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001720
1721 if (status)
1722 return;
1723
1724 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1725 if (!cp)
1726 return;
1727
1728 amp_write_remote_assoc(hdev, cp->phy_handle);
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001729}
1730
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001731static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001732{
1733 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001734 struct discovery_state *discov = &hdev->discovery;
1735 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001736
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001737 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001738
Johan Hedberg23bb5762010-12-21 23:01:27 +02001739 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001740
1741 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001742
1743 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1744 return;
1745
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001746 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001747 return;
1748
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001749 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001750
Andre Guedes343f9352012-02-17 20:39:37 -03001751 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001752 goto unlock;
1753
1754 if (list_empty(&discov->resolve)) {
1755 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1756 goto unlock;
1757 }
1758
1759 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1760 if (e && hci_resolve_name(hdev, e) == 0) {
1761 e->name_state = NAME_PENDING;
1762 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1763 } else {
1764 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1765 }
1766
1767unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001768 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001769}
1770
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001771static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001772{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001773 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001774 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775 int num_rsp = *((__u8 *) skb->data);
1776
1777 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1778
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001779 if (!num_rsp)
1780 return;
1781
Andre Guedes1519cc12012-03-21 00:03:38 -03001782 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1783 return;
1784
Linus Torvalds1da177e2005-04-16 15:20:36 -07001785 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001786
Johan Hedberge17acd42011-03-30 23:57:16 +03001787 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001788 bool name_known, ssp;
Johan Hedberg31754052012-01-04 13:39:52 +02001789
Linus Torvalds1da177e2005-04-16 15:20:36 -07001790 bacpy(&data.bdaddr, &info->bdaddr);
1791 data.pscan_rep_mode = info->pscan_rep_mode;
1792 data.pscan_period_mode = info->pscan_period_mode;
1793 data.pscan_mode = info->pscan_mode;
1794 memcpy(data.dev_class, info->dev_class, 3);
1795 data.clock_offset = info->clock_offset;
1796 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001797 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02001798
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001799 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02001800 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001801 info->dev_class, 0, !name_known, ssp, NULL,
1802 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001803 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001804
Linus Torvalds1da177e2005-04-16 15:20:36 -07001805 hci_dev_unlock(hdev);
1806}
1807
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001808static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001809{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001810 struct hci_ev_conn_complete *ev = (void *) skb->data;
1811 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001812
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001813 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001814
Linus Torvalds1da177e2005-04-16 15:20:36 -07001815 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001816
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001817 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001818 if (!conn) {
1819 if (ev->link_type != SCO_LINK)
1820 goto unlock;
1821
1822 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1823 if (!conn)
1824 goto unlock;
1825
1826 conn->type = SCO_LINK;
1827 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001828
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001829 if (!ev->status) {
1830 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001831
1832 if (conn->type == ACL_LINK) {
1833 conn->state = BT_CONFIG;
1834 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02001835
1836 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1837 !hci_find_link_key(hdev, &ev->bdaddr))
1838 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1839 else
1840 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02001841 } else
1842 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001843
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001844 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001845 hci_conn_add_sysfs(conn);
1846
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001847 if (test_bit(HCI_AUTH, &hdev->flags))
1848 conn->link_mode |= HCI_LM_AUTH;
1849
1850 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1851 conn->link_mode |= HCI_LM_ENCRYPT;
1852
1853 /* Get remote features */
1854 if (conn->type == ACL_LINK) {
1855 struct hci_cp_read_remote_features cp;
1856 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001857 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001858 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001859 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001860
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001861 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02001862 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001863 struct hci_cp_change_conn_ptype cp;
1864 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001865 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001866 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
1867 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001868 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001869 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001870 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001871 if (conn->type == ACL_LINK)
Johan Hedberg744cf192011-11-08 20:40:14 +02001872 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001873 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02001874 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001875
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001876 if (conn->type == ACL_LINK)
1877 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001878
Marcel Holtmann769be972008-07-14 20:13:49 +02001879 if (ev->status) {
1880 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001881 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001882 } else if (ev->link_type != ACL_LINK)
1883 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001884
1885unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001886 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001887
1888 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001889}
1890
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001891static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001892{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001893 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001894 int mask = hdev->link_mode;
1895
Gustavo Padovan807deac2012-05-17 00:36:24 -03001896 BT_DBG("%s bdaddr %s type 0x%x", hdev->name, batostr(&ev->bdaddr),
1897 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001898
1899 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1900
Szymon Janc138d22e2011-02-17 16:44:23 +01001901 if ((mask & HCI_LM_ACCEPT) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001902 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001903 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001904 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001905 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001906
1907 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001908
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001909 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1910 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001911 memcpy(ie->data.dev_class, ev->dev_class, 3);
1912
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03001913 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
1914 &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001915 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001916 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1917 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001918 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001919 hci_dev_unlock(hdev);
1920 return;
1921 }
1922 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001923
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924 memcpy(conn->dev_class, ev->dev_class, 3);
1925 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001926
Linus Torvalds1da177e2005-04-16 15:20:36 -07001927 hci_dev_unlock(hdev);
1928
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001929 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1930 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001931
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001932 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001933
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001934 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1935 cp.role = 0x00; /* Become master */
1936 else
1937 cp.role = 0x01; /* Remain slave */
1938
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001939 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
1940 &cp);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001941 } else {
1942 struct hci_cp_accept_sync_conn_req cp;
1943
1944 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001945 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001946
Andrei Emeltchenko82781e62012-05-25 11:38:27 +03001947 cp.tx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1948 cp.rx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1949 cp.max_latency = __constant_cpu_to_le16(0xffff);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001950 cp.content_format = cpu_to_le16(hdev->voice_setting);
1951 cp.retrans_effort = 0xff;
1952
1953 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001954 sizeof(cp), &cp);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001955 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001956 } else {
1957 /* Connection rejected */
1958 struct hci_cp_reject_conn_req cp;
1959
1960 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02001961 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001962 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001963 }
1964}
1965
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001966static u8 hci_to_mgmt_reason(u8 err)
1967{
1968 switch (err) {
1969 case HCI_ERROR_CONNECTION_TIMEOUT:
1970 return MGMT_DEV_DISCONN_TIMEOUT;
1971 case HCI_ERROR_REMOTE_USER_TERM:
1972 case HCI_ERROR_REMOTE_LOW_RESOURCES:
1973 case HCI_ERROR_REMOTE_POWER_OFF:
1974 return MGMT_DEV_DISCONN_REMOTE;
1975 case HCI_ERROR_LOCAL_HOST_TERM:
1976 return MGMT_DEV_DISCONN_LOCAL_HOST;
1977 default:
1978 return MGMT_DEV_DISCONN_UNKNOWN;
1979 }
1980}
1981
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001982static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001983{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001984 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001985 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001986
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001987 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001988
Linus Torvalds1da177e2005-04-16 15:20:36 -07001989 hci_dev_lock(hdev);
1990
Marcel Holtmann04837f62006-07-03 10:02:33 +02001991 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001992 if (!conn)
1993 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001994
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001995 if (ev->status == 0)
1996 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001997
Johan Hedbergb644ba32012-01-17 21:48:47 +02001998 if (test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001999 (conn->type == ACL_LINK || conn->type == LE_LINK)) {
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02002000 if (ev->status) {
Johan Hedberg88c3df12012-02-09 14:27:38 +02002001 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002002 conn->dst_type, ev->status);
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02002003 } else {
2004 u8 reason = hci_to_mgmt_reason(ev->reason);
2005
Johan Hedbergafc747a2012-01-15 18:11:07 +02002006 mgmt_device_disconnected(hdev, &conn->dst, conn->type,
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02002007 conn->dst_type, reason);
2008 }
Johan Hedberg37d9ef72011-11-10 15:54:39 +02002009 }
Johan Hedbergf7520542011-01-20 12:34:39 +02002010
Johan Hedberg37d9ef72011-11-10 15:54:39 +02002011 if (ev->status == 0) {
Vishal Agarwal6ec5bca2012-04-16 14:44:44 +05302012 if (conn->type == ACL_LINK && conn->flush_key)
2013 hci_remove_link_key(hdev, &conn->dst);
Johan Hedberg37d9ef72011-11-10 15:54:39 +02002014 hci_proto_disconn_cfm(conn, ev->reason);
2015 hci_conn_del(conn);
2016 }
Johan Hedbergf7520542011-01-20 12:34:39 +02002017
2018unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002019 hci_dev_unlock(hdev);
2020}
2021
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002022static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002023{
2024 struct hci_ev_auth_complete *ev = (void *) skb->data;
2025 struct hci_conn *conn;
2026
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002027 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002028
2029 hci_dev_lock(hdev);
2030
2031 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002032 if (!conn)
2033 goto unlock;
2034
2035 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002036 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002037 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002038 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03002039 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002040 conn->link_mode |= HCI_LM_AUTH;
2041 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03002042 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002043 } else {
Johan Hedbergbab73cb2012-02-09 16:07:29 +02002044 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002045 ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002046 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002047
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002048 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
2049 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002050
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002051 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002052 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002053 struct hci_cp_set_conn_encrypt cp;
2054 cp.handle = ev->handle;
2055 cp.encrypt = 0x01;
2056 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002057 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002058 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002059 conn->state = BT_CONNECTED;
2060 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002061 hci_conn_put(conn);
2062 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002063 } else {
2064 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002065
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002066 hci_conn_hold(conn);
2067 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
2068 hci_conn_put(conn);
2069 }
2070
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002071 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002072 if (!ev->status) {
2073 struct hci_cp_set_conn_encrypt cp;
2074 cp.handle = ev->handle;
2075 cp.encrypt = 0x01;
2076 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002077 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002078 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002079 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002080 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002081 }
2082 }
2083
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002084unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002085 hci_dev_unlock(hdev);
2086}
2087
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002088static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002089{
Johan Hedberg127178d2010-11-18 22:22:29 +02002090 struct hci_ev_remote_name *ev = (void *) skb->data;
2091 struct hci_conn *conn;
2092
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002093 BT_DBG("%s", hdev->name);
2094
2095 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02002096
2097 hci_dev_lock(hdev);
2098
2099 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002100
2101 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
2102 goto check_auth;
2103
2104 if (ev->status == 0)
2105 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002106 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02002107 else
2108 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2109
2110check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07002111 if (!conn)
2112 goto unlock;
2113
2114 if (!hci_outgoing_auth_needed(hdev, conn))
2115 goto unlock;
2116
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002117 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002118 struct hci_cp_auth_requested cp;
2119 cp.handle = __cpu_to_le16(conn->handle);
2120 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2121 }
2122
Johan Hedberg79c6c702011-04-28 11:28:55 -07002123unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02002124 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002125}
2126
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002127static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002128{
2129 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2130 struct hci_conn *conn;
2131
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002132 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002133
2134 hci_dev_lock(hdev);
2135
2136 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2137 if (conn) {
2138 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02002139 if (ev->encrypt) {
2140 /* Encryption implies authentication */
2141 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002142 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03002143 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02002144 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002145 conn->link_mode &= ~HCI_LM_ENCRYPT;
2146 }
2147
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002148 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002149
Gustavo Padovana7d77232012-05-13 03:20:07 -03002150 if (ev->status && conn->state == BT_CONNECTED) {
Gustavo Padovand839c812012-05-16 12:17:12 -03002151 hci_acl_disconn(conn, HCI_ERROR_AUTH_FAILURE);
Gustavo Padovana7d77232012-05-13 03:20:07 -03002152 hci_conn_put(conn);
2153 goto unlock;
2154 }
2155
Marcel Holtmannf8558552008-07-14 20:13:49 +02002156 if (conn->state == BT_CONFIG) {
2157 if (!ev->status)
2158 conn->state = BT_CONNECTED;
2159
2160 hci_proto_connect_cfm(conn, ev->status);
2161 hci_conn_put(conn);
2162 } else
2163 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002164 }
2165
Gustavo Padovana7d77232012-05-13 03:20:07 -03002166unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002167 hci_dev_unlock(hdev);
2168}
2169
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002170static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2171 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002172{
2173 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2174 struct hci_conn *conn;
2175
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002176 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002177
2178 hci_dev_lock(hdev);
2179
2180 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2181 if (conn) {
2182 if (!ev->status)
2183 conn->link_mode |= HCI_LM_SECURE;
2184
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002185 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002186
2187 hci_key_change_cfm(conn, ev->status);
2188 }
2189
2190 hci_dev_unlock(hdev);
2191}
2192
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002193static void hci_remote_features_evt(struct hci_dev *hdev,
2194 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002195{
2196 struct hci_ev_remote_features *ev = (void *) skb->data;
2197 struct hci_conn *conn;
2198
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002199 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002200
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002201 hci_dev_lock(hdev);
2202
2203 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002204 if (!conn)
2205 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002206
Johan Hedbergccd556f2010-11-10 17:11:51 +02002207 if (!ev->status)
2208 memcpy(conn->features, ev->features, 8);
2209
2210 if (conn->state != BT_CONFIG)
2211 goto unlock;
2212
2213 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2214 struct hci_cp_read_remote_ext_features cp;
2215 cp.handle = ev->handle;
2216 cp.page = 0x01;
2217 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002218 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002219 goto unlock;
2220 }
2221
Johan Hedberg671267b2012-05-12 16:11:50 -03002222 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002223 struct hci_cp_remote_name_req cp;
2224 memset(&cp, 0, sizeof(cp));
2225 bacpy(&cp.bdaddr, &conn->dst);
2226 cp.pscan_rep_mode = 0x02;
2227 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002228 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2229 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002230 conn->dst_type, 0, NULL, 0,
2231 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002232
Johan Hedberg127178d2010-11-18 22:22:29 +02002233 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002234 conn->state = BT_CONNECTED;
2235 hci_proto_connect_cfm(conn, ev->status);
2236 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002237 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002238
Johan Hedbergccd556f2010-11-10 17:11:51 +02002239unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002240 hci_dev_unlock(hdev);
2241}
2242
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002243static void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002244{
2245 BT_DBG("%s", hdev->name);
2246}
2247
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002248static void hci_qos_setup_complete_evt(struct hci_dev *hdev,
2249 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002250{
2251 BT_DBG("%s", hdev->name);
2252}
2253
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002254static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002255{
2256 struct hci_ev_cmd_complete *ev = (void *) skb->data;
2257 __u16 opcode;
2258
2259 skb_pull(skb, sizeof(*ev));
2260
2261 opcode = __le16_to_cpu(ev->opcode);
2262
2263 switch (opcode) {
2264 case HCI_OP_INQUIRY_CANCEL:
2265 hci_cc_inquiry_cancel(hdev, skb);
2266 break;
2267
Andre Guedes4d934832012-03-21 00:03:35 -03002268 case HCI_OP_PERIODIC_INQ:
2269 hci_cc_periodic_inq(hdev, skb);
2270 break;
2271
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002272 case HCI_OP_EXIT_PERIODIC_INQ:
2273 hci_cc_exit_periodic_inq(hdev, skb);
2274 break;
2275
2276 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2277 hci_cc_remote_name_req_cancel(hdev, skb);
2278 break;
2279
2280 case HCI_OP_ROLE_DISCOVERY:
2281 hci_cc_role_discovery(hdev, skb);
2282 break;
2283
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002284 case HCI_OP_READ_LINK_POLICY:
2285 hci_cc_read_link_policy(hdev, skb);
2286 break;
2287
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002288 case HCI_OP_WRITE_LINK_POLICY:
2289 hci_cc_write_link_policy(hdev, skb);
2290 break;
2291
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002292 case HCI_OP_READ_DEF_LINK_POLICY:
2293 hci_cc_read_def_link_policy(hdev, skb);
2294 break;
2295
2296 case HCI_OP_WRITE_DEF_LINK_POLICY:
2297 hci_cc_write_def_link_policy(hdev, skb);
2298 break;
2299
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002300 case HCI_OP_RESET:
2301 hci_cc_reset(hdev, skb);
2302 break;
2303
2304 case HCI_OP_WRITE_LOCAL_NAME:
2305 hci_cc_write_local_name(hdev, skb);
2306 break;
2307
2308 case HCI_OP_READ_LOCAL_NAME:
2309 hci_cc_read_local_name(hdev, skb);
2310 break;
2311
2312 case HCI_OP_WRITE_AUTH_ENABLE:
2313 hci_cc_write_auth_enable(hdev, skb);
2314 break;
2315
2316 case HCI_OP_WRITE_ENCRYPT_MODE:
2317 hci_cc_write_encrypt_mode(hdev, skb);
2318 break;
2319
2320 case HCI_OP_WRITE_SCAN_ENABLE:
2321 hci_cc_write_scan_enable(hdev, skb);
2322 break;
2323
2324 case HCI_OP_READ_CLASS_OF_DEV:
2325 hci_cc_read_class_of_dev(hdev, skb);
2326 break;
2327
2328 case HCI_OP_WRITE_CLASS_OF_DEV:
2329 hci_cc_write_class_of_dev(hdev, skb);
2330 break;
2331
2332 case HCI_OP_READ_VOICE_SETTING:
2333 hci_cc_read_voice_setting(hdev, skb);
2334 break;
2335
2336 case HCI_OP_WRITE_VOICE_SETTING:
2337 hci_cc_write_voice_setting(hdev, skb);
2338 break;
2339
2340 case HCI_OP_HOST_BUFFER_SIZE:
2341 hci_cc_host_buffer_size(hdev, skb);
2342 break;
2343
Marcel Holtmann333140b2008-07-14 20:13:48 +02002344 case HCI_OP_WRITE_SSP_MODE:
2345 hci_cc_write_ssp_mode(hdev, skb);
2346 break;
2347
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002348 case HCI_OP_READ_LOCAL_VERSION:
2349 hci_cc_read_local_version(hdev, skb);
2350 break;
2351
2352 case HCI_OP_READ_LOCAL_COMMANDS:
2353 hci_cc_read_local_commands(hdev, skb);
2354 break;
2355
2356 case HCI_OP_READ_LOCAL_FEATURES:
2357 hci_cc_read_local_features(hdev, skb);
2358 break;
2359
Andre Guedes971e3a42011-06-30 19:20:52 -03002360 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2361 hci_cc_read_local_ext_features(hdev, skb);
2362 break;
2363
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002364 case HCI_OP_READ_BUFFER_SIZE:
2365 hci_cc_read_buffer_size(hdev, skb);
2366 break;
2367
2368 case HCI_OP_READ_BD_ADDR:
2369 hci_cc_read_bd_addr(hdev, skb);
2370 break;
2371
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002372 case HCI_OP_READ_DATA_BLOCK_SIZE:
2373 hci_cc_read_data_block_size(hdev, skb);
2374 break;
2375
Johan Hedberg23bb5762010-12-21 23:01:27 +02002376 case HCI_OP_WRITE_CA_TIMEOUT:
2377 hci_cc_write_ca_timeout(hdev, skb);
2378 break;
2379
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002380 case HCI_OP_READ_FLOW_CONTROL_MODE:
2381 hci_cc_read_flow_control_mode(hdev, skb);
2382 break;
2383
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002384 case HCI_OP_READ_LOCAL_AMP_INFO:
2385 hci_cc_read_local_amp_info(hdev, skb);
2386 break;
2387
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002388 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2389 hci_cc_read_local_amp_assoc(hdev, skb);
2390 break;
2391
Johan Hedbergb0916ea2011-01-10 13:44:55 +02002392 case HCI_OP_DELETE_STORED_LINK_KEY:
2393 hci_cc_delete_stored_link_key(hdev, skb);
2394 break;
2395
Johan Hedbergd5859e22011-01-25 01:19:58 +02002396 case HCI_OP_SET_EVENT_MASK:
2397 hci_cc_set_event_mask(hdev, skb);
2398 break;
2399
2400 case HCI_OP_WRITE_INQUIRY_MODE:
2401 hci_cc_write_inquiry_mode(hdev, skb);
2402 break;
2403
2404 case HCI_OP_READ_INQ_RSP_TX_POWER:
2405 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2406 break;
2407
2408 case HCI_OP_SET_EVENT_FLT:
2409 hci_cc_set_event_flt(hdev, skb);
2410 break;
2411
Johan Hedberg980e1a52011-01-22 06:10:07 +02002412 case HCI_OP_PIN_CODE_REPLY:
2413 hci_cc_pin_code_reply(hdev, skb);
2414 break;
2415
2416 case HCI_OP_PIN_CODE_NEG_REPLY:
2417 hci_cc_pin_code_neg_reply(hdev, skb);
2418 break;
2419
Szymon Jancc35938b2011-03-22 13:12:21 +01002420 case HCI_OP_READ_LOCAL_OOB_DATA:
2421 hci_cc_read_local_oob_data_reply(hdev, skb);
2422 break;
2423
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002424 case HCI_OP_LE_READ_BUFFER_SIZE:
2425 hci_cc_le_read_buffer_size(hdev, skb);
2426 break;
2427
Johan Hedberga5c29682011-02-19 12:05:57 -03002428 case HCI_OP_USER_CONFIRM_REPLY:
2429 hci_cc_user_confirm_reply(hdev, skb);
2430 break;
2431
2432 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2433 hci_cc_user_confirm_neg_reply(hdev, skb);
2434 break;
2435
Brian Gix1143d452011-11-23 08:28:34 -08002436 case HCI_OP_USER_PASSKEY_REPLY:
2437 hci_cc_user_passkey_reply(hdev, skb);
2438 break;
2439
2440 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2441 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002442 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002443
2444 case HCI_OP_LE_SET_SCAN_PARAM:
2445 hci_cc_le_set_scan_param(hdev, skb);
Brian Gix1143d452011-11-23 08:28:34 -08002446 break;
2447
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002448 case HCI_OP_LE_SET_SCAN_ENABLE:
2449 hci_cc_le_set_scan_enable(hdev, skb);
2450 break;
2451
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002452 case HCI_OP_LE_LTK_REPLY:
2453 hci_cc_le_ltk_reply(hdev, skb);
2454 break;
2455
2456 case HCI_OP_LE_LTK_NEG_REPLY:
2457 hci_cc_le_ltk_neg_reply(hdev, skb);
2458 break;
2459
Andre Guedesf9b49302011-06-30 19:20:53 -03002460 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2461 hci_cc_write_le_host_supported(hdev, skb);
2462 break;
2463
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03002464 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2465 hci_cc_write_remote_amp_assoc(hdev, skb);
2466 break;
2467
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002468 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002469 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002470 break;
2471 }
2472
Ville Tervo6bd32322011-02-16 16:32:41 +02002473 if (ev->opcode != HCI_OP_NOP)
2474 del_timer(&hdev->cmd_timer);
2475
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002476 if (ev->ncmd) {
2477 atomic_set(&hdev->cmd_cnt, 1);
2478 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002479 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002480 }
2481}
2482
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002483static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002484{
2485 struct hci_ev_cmd_status *ev = (void *) skb->data;
2486 __u16 opcode;
2487
2488 skb_pull(skb, sizeof(*ev));
2489
2490 opcode = __le16_to_cpu(ev->opcode);
2491
2492 switch (opcode) {
2493 case HCI_OP_INQUIRY:
2494 hci_cs_inquiry(hdev, ev->status);
2495 break;
2496
2497 case HCI_OP_CREATE_CONN:
2498 hci_cs_create_conn(hdev, ev->status);
2499 break;
2500
2501 case HCI_OP_ADD_SCO:
2502 hci_cs_add_sco(hdev, ev->status);
2503 break;
2504
Marcel Holtmannf8558552008-07-14 20:13:49 +02002505 case HCI_OP_AUTH_REQUESTED:
2506 hci_cs_auth_requested(hdev, ev->status);
2507 break;
2508
2509 case HCI_OP_SET_CONN_ENCRYPT:
2510 hci_cs_set_conn_encrypt(hdev, ev->status);
2511 break;
2512
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002513 case HCI_OP_REMOTE_NAME_REQ:
2514 hci_cs_remote_name_req(hdev, ev->status);
2515 break;
2516
Marcel Holtmann769be972008-07-14 20:13:49 +02002517 case HCI_OP_READ_REMOTE_FEATURES:
2518 hci_cs_read_remote_features(hdev, ev->status);
2519 break;
2520
2521 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2522 hci_cs_read_remote_ext_features(hdev, ev->status);
2523 break;
2524
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002525 case HCI_OP_SETUP_SYNC_CONN:
2526 hci_cs_setup_sync_conn(hdev, ev->status);
2527 break;
2528
2529 case HCI_OP_SNIFF_MODE:
2530 hci_cs_sniff_mode(hdev, ev->status);
2531 break;
2532
2533 case HCI_OP_EXIT_SNIFF_MODE:
2534 hci_cs_exit_sniff_mode(hdev, ev->status);
2535 break;
2536
Johan Hedberg8962ee72011-01-20 12:40:27 +02002537 case HCI_OP_DISCONNECT:
Johan Hedberg88c3df12012-02-09 14:27:38 +02002538 hci_cs_disconnect(hdev, ev->status);
Johan Hedberg8962ee72011-01-20 12:40:27 +02002539 break;
2540
Ville Tervofcd89c02011-02-10 22:38:47 -03002541 case HCI_OP_LE_CREATE_CONN:
2542 hci_cs_le_create_conn(hdev, ev->status);
2543 break;
2544
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002545 case HCI_OP_LE_START_ENC:
2546 hci_cs_le_start_enc(hdev, ev->status);
2547 break;
2548
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03002549 case HCI_OP_CREATE_PHY_LINK:
2550 hci_cs_create_phylink(hdev, ev->status);
2551 break;
2552
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002553 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002554 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002555 break;
2556 }
2557
Ville Tervo6bd32322011-02-16 16:32:41 +02002558 if (ev->opcode != HCI_OP_NOP)
2559 del_timer(&hdev->cmd_timer);
2560
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002561 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002562 atomic_set(&hdev->cmd_cnt, 1);
2563 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002564 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002565 }
2566}
2567
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002568static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002569{
2570 struct hci_ev_role_change *ev = (void *) skb->data;
2571 struct hci_conn *conn;
2572
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002573 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002574
2575 hci_dev_lock(hdev);
2576
2577 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2578 if (conn) {
2579 if (!ev->status) {
2580 if (ev->role)
2581 conn->link_mode &= ~HCI_LM_MASTER;
2582 else
2583 conn->link_mode |= HCI_LM_MASTER;
2584 }
2585
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002586 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002587
2588 hci_role_switch_cfm(conn, ev->status, ev->role);
2589 }
2590
2591 hci_dev_unlock(hdev);
2592}
2593
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002594static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002595{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002596 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002597 int i;
2598
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02002599 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2600 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2601 return;
2602 }
2603
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002604 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002605 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002606 BT_DBG("%s bad parameters", hdev->name);
2607 return;
2608 }
2609
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002610 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2611
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002612 for (i = 0; i < ev->num_hndl; i++) {
2613 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002614 struct hci_conn *conn;
2615 __u16 handle, count;
2616
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002617 handle = __le16_to_cpu(info->handle);
2618 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002619
2620 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002621 if (!conn)
2622 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002623
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002624 conn->sent -= count;
2625
2626 switch (conn->type) {
2627 case ACL_LINK:
2628 hdev->acl_cnt += count;
2629 if (hdev->acl_cnt > hdev->acl_pkts)
2630 hdev->acl_cnt = hdev->acl_pkts;
2631 break;
2632
2633 case LE_LINK:
2634 if (hdev->le_pkts) {
2635 hdev->le_cnt += count;
2636 if (hdev->le_cnt > hdev->le_pkts)
2637 hdev->le_cnt = hdev->le_pkts;
2638 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002639 hdev->acl_cnt += count;
2640 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002641 hdev->acl_cnt = hdev->acl_pkts;
2642 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002643 break;
2644
2645 case SCO_LINK:
2646 hdev->sco_cnt += count;
2647 if (hdev->sco_cnt > hdev->sco_pkts)
2648 hdev->sco_cnt = hdev->sco_pkts;
2649 break;
2650
2651 default:
2652 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2653 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002654 }
2655 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002656
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02002657 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002658}
2659
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002660static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002661{
2662 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2663 int i;
2664
2665 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2666 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2667 return;
2668 }
2669
2670 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002671 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002672 BT_DBG("%s bad parameters", hdev->name);
2673 return;
2674 }
2675
2676 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002677 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002678
2679 for (i = 0; i < ev->num_hndl; i++) {
2680 struct hci_comp_blocks_info *info = &ev->handles[i];
2681 struct hci_conn *conn;
2682 __u16 handle, block_count;
2683
2684 handle = __le16_to_cpu(info->handle);
2685 block_count = __le16_to_cpu(info->blocks);
2686
2687 conn = hci_conn_hash_lookup_handle(hdev, handle);
2688 if (!conn)
2689 continue;
2690
2691 conn->sent -= block_count;
2692
2693 switch (conn->type) {
2694 case ACL_LINK:
2695 hdev->block_cnt += block_count;
2696 if (hdev->block_cnt > hdev->num_blocks)
2697 hdev->block_cnt = hdev->num_blocks;
2698 break;
2699
2700 default:
2701 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2702 break;
2703 }
2704 }
2705
2706 queue_work(hdev->workqueue, &hdev->tx_work);
2707}
2708
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002709static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002710{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002711 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002712 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002713
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002714 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002715
2716 hci_dev_lock(hdev);
2717
Marcel Holtmann04837f62006-07-03 10:02:33 +02002718 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2719 if (conn) {
2720 conn->mode = ev->mode;
2721 conn->interval = __le16_to_cpu(ev->interval);
2722
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002723 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2724 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02002725 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002726 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002727 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02002728 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002729 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002730
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002731 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002732 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002733 }
2734
2735 hci_dev_unlock(hdev);
2736}
2737
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002738static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002739{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002740 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2741 struct hci_conn *conn;
2742
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002743 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002744
2745 hci_dev_lock(hdev);
2746
2747 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002748 if (!conn)
2749 goto unlock;
2750
2751 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002752 hci_conn_hold(conn);
2753 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2754 hci_conn_put(conn);
2755 }
2756
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002757 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02002758 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002759 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002760 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002761 u8 secure;
2762
2763 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2764 secure = 1;
2765 else
2766 secure = 0;
2767
Johan Hedberg744cf192011-11-08 20:40:14 +02002768 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002769 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002770
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002771unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002772 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002773}
2774
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002775static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002776{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002777 struct hci_ev_link_key_req *ev = (void *) skb->data;
2778 struct hci_cp_link_key_reply cp;
2779 struct hci_conn *conn;
2780 struct link_key *key;
2781
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002782 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002783
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002784 if (!test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002785 return;
2786
2787 hci_dev_lock(hdev);
2788
2789 key = hci_find_link_key(hdev, &ev->bdaddr);
2790 if (!key) {
2791 BT_DBG("%s link key not found for %s", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002792 batostr(&ev->bdaddr));
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002793 goto not_found;
2794 }
2795
2796 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002797 batostr(&ev->bdaddr));
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002798
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002799 if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002800 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002801 BT_DBG("%s ignoring debug key", hdev->name);
2802 goto not_found;
2803 }
2804
2805 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002806 if (conn) {
2807 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002808 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002809 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2810 goto not_found;
2811 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002812
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002813 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002814 conn->pending_sec_level == BT_SECURITY_HIGH) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002815 BT_DBG("%s ignoring key unauthenticated for high security",
2816 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002817 goto not_found;
2818 }
2819
2820 conn->key_type = key->type;
2821 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002822 }
2823
2824 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03002825 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002826
2827 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2828
2829 hci_dev_unlock(hdev);
2830
2831 return;
2832
2833not_found:
2834 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2835 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002836}
2837
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002838static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002839{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002840 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2841 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002842 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002843
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002844 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002845
2846 hci_dev_lock(hdev);
2847
2848 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2849 if (conn) {
2850 hci_conn_hold(conn);
2851 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002852 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002853
2854 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2855 conn->key_type = ev->key_type;
2856
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002857 hci_conn_put(conn);
2858 }
2859
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002860 if (test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002861 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002862 ev->key_type, pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002863
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002864 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002865}
2866
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002867static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02002868{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002869 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002870 struct hci_conn *conn;
2871
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002872 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002873
2874 hci_dev_lock(hdev);
2875
2876 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002877 if (conn && !ev->status) {
2878 struct inquiry_entry *ie;
2879
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002880 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2881 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002882 ie->data.clock_offset = ev->clock_offset;
2883 ie->timestamp = jiffies;
2884 }
2885 }
2886
2887 hci_dev_unlock(hdev);
2888}
2889
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002890static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02002891{
2892 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2893 struct hci_conn *conn;
2894
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002895 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02002896
2897 hci_dev_lock(hdev);
2898
2899 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2900 if (conn && !ev->status)
2901 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2902
2903 hci_dev_unlock(hdev);
2904}
2905
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002906static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002907{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002908 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002909 struct inquiry_entry *ie;
2910
2911 BT_DBG("%s", hdev->name);
2912
2913 hci_dev_lock(hdev);
2914
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002915 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2916 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002917 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2918 ie->timestamp = jiffies;
2919 }
2920
2921 hci_dev_unlock(hdev);
2922}
2923
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002924static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
2925 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002926{
2927 struct inquiry_data data;
2928 int num_rsp = *((__u8 *) skb->data);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002929 bool name_known, ssp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002930
2931 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2932
2933 if (!num_rsp)
2934 return;
2935
Andre Guedes1519cc12012-03-21 00:03:38 -03002936 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2937 return;
2938
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002939 hci_dev_lock(hdev);
2940
2941 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002942 struct inquiry_info_with_rssi_and_pscan_mode *info;
2943 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002944
Johan Hedberge17acd42011-03-30 23:57:16 +03002945 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002946 bacpy(&data.bdaddr, &info->bdaddr);
2947 data.pscan_rep_mode = info->pscan_rep_mode;
2948 data.pscan_period_mode = info->pscan_period_mode;
2949 data.pscan_mode = info->pscan_mode;
2950 memcpy(data.dev_class, info->dev_class, 3);
2951 data.clock_offset = info->clock_offset;
2952 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002953 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002954
2955 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002956 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002957 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002958 info->dev_class, info->rssi,
2959 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002960 }
2961 } else {
2962 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2963
Johan Hedberge17acd42011-03-30 23:57:16 +03002964 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002965 bacpy(&data.bdaddr, &info->bdaddr);
2966 data.pscan_rep_mode = info->pscan_rep_mode;
2967 data.pscan_period_mode = info->pscan_period_mode;
2968 data.pscan_mode = 0x00;
2969 memcpy(data.dev_class, info->dev_class, 3);
2970 data.clock_offset = info->clock_offset;
2971 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002972 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002973 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002974 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002975 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002976 info->dev_class, info->rssi,
2977 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002978 }
2979 }
2980
2981 hci_dev_unlock(hdev);
2982}
2983
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002984static void hci_remote_ext_features_evt(struct hci_dev *hdev,
2985 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002986{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002987 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2988 struct hci_conn *conn;
2989
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002990 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002991
Marcel Holtmann41a96212008-07-14 20:13:48 +02002992 hci_dev_lock(hdev);
2993
2994 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002995 if (!conn)
2996 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002997
Johan Hedbergccd556f2010-11-10 17:11:51 +02002998 if (!ev->status && ev->page == 0x01) {
2999 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003000
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003001 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3002 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003003 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02003004
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003005 if (ev->features[0] & LMP_HOST_SSP)
Johan Hedberg58a681e2012-01-16 06:47:28 +02003006 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003007 }
3008
Johan Hedbergccd556f2010-11-10 17:11:51 +02003009 if (conn->state != BT_CONFIG)
3010 goto unlock;
3011
Johan Hedberg671267b2012-05-12 16:11:50 -03003012 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02003013 struct hci_cp_remote_name_req cp;
3014 memset(&cp, 0, sizeof(cp));
3015 bacpy(&cp.bdaddr, &conn->dst);
3016 cp.pscan_rep_mode = 0x02;
3017 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003018 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3019 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003020 conn->dst_type, 0, NULL, 0,
3021 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02003022
Johan Hedberg127178d2010-11-18 22:22:29 +02003023 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02003024 conn->state = BT_CONNECTED;
3025 hci_proto_connect_cfm(conn, ev->status);
3026 hci_conn_put(conn);
3027 }
3028
3029unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02003030 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003031}
3032
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003033static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3034 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003035{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003036 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3037 struct hci_conn *conn;
3038
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003039 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003040
3041 hci_dev_lock(hdev);
3042
3043 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003044 if (!conn) {
3045 if (ev->link_type == ESCO_LINK)
3046 goto unlock;
3047
3048 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3049 if (!conn)
3050 goto unlock;
3051
3052 conn->type = SCO_LINK;
3053 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003054
Marcel Holtmann732547f2009-04-19 19:14:14 +02003055 switch (ev->status) {
3056 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003057 conn->handle = __le16_to_cpu(ev->handle);
3058 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003059
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07003060 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003061 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02003062 break;
3063
Stephen Coe705e5712010-02-16 11:29:44 -05003064 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003065 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08003066 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003067 case 0x1f: /* Unspecified error */
3068 if (conn->out && conn->attempt < 2) {
3069 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3070 (hdev->esco_type & EDR_ESCO_MASK);
3071 hci_setup_sync(conn, conn->link->handle);
3072 goto unlock;
3073 }
3074 /* fall through */
3075
3076 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003077 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003078 break;
3079 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003080
3081 hci_proto_connect_cfm(conn, ev->status);
3082 if (ev->status)
3083 hci_conn_del(conn);
3084
3085unlock:
3086 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003087}
3088
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003089static void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003090{
3091 BT_DBG("%s", hdev->name);
3092}
3093
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003094static void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02003095{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003096 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003097
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003098 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003099}
3100
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003101static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3102 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003103{
3104 struct inquiry_data data;
3105 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3106 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303107 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003108
3109 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3110
3111 if (!num_rsp)
3112 return;
3113
Andre Guedes1519cc12012-03-21 00:03:38 -03003114 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3115 return;
3116
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003117 hci_dev_lock(hdev);
3118
Johan Hedberge17acd42011-03-30 23:57:16 +03003119 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003120 bool name_known, ssp;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003121
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003122 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01003123 data.pscan_rep_mode = info->pscan_rep_mode;
3124 data.pscan_period_mode = info->pscan_period_mode;
3125 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003126 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01003127 data.clock_offset = info->clock_offset;
3128 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003129 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003130
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003131 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02003132 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003133 sizeof(info->data),
3134 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02003135 else
3136 name_known = true;
3137
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003138 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003139 &ssp);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303140 eir_len = eir_get_length(info->data, sizeof(info->data));
Johan Hedberg48264f02011-11-09 13:58:58 +02003141 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003142 info->dev_class, info->rssi, !name_known,
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303143 ssp, info->data, eir_len);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003144 }
3145
3146 hci_dev_unlock(hdev);
3147}
3148
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003149static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3150 struct sk_buff *skb)
3151{
3152 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3153 struct hci_conn *conn;
3154
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003155 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003156 __le16_to_cpu(ev->handle));
3157
3158 hci_dev_lock(hdev);
3159
3160 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3161 if (!conn)
3162 goto unlock;
3163
3164 if (!ev->status)
3165 conn->sec_level = conn->pending_sec_level;
3166
3167 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3168
3169 if (ev->status && conn->state == BT_CONNECTED) {
3170 hci_acl_disconn(conn, HCI_ERROR_AUTH_FAILURE);
3171 hci_conn_put(conn);
3172 goto unlock;
3173 }
3174
3175 if (conn->state == BT_CONFIG) {
3176 if (!ev->status)
3177 conn->state = BT_CONNECTED;
3178
3179 hci_proto_connect_cfm(conn, ev->status);
3180 hci_conn_put(conn);
3181 } else {
3182 hci_auth_cfm(conn, ev->status);
3183
3184 hci_conn_hold(conn);
3185 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
3186 hci_conn_put(conn);
3187 }
3188
3189unlock:
3190 hci_dev_unlock(hdev);
3191}
3192
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003193static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003194{
3195 /* If remote requests dedicated bonding follow that lead */
3196 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
3197 /* If both remote and local IO capabilities allow MITM
3198 * protection then require it, otherwise don't */
3199 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
3200 return 0x02;
3201 else
3202 return 0x03;
3203 }
3204
3205 /* If remote requests no-bonding follow that lead */
3206 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003207 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003208
3209 return conn->auth_type;
3210}
3211
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003212static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003213{
3214 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3215 struct hci_conn *conn;
3216
3217 BT_DBG("%s", hdev->name);
3218
3219 hci_dev_lock(hdev);
3220
3221 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003222 if (!conn)
3223 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003224
Johan Hedberg03b555e2011-01-04 15:40:05 +02003225 hci_conn_hold(conn);
3226
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003227 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003228 goto unlock;
3229
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003230 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003231 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003232 struct hci_cp_io_capability_reply cp;
3233
3234 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303235 /* Change the IO capability from KeyboardDisplay
3236 * to DisplayYesNo as it is not supported by BT spec. */
3237 cp.capability = (conn->io_capability == 0x04) ?
3238 0x01 : conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07003239 conn->auth_type = hci_get_auth_req(conn);
3240 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003241
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003242 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3243 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
Szymon Jancce85ee12011-03-22 13:12:23 +01003244 cp.oob_data = 0x01;
3245 else
3246 cp.oob_data = 0x00;
3247
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003248 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003249 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003250 } else {
3251 struct hci_cp_io_capability_neg_reply cp;
3252
3253 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02003254 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003255
3256 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003257 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003258 }
3259
3260unlock:
3261 hci_dev_unlock(hdev);
3262}
3263
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003264static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02003265{
3266 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3267 struct hci_conn *conn;
3268
3269 BT_DBG("%s", hdev->name);
3270
3271 hci_dev_lock(hdev);
3272
3273 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3274 if (!conn)
3275 goto unlock;
3276
Johan Hedberg03b555e2011-01-04 15:40:05 +02003277 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003278 conn->remote_auth = ev->authentication;
Johan Hedberg58a681e2012-01-16 06:47:28 +02003279 if (ev->oob_data)
3280 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003281
3282unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003283 hci_dev_unlock(hdev);
3284}
3285
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003286static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3287 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003288{
3289 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003290 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07003291 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03003292
3293 BT_DBG("%s", hdev->name);
3294
3295 hci_dev_lock(hdev);
3296
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003297 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg7a828902011-04-28 11:28:53 -07003298 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03003299
Johan Hedberg7a828902011-04-28 11:28:53 -07003300 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3301 if (!conn)
3302 goto unlock;
3303
3304 loc_mitm = (conn->auth_type & 0x01);
3305 rem_mitm = (conn->remote_auth & 0x01);
3306
3307 /* If we require MITM but the remote device can't provide that
3308 * (it has NoInputNoOutput) then reject the confirmation
3309 * request. The only exception is when we're dedicated bonding
3310 * initiators (connect_cfm_cb set) since then we always have the MITM
3311 * bit set. */
3312 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
3313 BT_DBG("Rejecting request: remote device can't provide MITM");
3314 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003315 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003316 goto unlock;
3317 }
3318
3319 /* If no side requires MITM protection; auto-accept */
3320 if ((!loc_mitm || conn->remote_cap == 0x03) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003321 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003322
3323 /* If we're not the initiators request authorization to
3324 * proceed from user space (mgmt_user_confirm with
3325 * confirm_hint set to 1). */
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003326 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003327 BT_DBG("Confirming auto-accept as acceptor");
3328 confirm_hint = 1;
3329 goto confirm;
3330 }
3331
Johan Hedberg9f616562011-04-28 11:28:54 -07003332 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03003333 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003334
3335 if (hdev->auto_accept_delay > 0) {
3336 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
3337 mod_timer(&conn->auto_accept_timer, jiffies + delay);
3338 goto unlock;
3339 }
3340
Johan Hedberg7a828902011-04-28 11:28:53 -07003341 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003342 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003343 goto unlock;
3344 }
3345
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003346confirm:
Johan Hedberg272d90d2012-02-09 15:26:12 +02003347 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0, ev->passkey,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003348 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07003349
3350unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03003351 hci_dev_unlock(hdev);
3352}
3353
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003354static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3355 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08003356{
3357 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3358
3359 BT_DBG("%s", hdev->name);
3360
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003361 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02003362 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08003363}
3364
Johan Hedberg92a25252012-09-06 18:39:26 +03003365static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3366 struct sk_buff *skb)
3367{
3368 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3369 struct hci_conn *conn;
3370
3371 BT_DBG("%s", hdev->name);
3372
3373 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3374 if (!conn)
3375 return;
3376
3377 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3378 conn->passkey_entered = 0;
3379
3380 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3381 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3382 conn->dst_type, conn->passkey_notify,
3383 conn->passkey_entered);
3384}
3385
3386static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3387{
3388 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3389 struct hci_conn *conn;
3390
3391 BT_DBG("%s", hdev->name);
3392
3393 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3394 if (!conn)
3395 return;
3396
3397 switch (ev->type) {
3398 case HCI_KEYPRESS_STARTED:
3399 conn->passkey_entered = 0;
3400 return;
3401
3402 case HCI_KEYPRESS_ENTERED:
3403 conn->passkey_entered++;
3404 break;
3405
3406 case HCI_KEYPRESS_ERASED:
3407 conn->passkey_entered--;
3408 break;
3409
3410 case HCI_KEYPRESS_CLEARED:
3411 conn->passkey_entered = 0;
3412 break;
3413
3414 case HCI_KEYPRESS_COMPLETED:
3415 return;
3416 }
3417
3418 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3419 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3420 conn->dst_type, conn->passkey_notify,
3421 conn->passkey_entered);
3422}
3423
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003424static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3425 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003426{
3427 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3428 struct hci_conn *conn;
3429
3430 BT_DBG("%s", hdev->name);
3431
3432 hci_dev_lock(hdev);
3433
3434 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003435 if (!conn)
3436 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003437
Johan Hedberg2a611692011-02-19 12:06:00 -03003438 /* To avoid duplicate auth_failed events to user space we check
3439 * the HCI_CONN_AUTH_PEND flag which will be set if we
3440 * initiated the authentication. A traditional auth_complete
3441 * event gets always produced as initiator and is also mapped to
3442 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02003443 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003444 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003445 ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003446
3447 hci_conn_put(conn);
3448
3449unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003450 hci_dev_unlock(hdev);
3451}
3452
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003453static void hci_remote_host_features_evt(struct hci_dev *hdev,
3454 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003455{
3456 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3457 struct inquiry_entry *ie;
3458
3459 BT_DBG("%s", hdev->name);
3460
3461 hci_dev_lock(hdev);
3462
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003463 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3464 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003465 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003466
3467 hci_dev_unlock(hdev);
3468}
3469
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003470static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3471 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01003472{
3473 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3474 struct oob_data *data;
3475
3476 BT_DBG("%s", hdev->name);
3477
3478 hci_dev_lock(hdev);
3479
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003480 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Szymon Jance1ba1f12011-04-06 13:01:59 +02003481 goto unlock;
3482
Szymon Janc2763eda2011-03-22 13:12:22 +01003483 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3484 if (data) {
3485 struct hci_cp_remote_oob_data_reply cp;
3486
3487 bacpy(&cp.bdaddr, &ev->bdaddr);
3488 memcpy(cp.hash, data->hash, sizeof(cp.hash));
3489 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
3490
3491 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003492 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003493 } else {
3494 struct hci_cp_remote_oob_data_neg_reply cp;
3495
3496 bacpy(&cp.bdaddr, &ev->bdaddr);
3497 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003498 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003499 }
3500
Szymon Jance1ba1f12011-04-06 13:01:59 +02003501unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003502 hci_dev_unlock(hdev);
3503}
3504
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003505static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003506{
3507 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3508 struct hci_conn *conn;
3509
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003510 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003511
3512 hci_dev_lock(hdev);
3513
Andre Guedesb47a09b2012-07-27 15:10:15 -03003514 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03003515 if (!conn) {
3516 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
3517 if (!conn) {
3518 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03003519 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03003520 }
Andre Guedes29b79882011-05-31 14:20:54 -03003521
3522 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03003523
3524 if (ev->role == LE_CONN_ROLE_MASTER) {
3525 conn->out = true;
3526 conn->link_mode |= HCI_LM_MASTER;
3527 }
Ville Tervob62f3282011-02-10 22:38:50 -03003528 }
Ville Tervofcd89c02011-02-10 22:38:47 -03003529
Andre Guedescd17dec2012-07-27 15:10:16 -03003530 if (ev->status) {
3531 mgmt_connect_failed(hdev, &conn->dst, conn->type,
3532 conn->dst_type, ev->status);
3533 hci_proto_connect_cfm(conn, ev->status);
3534 conn->state = BT_CLOSED;
3535 hci_conn_del(conn);
3536 goto unlock;
3537 }
3538
Johan Hedbergb644ba32012-01-17 21:48:47 +02003539 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3540 mgmt_device_connected(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003541 conn->dst_type, 0, NULL, 0, NULL);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03003542
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03003543 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03003544 conn->handle = __le16_to_cpu(ev->handle);
3545 conn->state = BT_CONNECTED;
3546
3547 hci_conn_hold_device(conn);
3548 hci_conn_add_sysfs(conn);
3549
3550 hci_proto_connect_cfm(conn, ev->status);
3551
3552unlock:
3553 hci_dev_unlock(hdev);
3554}
3555
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003556static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03003557{
Andre Guedese95beb42011-09-26 20:48:35 -03003558 u8 num_reports = skb->data[0];
3559 void *ptr = &skb->data[1];
Andre Guedes3c9e9192012-01-10 18:20:50 -03003560 s8 rssi;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003561
3562 hci_dev_lock(hdev);
3563
Andre Guedese95beb42011-09-26 20:48:35 -03003564 while (num_reports--) {
3565 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003566
Andre Guedes3c9e9192012-01-10 18:20:50 -03003567 rssi = ev->data[ev->length];
3568 mgmt_device_found(hdev, &ev->bdaddr, LE_LINK, ev->bdaddr_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003569 NULL, rssi, 0, 1, ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03003570
Andre Guedese95beb42011-09-26 20:48:35 -03003571 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003572 }
3573
3574 hci_dev_unlock(hdev);
3575}
3576
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003577static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003578{
3579 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
3580 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003581 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003582 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003583 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003584
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003585 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003586
3587 hci_dev_lock(hdev);
3588
3589 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003590 if (conn == NULL)
3591 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003592
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003593 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
3594 if (ltk == NULL)
3595 goto not_found;
3596
3597 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003598 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003599
3600 if (ltk->authenticated)
3601 conn->sec_level = BT_SECURITY_HIGH;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003602
3603 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
3604
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003605 if (ltk->type & HCI_SMP_STK) {
3606 list_del(&ltk->list);
3607 kfree(ltk);
3608 }
3609
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003610 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003611
3612 return;
3613
3614not_found:
3615 neg.handle = ev->handle;
3616 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
3617 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003618}
3619
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003620static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003621{
3622 struct hci_ev_le_meta *le_ev = (void *) skb->data;
3623
3624 skb_pull(skb, sizeof(*le_ev));
3625
3626 switch (le_ev->subevent) {
3627 case HCI_EV_LE_CONN_COMPLETE:
3628 hci_le_conn_complete_evt(hdev, skb);
3629 break;
3630
Andre Guedes9aa04c92011-05-26 16:23:51 -03003631 case HCI_EV_LE_ADVERTISING_REPORT:
3632 hci_le_adv_report_evt(hdev, skb);
3633 break;
3634
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003635 case HCI_EV_LE_LTK_REQ:
3636 hci_le_ltk_request_evt(hdev, skb);
3637 break;
3638
Ville Tervofcd89c02011-02-10 22:38:47 -03003639 default:
3640 break;
3641 }
3642}
3643
Linus Torvalds1da177e2005-04-16 15:20:36 -07003644void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
3645{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003646 struct hci_event_hdr *hdr = (void *) skb->data;
3647 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003648
3649 skb_pull(skb, HCI_EVENT_HDR_SIZE);
3650
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003651 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003652 case HCI_EV_INQUIRY_COMPLETE:
3653 hci_inquiry_complete_evt(hdev, skb);
3654 break;
3655
3656 case HCI_EV_INQUIRY_RESULT:
3657 hci_inquiry_result_evt(hdev, skb);
3658 break;
3659
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003660 case HCI_EV_CONN_COMPLETE:
3661 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02003662 break;
3663
Linus Torvalds1da177e2005-04-16 15:20:36 -07003664 case HCI_EV_CONN_REQUEST:
3665 hci_conn_request_evt(hdev, skb);
3666 break;
3667
Linus Torvalds1da177e2005-04-16 15:20:36 -07003668 case HCI_EV_DISCONN_COMPLETE:
3669 hci_disconn_complete_evt(hdev, skb);
3670 break;
3671
Linus Torvalds1da177e2005-04-16 15:20:36 -07003672 case HCI_EV_AUTH_COMPLETE:
3673 hci_auth_complete_evt(hdev, skb);
3674 break;
3675
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003676 case HCI_EV_REMOTE_NAME:
3677 hci_remote_name_evt(hdev, skb);
3678 break;
3679
Linus Torvalds1da177e2005-04-16 15:20:36 -07003680 case HCI_EV_ENCRYPT_CHANGE:
3681 hci_encrypt_change_evt(hdev, skb);
3682 break;
3683
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003684 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3685 hci_change_link_key_complete_evt(hdev, skb);
3686 break;
3687
3688 case HCI_EV_REMOTE_FEATURES:
3689 hci_remote_features_evt(hdev, skb);
3690 break;
3691
3692 case HCI_EV_REMOTE_VERSION:
3693 hci_remote_version_evt(hdev, skb);
3694 break;
3695
3696 case HCI_EV_QOS_SETUP_COMPLETE:
3697 hci_qos_setup_complete_evt(hdev, skb);
3698 break;
3699
3700 case HCI_EV_CMD_COMPLETE:
3701 hci_cmd_complete_evt(hdev, skb);
3702 break;
3703
3704 case HCI_EV_CMD_STATUS:
3705 hci_cmd_status_evt(hdev, skb);
3706 break;
3707
3708 case HCI_EV_ROLE_CHANGE:
3709 hci_role_change_evt(hdev, skb);
3710 break;
3711
3712 case HCI_EV_NUM_COMP_PKTS:
3713 hci_num_comp_pkts_evt(hdev, skb);
3714 break;
3715
3716 case HCI_EV_MODE_CHANGE:
3717 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003718 break;
3719
3720 case HCI_EV_PIN_CODE_REQ:
3721 hci_pin_code_request_evt(hdev, skb);
3722 break;
3723
3724 case HCI_EV_LINK_KEY_REQ:
3725 hci_link_key_request_evt(hdev, skb);
3726 break;
3727
3728 case HCI_EV_LINK_KEY_NOTIFY:
3729 hci_link_key_notify_evt(hdev, skb);
3730 break;
3731
3732 case HCI_EV_CLOCK_OFFSET:
3733 hci_clock_offset_evt(hdev, skb);
3734 break;
3735
Marcel Holtmanna8746412008-07-14 20:13:46 +02003736 case HCI_EV_PKT_TYPE_CHANGE:
3737 hci_pkt_type_change_evt(hdev, skb);
3738 break;
3739
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003740 case HCI_EV_PSCAN_REP_MODE:
3741 hci_pscan_rep_mode_evt(hdev, skb);
3742 break;
3743
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003744 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3745 hci_inquiry_result_with_rssi_evt(hdev, skb);
3746 break;
3747
3748 case HCI_EV_REMOTE_EXT_FEATURES:
3749 hci_remote_ext_features_evt(hdev, skb);
3750 break;
3751
3752 case HCI_EV_SYNC_CONN_COMPLETE:
3753 hci_sync_conn_complete_evt(hdev, skb);
3754 break;
3755
3756 case HCI_EV_SYNC_CONN_CHANGED:
3757 hci_sync_conn_changed_evt(hdev, skb);
3758 break;
3759
Marcel Holtmann04837f62006-07-03 10:02:33 +02003760 case HCI_EV_SNIFF_SUBRATE:
3761 hci_sniff_subrate_evt(hdev, skb);
3762 break;
3763
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003764 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3765 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003766 break;
3767
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003768 case HCI_EV_KEY_REFRESH_COMPLETE:
3769 hci_key_refresh_complete_evt(hdev, skb);
3770 break;
3771
Marcel Holtmann04936842008-07-14 20:13:48 +02003772 case HCI_EV_IO_CAPA_REQUEST:
3773 hci_io_capa_request_evt(hdev, skb);
3774 break;
3775
Johan Hedberg03b555e2011-01-04 15:40:05 +02003776 case HCI_EV_IO_CAPA_REPLY:
3777 hci_io_capa_reply_evt(hdev, skb);
3778 break;
3779
Johan Hedberga5c29682011-02-19 12:05:57 -03003780 case HCI_EV_USER_CONFIRM_REQUEST:
3781 hci_user_confirm_request_evt(hdev, skb);
3782 break;
3783
Brian Gix1143d452011-11-23 08:28:34 -08003784 case HCI_EV_USER_PASSKEY_REQUEST:
3785 hci_user_passkey_request_evt(hdev, skb);
3786 break;
3787
Johan Hedberg92a25252012-09-06 18:39:26 +03003788 case HCI_EV_USER_PASSKEY_NOTIFY:
3789 hci_user_passkey_notify_evt(hdev, skb);
3790 break;
3791
3792 case HCI_EV_KEYPRESS_NOTIFY:
3793 hci_keypress_notify_evt(hdev, skb);
3794 break;
3795
Marcel Holtmann04936842008-07-14 20:13:48 +02003796 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3797 hci_simple_pair_complete_evt(hdev, skb);
3798 break;
3799
Marcel Holtmann41a96212008-07-14 20:13:48 +02003800 case HCI_EV_REMOTE_HOST_FEATURES:
3801 hci_remote_host_features_evt(hdev, skb);
3802 break;
3803
Ville Tervofcd89c02011-02-10 22:38:47 -03003804 case HCI_EV_LE_META:
3805 hci_le_meta_evt(hdev, skb);
3806 break;
3807
Szymon Janc2763eda2011-03-22 13:12:22 +01003808 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3809 hci_remote_oob_data_request_evt(hdev, skb);
3810 break;
3811
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003812 case HCI_EV_NUM_COMP_BLOCKS:
3813 hci_num_comp_blocks_evt(hdev, skb);
3814 break;
3815
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003816 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003817 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003818 break;
3819 }
3820
3821 kfree_skb(skb);
3822 hdev->stat.evt_rx++;
3823}