blob: 2fced8c4325824a79d5b0b04558968e86a9c740b [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI event handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28
29#include <linux/types.h>
30#include <linux/errno.h>
31#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#include <linux/slab.h>
33#include <linux/poll.h>
34#include <linux/fcntl.h>
35#include <linux/init.h>
36#include <linux/skbuff.h>
37#include <linux/interrupt.h>
38#include <linux/notifier.h>
39#include <net/sock.h>
40
41#include <asm/system.h>
Andrei Emeltchenko70f230202010-12-01 16:58:25 +020042#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070043#include <asm/unaligned.h>
44
45#include <net/bluetooth/bluetooth.h>
46#include <net/bluetooth/hci_core.h>
47
Andre Guedese6100a22011-06-30 19:20:54 -030048static int enable_le;
49
Linus Torvalds1da177e2005-04-16 15:20:36 -070050/* Handle HCI Event packets */
51
Marcel Holtmanna9de9242007-10-20 13:33:56 +020052static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070053{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020054 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
Marcel Holtmanna9de9242007-10-20 13:33:56 +020056 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070057
Marcel Holtmanna9de9242007-10-20 13:33:56 +020058 if (status)
59 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070060
Andre Guedes89352e72011-11-04 14:16:53 -030061 clear_bit(HCI_INQUIRY, &hdev->flags);
62
63 mgmt_discovering(hdev->id, 0);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010064
Johan Hedberg23bb5762010-12-21 23:01:27 +020065 hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010066
Marcel Holtmanna9de9242007-10-20 13:33:56 +020067 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070068}
69
Marcel Holtmanna9de9242007-10-20 13:33:56 +020070static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070071{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020072 __u8 status = *((__u8 *) skb->data);
73
74 BT_DBG("%s status 0x%x", hdev->name, status);
75
76 if (status)
77 return;
78
Marcel Holtmanna9de9242007-10-20 13:33:56 +020079 hci_conn_check_pending(hdev);
80}
81
82static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
83{
84 BT_DBG("%s", hdev->name);
85}
86
87static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
88{
89 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070090 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
Marcel Holtmanna9de9242007-10-20 13:33:56 +020092 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070093
Marcel Holtmanna9de9242007-10-20 13:33:56 +020094 if (rp->status)
95 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070096
Marcel Holtmanna9de9242007-10-20 13:33:56 +020097 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Marcel Holtmanna9de9242007-10-20 13:33:56 +020099 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
100 if (conn) {
101 if (rp->role)
102 conn->link_mode &= ~HCI_LM_MASTER;
103 else
104 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200106
107 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108}
109
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200110static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
111{
112 struct hci_rp_read_link_policy *rp = (void *) skb->data;
113 struct hci_conn *conn;
114
115 BT_DBG("%s status 0x%x", hdev->name, rp->status);
116
117 if (rp->status)
118 return;
119
120 hci_dev_lock(hdev);
121
122 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
123 if (conn)
124 conn->link_policy = __le16_to_cpu(rp->policy);
125
126 hci_dev_unlock(hdev);
127}
128
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200129static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200131 struct hci_rp_write_link_policy *rp = (void *) skb->data;
132 struct hci_conn *conn;
133 void *sent;
134
135 BT_DBG("%s status 0x%x", hdev->name, rp->status);
136
137 if (rp->status)
138 return;
139
140 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
141 if (!sent)
142 return;
143
144 hci_dev_lock(hdev);
145
146 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200147 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700148 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200149
150 hci_dev_unlock(hdev);
151}
152
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200153static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
154{
155 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
156
157 BT_DBG("%s status 0x%x", hdev->name, rp->status);
158
159 if (rp->status)
160 return;
161
162 hdev->link_policy = __le16_to_cpu(rp->policy);
163}
164
165static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
166{
167 __u8 status = *((__u8 *) skb->data);
168 void *sent;
169
170 BT_DBG("%s status 0x%x", hdev->name, status);
171
172 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
173 if (!sent)
174 return;
175
176 if (!status)
177 hdev->link_policy = get_unaligned_le16(sent);
178
Johan Hedberg23bb5762010-12-21 23:01:27 +0200179 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200180}
181
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200182static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
183{
184 __u8 status = *((__u8 *) skb->data);
185
186 BT_DBG("%s status 0x%x", hdev->name, status);
187
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300188 clear_bit(HCI_RESET, &hdev->flags);
189
Johan Hedberg23bb5762010-12-21 23:01:27 +0200190 hci_req_complete(hdev, HCI_OP_RESET, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200191}
192
193static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
194{
195 __u8 status = *((__u8 *) skb->data);
196 void *sent;
197
198 BT_DBG("%s status 0x%x", hdev->name, status);
199
200 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
201 if (!sent)
202 return;
203
Johan Hedbergb312b1612011-03-16 14:29:37 +0200204 if (test_bit(HCI_MGMT, &hdev->flags))
205 mgmt_set_local_name_complete(hdev->id, sent, status);
206
207 if (status)
208 return;
209
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200210 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200211}
212
213static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
214{
215 struct hci_rp_read_local_name *rp = (void *) skb->data;
216
217 BT_DBG("%s status 0x%x", hdev->name, rp->status);
218
219 if (rp->status)
220 return;
221
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200222 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200223}
224
225static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
226{
227 __u8 status = *((__u8 *) skb->data);
228 void *sent;
229
230 BT_DBG("%s status 0x%x", hdev->name, status);
231
232 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
233 if (!sent)
234 return;
235
236 if (!status) {
237 __u8 param = *((__u8 *) sent);
238
239 if (param == AUTH_ENABLED)
240 set_bit(HCI_AUTH, &hdev->flags);
241 else
242 clear_bit(HCI_AUTH, &hdev->flags);
243 }
244
Johan Hedberg23bb5762010-12-21 23:01:27 +0200245 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200246}
247
248static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
249{
250 __u8 status = *((__u8 *) skb->data);
251 void *sent;
252
253 BT_DBG("%s status 0x%x", hdev->name, status);
254
255 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
256 if (!sent)
257 return;
258
259 if (!status) {
260 __u8 param = *((__u8 *) sent);
261
262 if (param)
263 set_bit(HCI_ENCRYPT, &hdev->flags);
264 else
265 clear_bit(HCI_ENCRYPT, &hdev->flags);
266 }
267
Johan Hedberg23bb5762010-12-21 23:01:27 +0200268 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200269}
270
271static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
272{
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200273 __u8 param, status = *((__u8 *) skb->data);
274 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200275 void *sent;
276
277 BT_DBG("%s status 0x%x", hdev->name, status);
278
279 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
280 if (!sent)
281 return;
282
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200283 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200284
Johan Hedberg2d7cee52011-11-07 22:16:03 +0200285 if (status != 0) {
286 mgmt_write_scan_failed(hdev->id, param, status);
287 hdev->discov_timeout = 0;
288 goto done;
289 }
290
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200291 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
292 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200293
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200294 if (param & SCAN_INQUIRY) {
295 set_bit(HCI_ISCAN, &hdev->flags);
296 if (!old_iscan)
297 mgmt_discoverable(hdev->id, 1);
Johan Hedberg16ab91a2011-11-07 22:16:02 +0200298 if (hdev->discov_timeout > 0) {
299 int to = msecs_to_jiffies(hdev->discov_timeout * 1000);
300 queue_delayed_work(hdev->workqueue, &hdev->discov_off,
301 to);
302 }
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200303 } else if (old_iscan)
304 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200305
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200306 if (param & SCAN_PAGE) {
307 set_bit(HCI_PSCAN, &hdev->flags);
308 if (!old_pscan)
309 mgmt_connectable(hdev->id, 1);
310 } else if (old_pscan)
311 mgmt_connectable(hdev->id, 0);
312
313done:
Johan Hedberg23bb5762010-12-21 23:01:27 +0200314 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200315}
316
317static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
318{
319 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
320
321 BT_DBG("%s status 0x%x", hdev->name, rp->status);
322
323 if (rp->status)
324 return;
325
326 memcpy(hdev->dev_class, rp->dev_class, 3);
327
328 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
329 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
330}
331
332static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
333{
334 __u8 status = *((__u8 *) skb->data);
335 void *sent;
336
337 BT_DBG("%s status 0x%x", hdev->name, status);
338
Marcel Holtmannf383f272008-07-14 20:13:47 +0200339 if (status)
340 return;
341
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200342 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
343 if (!sent)
344 return;
345
Marcel Holtmannf383f272008-07-14 20:13:47 +0200346 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200347}
348
349static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
350{
351 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200353
354 BT_DBG("%s status 0x%x", hdev->name, rp->status);
355
356 if (rp->status)
357 return;
358
359 setting = __le16_to_cpu(rp->voice_setting);
360
Marcel Holtmannf383f272008-07-14 20:13:47 +0200361 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200362 return;
363
364 hdev->voice_setting = setting;
365
366 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
367
368 if (hdev->notify) {
369 tasklet_disable(&hdev->tx_task);
370 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
371 tasklet_enable(&hdev->tx_task);
372 }
373}
374
375static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
376{
377 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200378 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 void *sent;
380
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200381 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382
Marcel Holtmannf383f272008-07-14 20:13:47 +0200383 if (status)
384 return;
385
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200386 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
387 if (!sent)
388 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389
Marcel Holtmannf383f272008-07-14 20:13:47 +0200390 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391
Marcel Holtmannf383f272008-07-14 20:13:47 +0200392 if (hdev->voice_setting == setting)
393 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394
Marcel Holtmannf383f272008-07-14 20:13:47 +0200395 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
Marcel Holtmannf383f272008-07-14 20:13:47 +0200397 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
398
399 if (hdev->notify) {
400 tasklet_disable(&hdev->tx_task);
401 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
402 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403 }
404}
405
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200406static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200408 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200410 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411
Johan Hedberg23bb5762010-12-21 23:01:27 +0200412 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413}
414
Marcel Holtmann333140b2008-07-14 20:13:48 +0200415static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
416{
417 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
418
419 BT_DBG("%s status 0x%x", hdev->name, rp->status);
420
421 if (rp->status)
422 return;
423
424 hdev->ssp_mode = rp->mode;
425}
426
427static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
428{
429 __u8 status = *((__u8 *) skb->data);
430 void *sent;
431
432 BT_DBG("%s status 0x%x", hdev->name, status);
433
434 if (status)
435 return;
436
437 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
438 if (!sent)
439 return;
440
441 hdev->ssp_mode = *((__u8 *) sent);
442}
443
Johan Hedbergd5859e22011-01-25 01:19:58 +0200444static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
445{
446 if (hdev->features[6] & LMP_EXT_INQ)
447 return 2;
448
449 if (hdev->features[3] & LMP_RSSI_INQ)
450 return 1;
451
452 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
453 hdev->lmp_subver == 0x0757)
454 return 1;
455
456 if (hdev->manufacturer == 15) {
457 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
458 return 1;
459 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
460 return 1;
461 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
462 return 1;
463 }
464
465 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
466 hdev->lmp_subver == 0x1805)
467 return 1;
468
469 return 0;
470}
471
472static void hci_setup_inquiry_mode(struct hci_dev *hdev)
473{
474 u8 mode;
475
476 mode = hci_get_inquiry_mode(hdev);
477
478 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
479}
480
481static void hci_setup_event_mask(struct hci_dev *hdev)
482{
483 /* The second byte is 0xff instead of 0x9f (two reserved bits
484 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
485 * command otherwise */
486 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
487
Ville Tervo6de6c182011-05-27 11:16:21 +0300488 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
489 * any event mask for pre 1.2 devices */
490 if (hdev->lmp_ver <= 1)
491 return;
492
493 events[4] |= 0x01; /* Flow Specification Complete */
494 events[4] |= 0x02; /* Inquiry Result with RSSI */
495 events[4] |= 0x04; /* Read Remote Extended Features Complete */
496 events[5] |= 0x08; /* Synchronous Connection Complete */
497 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200498
499 if (hdev->features[3] & LMP_RSSI_INQ)
500 events[4] |= 0x04; /* Inquiry Result with RSSI */
501
502 if (hdev->features[5] & LMP_SNIFF_SUBR)
503 events[5] |= 0x20; /* Sniff Subrating */
504
505 if (hdev->features[5] & LMP_PAUSE_ENC)
506 events[5] |= 0x80; /* Encryption Key Refresh Complete */
507
508 if (hdev->features[6] & LMP_EXT_INQ)
509 events[5] |= 0x40; /* Extended Inquiry Result */
510
511 if (hdev->features[6] & LMP_NO_FLUSH)
512 events[7] |= 0x01; /* Enhanced Flush Complete */
513
514 if (hdev->features[7] & LMP_LSTO)
515 events[6] |= 0x80; /* Link Supervision Timeout Changed */
516
517 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
518 events[6] |= 0x01; /* IO Capability Request */
519 events[6] |= 0x02; /* IO Capability Response */
520 events[6] |= 0x04; /* User Confirmation Request */
521 events[6] |= 0x08; /* User Passkey Request */
522 events[6] |= 0x10; /* Remote OOB Data Request */
523 events[6] |= 0x20; /* Simple Pairing Complete */
524 events[7] |= 0x04; /* User Passkey Notification */
525 events[7] |= 0x08; /* Keypress Notification */
526 events[7] |= 0x10; /* Remote Host Supported
527 * Features Notification */
528 }
529
530 if (hdev->features[4] & LMP_LE)
531 events[7] |= 0x20; /* LE Meta-Event */
532
533 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
534}
535
Andre Guedese6100a22011-06-30 19:20:54 -0300536static void hci_set_le_support(struct hci_dev *hdev)
537{
538 struct hci_cp_write_le_host_supported cp;
539
540 memset(&cp, 0, sizeof(cp));
541
542 if (enable_le) {
543 cp.le = 1;
544 cp.simul = !!(hdev->features[6] & LMP_SIMUL_LE_BR);
545 }
546
547 hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(cp), &cp);
548}
549
Johan Hedbergd5859e22011-01-25 01:19:58 +0200550static void hci_setup(struct hci_dev *hdev)
551{
552 hci_setup_event_mask(hdev);
553
554 if (hdev->lmp_ver > 1)
555 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
556
557 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
558 u8 mode = 0x01;
559 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
560 }
561
562 if (hdev->features[3] & LMP_RSSI_INQ)
563 hci_setup_inquiry_mode(hdev);
564
565 if (hdev->features[7] & LMP_INQ_TX_PWR)
566 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
Andre Guedes971e3a42011-06-30 19:20:52 -0300567
568 if (hdev->features[7] & LMP_EXTFEATURES) {
569 struct hci_cp_read_local_ext_features cp;
570
571 cp.page = 0x01;
572 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES,
573 sizeof(cp), &cp);
574 }
Andre Guedese6100a22011-06-30 19:20:54 -0300575
576 if (hdev->features[4] & LMP_LE)
577 hci_set_le_support(hdev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200578}
579
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200580static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
581{
582 struct hci_rp_read_local_version *rp = (void *) skb->data;
583
584 BT_DBG("%s status 0x%x", hdev->name, rp->status);
585
586 if (rp->status)
587 return;
588
589 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200590 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200591 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200592 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200593 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200594
595 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
596 hdev->manufacturer,
597 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200598
599 if (test_bit(HCI_INIT, &hdev->flags))
600 hci_setup(hdev);
601}
602
603static void hci_setup_link_policy(struct hci_dev *hdev)
604{
605 u16 link_policy = 0;
606
607 if (hdev->features[0] & LMP_RSWITCH)
608 link_policy |= HCI_LP_RSWITCH;
609 if (hdev->features[0] & LMP_HOLD)
610 link_policy |= HCI_LP_HOLD;
611 if (hdev->features[0] & LMP_SNIFF)
612 link_policy |= HCI_LP_SNIFF;
613 if (hdev->features[1] & LMP_PARK)
614 link_policy |= HCI_LP_PARK;
615
616 link_policy = cpu_to_le16(link_policy);
617 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
618 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200619}
620
621static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
622{
623 struct hci_rp_read_local_commands *rp = (void *) skb->data;
624
625 BT_DBG("%s status 0x%x", hdev->name, rp->status);
626
627 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200628 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200629
630 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200631
632 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
633 hci_setup_link_policy(hdev);
634
635done:
636 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200637}
638
639static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
640{
641 struct hci_rp_read_local_features *rp = (void *) skb->data;
642
643 BT_DBG("%s status 0x%x", hdev->name, rp->status);
644
645 if (rp->status)
646 return;
647
648 memcpy(hdev->features, rp->features, 8);
649
650 /* Adjust default settings according to features
651 * supported by device. */
652
653 if (hdev->features[0] & LMP_3SLOT)
654 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
655
656 if (hdev->features[0] & LMP_5SLOT)
657 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
658
659 if (hdev->features[1] & LMP_HV2) {
660 hdev->pkt_type |= (HCI_HV2);
661 hdev->esco_type |= (ESCO_HV2);
662 }
663
664 if (hdev->features[1] & LMP_HV3) {
665 hdev->pkt_type |= (HCI_HV3);
666 hdev->esco_type |= (ESCO_HV3);
667 }
668
669 if (hdev->features[3] & LMP_ESCO)
670 hdev->esco_type |= (ESCO_EV3);
671
672 if (hdev->features[4] & LMP_EV4)
673 hdev->esco_type |= (ESCO_EV4);
674
675 if (hdev->features[4] & LMP_EV5)
676 hdev->esco_type |= (ESCO_EV5);
677
Marcel Holtmannefc76882009-02-06 09:13:37 +0100678 if (hdev->features[5] & LMP_EDR_ESCO_2M)
679 hdev->esco_type |= (ESCO_2EV3);
680
681 if (hdev->features[5] & LMP_EDR_ESCO_3M)
682 hdev->esco_type |= (ESCO_3EV3);
683
684 if (hdev->features[5] & LMP_EDR_3S_ESCO)
685 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
686
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200687 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
688 hdev->features[0], hdev->features[1],
689 hdev->features[2], hdev->features[3],
690 hdev->features[4], hdev->features[5],
691 hdev->features[6], hdev->features[7]);
692}
693
Andre Guedes971e3a42011-06-30 19:20:52 -0300694static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
695 struct sk_buff *skb)
696{
697 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
698
699 BT_DBG("%s status 0x%x", hdev->name, rp->status);
700
701 if (rp->status)
702 return;
703
704 memcpy(hdev->extfeatures, rp->features, 8);
705
706 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
707}
708
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200709static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
710{
711 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
712
713 BT_DBG("%s status 0x%x", hdev->name, rp->status);
714
715 if (rp->status)
716 return;
717
718 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
719 hdev->sco_mtu = rp->sco_mtu;
720 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
721 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
722
723 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
724 hdev->sco_mtu = 64;
725 hdev->sco_pkts = 8;
726 }
727
728 hdev->acl_cnt = hdev->acl_pkts;
729 hdev->sco_cnt = hdev->sco_pkts;
730
731 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
732 hdev->acl_mtu, hdev->acl_pkts,
733 hdev->sco_mtu, hdev->sco_pkts);
734}
735
736static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
737{
738 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
739
740 BT_DBG("%s status 0x%x", hdev->name, rp->status);
741
742 if (!rp->status)
743 bacpy(&hdev->bdaddr, &rp->bdaddr);
744
Johan Hedberg23bb5762010-12-21 23:01:27 +0200745 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
746}
747
748static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
749{
750 __u8 status = *((__u8 *) skb->data);
751
752 BT_DBG("%s status 0x%x", hdev->name, status);
753
754 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200755}
756
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300757static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
758 struct sk_buff *skb)
759{
760 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
761
762 BT_DBG("%s status 0x%x", hdev->name, rp->status);
763
764 if (rp->status)
765 return;
766
767 hdev->amp_status = rp->amp_status;
768 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
769 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
770 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
771 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
772 hdev->amp_type = rp->amp_type;
773 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
774 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
775 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
776 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
777
778 hci_req_complete(hdev, HCI_OP_READ_LOCAL_AMP_INFO, rp->status);
779}
780
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200781static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
782 struct sk_buff *skb)
783{
784 __u8 status = *((__u8 *) skb->data);
785
786 BT_DBG("%s status 0x%x", hdev->name, status);
787
788 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
789}
790
Johan Hedbergd5859e22011-01-25 01:19:58 +0200791static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
792{
793 __u8 status = *((__u8 *) skb->data);
794
795 BT_DBG("%s status 0x%x", hdev->name, status);
796
797 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
798}
799
800static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
801 struct sk_buff *skb)
802{
803 __u8 status = *((__u8 *) skb->data);
804
805 BT_DBG("%s status 0x%x", hdev->name, status);
806
807 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
808}
809
810static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
811 struct sk_buff *skb)
812{
813 __u8 status = *((__u8 *) skb->data);
814
815 BT_DBG("%s status 0x%x", hdev->name, status);
816
817 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
818}
819
820static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
821{
822 __u8 status = *((__u8 *) skb->data);
823
824 BT_DBG("%s status 0x%x", hdev->name, status);
825
826 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
827}
828
Johan Hedberg980e1a52011-01-22 06:10:07 +0200829static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
830{
831 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
832 struct hci_cp_pin_code_reply *cp;
833 struct hci_conn *conn;
834
835 BT_DBG("%s status 0x%x", hdev->name, rp->status);
836
837 if (test_bit(HCI_MGMT, &hdev->flags))
838 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
839
840 if (rp->status != 0)
841 return;
842
843 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
844 if (!cp)
845 return;
846
847 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
848 if (conn)
849 conn->pin_length = cp->pin_len;
850}
851
852static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
853{
854 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
855
856 BT_DBG("%s status 0x%x", hdev->name, rp->status);
857
858 if (test_bit(HCI_MGMT, &hdev->flags))
859 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
860 rp->status);
861}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300862static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
863 struct sk_buff *skb)
864{
865 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
866
867 BT_DBG("%s status 0x%x", hdev->name, rp->status);
868
869 if (rp->status)
870 return;
871
872 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
873 hdev->le_pkts = rp->le_max_pkt;
874
875 hdev->le_cnt = hdev->le_pkts;
876
877 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
878
879 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
880}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200881
Johan Hedberga5c29682011-02-19 12:05:57 -0300882static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
883{
884 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
885
886 BT_DBG("%s status 0x%x", hdev->name, rp->status);
887
888 if (test_bit(HCI_MGMT, &hdev->flags))
889 mgmt_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
890 rp->status);
891}
892
893static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
894 struct sk_buff *skb)
895{
896 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
897
898 BT_DBG("%s status 0x%x", hdev->name, rp->status);
899
900 if (test_bit(HCI_MGMT, &hdev->flags))
901 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
902 rp->status);
903}
904
Szymon Jancc35938b2011-03-22 13:12:21 +0100905static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
906 struct sk_buff *skb)
907{
908 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
909
910 BT_DBG("%s status 0x%x", hdev->name, rp->status);
911
912 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
913 rp->randomizer, rp->status);
914}
915
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300916static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
917 struct sk_buff *skb)
918{
919 struct hci_cp_le_set_scan_enable *cp;
920 __u8 status = *((__u8 *) skb->data);
921
922 BT_DBG("%s status 0x%x", hdev->name, status);
923
924 if (status)
925 return;
926
927 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
928 if (!cp)
929 return;
930
Andre Guedes35815082011-05-26 16:23:53 -0300931 if (cp->enable == 0x01) {
932 del_timer(&hdev->adv_timer);
Andre Guedesa8f13c82011-09-09 18:56:24 -0300933
934 hci_dev_lock(hdev);
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300935 hci_adv_entries_clear(hdev);
Andre Guedesa8f13c82011-09-09 18:56:24 -0300936 hci_dev_unlock(hdev);
Andre Guedes35815082011-05-26 16:23:53 -0300937 } else if (cp->enable == 0x00) {
938 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
939 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300940}
941
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300942static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
943{
944 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
945
946 BT_DBG("%s status 0x%x", hdev->name, rp->status);
947
948 if (rp->status)
949 return;
950
951 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
952}
953
954static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
955{
956 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
957
958 BT_DBG("%s status 0x%x", hdev->name, rp->status);
959
960 if (rp->status)
961 return;
962
963 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
964}
965
Andre Guedesf9b49302011-06-30 19:20:53 -0300966static inline void hci_cc_write_le_host_supported(struct hci_dev *hdev,
967 struct sk_buff *skb)
968{
969 struct hci_cp_read_local_ext_features cp;
970 __u8 status = *((__u8 *) skb->data);
971
972 BT_DBG("%s status 0x%x", hdev->name, status);
973
974 if (status)
975 return;
976
977 cp.page = 0x01;
978 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp), &cp);
979}
980
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200981static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
982{
983 BT_DBG("%s status 0x%x", hdev->name, status);
984
985 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200986 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200987 hci_conn_check_pending(hdev);
Johan Hedberg164a6e72011-11-01 17:06:44 +0200988 if (test_bit(HCI_MGMT, &hdev->flags))
989 mgmt_inquiry_failed(hdev->id, status);
Johan Hedberg314b2382011-04-27 10:29:57 -0400990 return;
991 }
992
Andre Guedes89352e72011-11-04 14:16:53 -0300993 set_bit(HCI_INQUIRY, &hdev->flags);
994
995 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200996}
997
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
999{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001000 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001003 BT_DBG("%s status 0x%x", hdev->name, status);
1004
1005 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006 if (!cp)
1007 return;
1008
1009 hci_dev_lock(hdev);
1010
1011 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1012
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001013 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001014
1015 if (status) {
1016 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001017 if (status != 0x0c || conn->attempt > 2) {
1018 conn->state = BT_CLOSED;
1019 hci_proto_connect_cfm(conn, status);
1020 hci_conn_del(conn);
1021 } else
1022 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023 }
1024 } else {
1025 if (!conn) {
1026 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1027 if (conn) {
1028 conn->out = 1;
1029 conn->link_mode |= HCI_LM_MASTER;
1030 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001031 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032 }
1033 }
1034
1035 hci_dev_unlock(hdev);
1036}
1037
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001038static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001040 struct hci_cp_add_sco *cp;
1041 struct hci_conn *acl, *sco;
1042 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001044 BT_DBG("%s status 0x%x", hdev->name, status);
1045
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001046 if (!status)
1047 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001048
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001049 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1050 if (!cp)
1051 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001052
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001053 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001054
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001055 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001056
1057 hci_dev_lock(hdev);
1058
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001059 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001060 if (acl) {
1061 sco = acl->link;
1062 if (sco) {
1063 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001064
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001065 hci_proto_connect_cfm(sco, status);
1066 hci_conn_del(sco);
1067 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001068 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001069
1070 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001071}
1072
Marcel Holtmannf8558552008-07-14 20:13:49 +02001073static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1074{
1075 struct hci_cp_auth_requested *cp;
1076 struct hci_conn *conn;
1077
1078 BT_DBG("%s status 0x%x", hdev->name, status);
1079
1080 if (!status)
1081 return;
1082
1083 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1084 if (!cp)
1085 return;
1086
1087 hci_dev_lock(hdev);
1088
1089 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1090 if (conn) {
1091 if (conn->state == BT_CONFIG) {
1092 hci_proto_connect_cfm(conn, status);
1093 hci_conn_put(conn);
1094 }
1095 }
1096
1097 hci_dev_unlock(hdev);
1098}
1099
1100static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1101{
1102 struct hci_cp_set_conn_encrypt *cp;
1103 struct hci_conn *conn;
1104
1105 BT_DBG("%s status 0x%x", hdev->name, status);
1106
1107 if (!status)
1108 return;
1109
1110 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1111 if (!cp)
1112 return;
1113
1114 hci_dev_lock(hdev);
1115
1116 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1117 if (conn) {
1118 if (conn->state == BT_CONFIG) {
1119 hci_proto_connect_cfm(conn, status);
1120 hci_conn_put(conn);
1121 }
1122 }
1123
1124 hci_dev_unlock(hdev);
1125}
1126
Johan Hedberg127178d2010-11-18 22:22:29 +02001127static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001128 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001129{
Johan Hedberg392599b2010-11-18 22:22:28 +02001130 if (conn->state != BT_CONFIG || !conn->out)
1131 return 0;
1132
Johan Hedberg765c2a92011-01-19 12:06:52 +05301133 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001134 return 0;
1135
1136 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001137 * devices with sec_level HIGH or if MITM protection is requested */
Johan Hedberg392599b2010-11-18 22:22:28 +02001138 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001139 conn->pending_sec_level != BT_SECURITY_HIGH &&
1140 !(conn->auth_type & 0x01))
Johan Hedberg392599b2010-11-18 22:22:28 +02001141 return 0;
1142
Johan Hedberg392599b2010-11-18 22:22:28 +02001143 return 1;
1144}
1145
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001146static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1147{
Johan Hedberg127178d2010-11-18 22:22:29 +02001148 struct hci_cp_remote_name_req *cp;
1149 struct hci_conn *conn;
1150
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001151 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001152
1153 /* If successful wait for the name req complete event before
1154 * checking for the need to do authentication */
1155 if (!status)
1156 return;
1157
1158 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1159 if (!cp)
1160 return;
1161
1162 hci_dev_lock(hdev);
1163
1164 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001165 if (!conn)
1166 goto unlock;
1167
1168 if (!hci_outgoing_auth_needed(hdev, conn))
1169 goto unlock;
1170
1171 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001172 struct hci_cp_auth_requested cp;
1173 cp.handle = __cpu_to_le16(conn->handle);
1174 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1175 }
1176
Johan Hedberg79c6c702011-04-28 11:28:55 -07001177unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001178 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001179}
1180
Marcel Holtmann769be972008-07-14 20:13:49 +02001181static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1182{
1183 struct hci_cp_read_remote_features *cp;
1184 struct hci_conn *conn;
1185
1186 BT_DBG("%s status 0x%x", hdev->name, status);
1187
1188 if (!status)
1189 return;
1190
1191 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1192 if (!cp)
1193 return;
1194
1195 hci_dev_lock(hdev);
1196
1197 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1198 if (conn) {
1199 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001200 hci_proto_connect_cfm(conn, status);
1201 hci_conn_put(conn);
1202 }
1203 }
1204
1205 hci_dev_unlock(hdev);
1206}
1207
1208static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1209{
1210 struct hci_cp_read_remote_ext_features *cp;
1211 struct hci_conn *conn;
1212
1213 BT_DBG("%s status 0x%x", hdev->name, status);
1214
1215 if (!status)
1216 return;
1217
1218 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1219 if (!cp)
1220 return;
1221
1222 hci_dev_lock(hdev);
1223
1224 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1225 if (conn) {
1226 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001227 hci_proto_connect_cfm(conn, status);
1228 hci_conn_put(conn);
1229 }
1230 }
1231
1232 hci_dev_unlock(hdev);
1233}
1234
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001235static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1236{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001237 struct hci_cp_setup_sync_conn *cp;
1238 struct hci_conn *acl, *sco;
1239 __u16 handle;
1240
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001241 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001242
1243 if (!status)
1244 return;
1245
1246 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1247 if (!cp)
1248 return;
1249
1250 handle = __le16_to_cpu(cp->handle);
1251
1252 BT_DBG("%s handle %d", hdev->name, handle);
1253
1254 hci_dev_lock(hdev);
1255
1256 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001257 if (acl) {
1258 sco = acl->link;
1259 if (sco) {
1260 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001261
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001262 hci_proto_connect_cfm(sco, status);
1263 hci_conn_del(sco);
1264 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001265 }
1266
1267 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001268}
1269
1270static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1271{
1272 struct hci_cp_sniff_mode *cp;
1273 struct hci_conn *conn;
1274
1275 BT_DBG("%s status 0x%x", hdev->name, status);
1276
1277 if (!status)
1278 return;
1279
1280 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1281 if (!cp)
1282 return;
1283
1284 hci_dev_lock(hdev);
1285
1286 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001287 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001288 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1289
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001290 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1291 hci_sco_setup(conn, status);
1292 }
1293
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001294 hci_dev_unlock(hdev);
1295}
1296
1297static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1298{
1299 struct hci_cp_exit_sniff_mode *cp;
1300 struct hci_conn *conn;
1301
1302 BT_DBG("%s status 0x%x", hdev->name, status);
1303
1304 if (!status)
1305 return;
1306
1307 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1308 if (!cp)
1309 return;
1310
1311 hci_dev_lock(hdev);
1312
1313 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001314 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001315 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1316
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001317 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1318 hci_sco_setup(conn, status);
1319 }
1320
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001321 hci_dev_unlock(hdev);
1322}
1323
Ville Tervofcd89c02011-02-10 22:38:47 -03001324static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1325{
1326 struct hci_cp_le_create_conn *cp;
1327 struct hci_conn *conn;
1328
1329 BT_DBG("%s status 0x%x", hdev->name, status);
1330
1331 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1332 if (!cp)
1333 return;
1334
1335 hci_dev_lock(hdev);
1336
1337 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1338
1339 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1340 conn);
1341
1342 if (status) {
1343 if (conn && conn->state == BT_CONNECT) {
1344 conn->state = BT_CLOSED;
1345 hci_proto_connect_cfm(conn, status);
1346 hci_conn_del(conn);
1347 }
1348 } else {
1349 if (!conn) {
1350 conn = hci_conn_add(hdev, LE_LINK, &cp->peer_addr);
Andre Guedes29b79882011-05-31 14:20:54 -03001351 if (conn) {
1352 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001353 conn->out = 1;
Andre Guedes29b79882011-05-31 14:20:54 -03001354 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001355 BT_ERR("No memory for new connection");
Andre Guedes29b79882011-05-31 14:20:54 -03001356 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001357 }
1358 }
1359
1360 hci_dev_unlock(hdev);
1361}
1362
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001363static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1364{
1365 BT_DBG("%s status 0x%x", hdev->name, status);
1366}
1367
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001368static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1369{
1370 __u8 status = *((__u8 *) skb->data);
1371
1372 BT_DBG("%s status %d", hdev->name, status);
1373
Johan Hedberg23bb5762010-12-21 23:01:27 +02001374 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001375
1376 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001377
1378 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1379 return;
1380
1381 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001382}
1383
Linus Torvalds1da177e2005-04-16 15:20:36 -07001384static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1385{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001386 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001387 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001388 int num_rsp = *((__u8 *) skb->data);
1389
1390 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1391
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001392 if (!num_rsp)
1393 return;
1394
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001396
Johan Hedberge17acd42011-03-30 23:57:16 +03001397 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001398 bacpy(&data.bdaddr, &info->bdaddr);
1399 data.pscan_rep_mode = info->pscan_rep_mode;
1400 data.pscan_period_mode = info->pscan_period_mode;
1401 data.pscan_mode = info->pscan_mode;
1402 memcpy(data.dev_class, info->dev_class, 3);
1403 data.clock_offset = info->clock_offset;
1404 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001405 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406 hci_inquiry_cache_update(hdev, &data);
Johan Hedberg4c659c32011-11-07 23:13:39 +02001407 mgmt_device_found(hdev->id, &info->bdaddr, ACL_LINK,
1408 info->dev_class, 0, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001410
Linus Torvalds1da177e2005-04-16 15:20:36 -07001411 hci_dev_unlock(hdev);
1412}
1413
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001414static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001415{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001416 struct hci_ev_conn_complete *ev = (void *) skb->data;
1417 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001418
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001419 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001420
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001422
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001423 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001424 if (!conn) {
1425 if (ev->link_type != SCO_LINK)
1426 goto unlock;
1427
1428 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1429 if (!conn)
1430 goto unlock;
1431
1432 conn->type = SCO_LINK;
1433 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001434
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001435 if (!ev->status) {
1436 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001437
1438 if (conn->type == ACL_LINK) {
1439 conn->state = BT_CONFIG;
1440 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001441 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Vinicius Costa Gomescfafccf2011-08-19 21:06:56 -03001442 mgmt_connected(hdev->id, &ev->bdaddr, conn->type);
Marcel Holtmann769be972008-07-14 20:13:49 +02001443 } else
1444 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001445
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001446 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001447 hci_conn_add_sysfs(conn);
1448
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001449 if (test_bit(HCI_AUTH, &hdev->flags))
1450 conn->link_mode |= HCI_LM_AUTH;
1451
1452 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1453 conn->link_mode |= HCI_LM_ENCRYPT;
1454
1455 /* Get remote features */
1456 if (conn->type == ACL_LINK) {
1457 struct hci_cp_read_remote_features cp;
1458 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001459 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1460 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001461 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001462
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001463 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001464 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001465 struct hci_cp_change_conn_ptype cp;
1466 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001467 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1468 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1469 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001470 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001471 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001472 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001473 if (conn->type == ACL_LINK)
Johan Hedberg4c659c32011-11-07 23:13:39 +02001474 mgmt_connect_failed(hdev->id, &ev->bdaddr, conn->type,
1475 ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02001476 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001477
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001478 if (conn->type == ACL_LINK)
1479 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001480
Marcel Holtmann769be972008-07-14 20:13:49 +02001481 if (ev->status) {
1482 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001483 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001484 } else if (ev->link_type != ACL_LINK)
1485 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001486
1487unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001489
1490 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001491}
1492
Linus Torvalds1da177e2005-04-16 15:20:36 -07001493static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1494{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001495 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001496 int mask = hdev->link_mode;
1497
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001498 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1499 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001500
1501 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1502
Szymon Janc138d22e2011-02-17 16:44:23 +01001503 if ((mask & HCI_LM_ACCEPT) &&
1504 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001505 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001506 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001508
1509 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001510
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001511 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1512 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001513 memcpy(ie->data.dev_class, ev->dev_class, 3);
1514
Linus Torvalds1da177e2005-04-16 15:20:36 -07001515 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1516 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001517 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1518 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001519 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001520 hci_dev_unlock(hdev);
1521 return;
1522 }
1523 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001524
Linus Torvalds1da177e2005-04-16 15:20:36 -07001525 memcpy(conn->dev_class, ev->dev_class, 3);
1526 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001527
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528 hci_dev_unlock(hdev);
1529
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001530 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1531 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001532
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001533 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001534
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001535 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1536 cp.role = 0x00; /* Become master */
1537 else
1538 cp.role = 0x01; /* Remain slave */
1539
1540 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1541 sizeof(cp), &cp);
1542 } else {
1543 struct hci_cp_accept_sync_conn_req cp;
1544
1545 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001546 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001547
1548 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1549 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1550 cp.max_latency = cpu_to_le16(0xffff);
1551 cp.content_format = cpu_to_le16(hdev->voice_setting);
1552 cp.retrans_effort = 0xff;
1553
1554 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1555 sizeof(cp), &cp);
1556 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001557 } else {
1558 /* Connection rejected */
1559 struct hci_cp_reject_conn_req cp;
1560
1561 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02001562 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001563 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001564 }
1565}
1566
Linus Torvalds1da177e2005-04-16 15:20:36 -07001567static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1568{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001569 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001570 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001571
1572 BT_DBG("%s status %d", hdev->name, ev->status);
1573
Johan Hedberg8962ee72011-01-20 12:40:27 +02001574 if (ev->status) {
1575 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001576 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001577 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001578
1579 hci_dev_lock(hdev);
1580
Marcel Holtmann04837f62006-07-03 10:02:33 +02001581 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001582 if (!conn)
1583 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001584
Johan Hedbergf7520542011-01-20 12:34:39 +02001585 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001586
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001587 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedberg4c659c32011-11-07 23:13:39 +02001588 mgmt_disconnected(hdev->id, &conn->dst, conn->type);
Johan Hedbergf7520542011-01-20 12:34:39 +02001589
1590 hci_proto_disconn_cfm(conn, ev->reason);
1591 hci_conn_del(conn);
1592
1593unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001594 hci_dev_unlock(hdev);
1595}
1596
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001597static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1598{
1599 struct hci_ev_auth_complete *ev = (void *) skb->data;
1600 struct hci_conn *conn;
1601
1602 BT_DBG("%s status %d", hdev->name, ev->status);
1603
1604 hci_dev_lock(hdev);
1605
1606 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001607 if (!conn)
1608 goto unlock;
1609
1610 if (!ev->status) {
1611 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1612 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1613 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001614 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001615 conn->link_mode |= HCI_LM_AUTH;
1616 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001617 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001618 } else {
1619 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1620 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001621
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001622 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1623 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001624
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001625 if (conn->state == BT_CONFIG) {
1626 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1627 struct hci_cp_set_conn_encrypt cp;
1628 cp.handle = ev->handle;
1629 cp.encrypt = 0x01;
1630 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1631 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001632 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001633 conn->state = BT_CONNECTED;
1634 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001635 hci_conn_put(conn);
1636 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001637 } else {
1638 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001639
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001640 hci_conn_hold(conn);
1641 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1642 hci_conn_put(conn);
1643 }
1644
1645 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1646 if (!ev->status) {
1647 struct hci_cp_set_conn_encrypt cp;
1648 cp.handle = ev->handle;
1649 cp.encrypt = 0x01;
1650 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1651 &cp);
1652 } else {
1653 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1654 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001655 }
1656 }
1657
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001658unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001659 hci_dev_unlock(hdev);
1660}
1661
1662static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1663{
Johan Hedberg127178d2010-11-18 22:22:29 +02001664 struct hci_ev_remote_name *ev = (void *) skb->data;
1665 struct hci_conn *conn;
1666
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001667 BT_DBG("%s", hdev->name);
1668
1669 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001670
1671 hci_dev_lock(hdev);
1672
Johan Hedberga88a9652011-03-30 13:18:12 +03001673 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1674 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1675
Johan Hedberg127178d2010-11-18 22:22:29 +02001676 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001677 if (!conn)
1678 goto unlock;
1679
1680 if (!hci_outgoing_auth_needed(hdev, conn))
1681 goto unlock;
1682
1683 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001684 struct hci_cp_auth_requested cp;
1685 cp.handle = __cpu_to_le16(conn->handle);
1686 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1687 }
1688
Johan Hedberg79c6c702011-04-28 11:28:55 -07001689unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001690 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001691}
1692
1693static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1694{
1695 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1696 struct hci_conn *conn;
1697
1698 BT_DBG("%s status %d", hdev->name, ev->status);
1699
1700 hci_dev_lock(hdev);
1701
1702 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1703 if (conn) {
1704 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001705 if (ev->encrypt) {
1706 /* Encryption implies authentication */
1707 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001708 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03001709 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001710 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001711 conn->link_mode &= ~HCI_LM_ENCRYPT;
1712 }
1713
1714 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1715
Marcel Holtmannf8558552008-07-14 20:13:49 +02001716 if (conn->state == BT_CONFIG) {
1717 if (!ev->status)
1718 conn->state = BT_CONNECTED;
1719
1720 hci_proto_connect_cfm(conn, ev->status);
1721 hci_conn_put(conn);
1722 } else
1723 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001724 }
1725
1726 hci_dev_unlock(hdev);
1727}
1728
1729static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1730{
1731 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1732 struct hci_conn *conn;
1733
1734 BT_DBG("%s status %d", hdev->name, ev->status);
1735
1736 hci_dev_lock(hdev);
1737
1738 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1739 if (conn) {
1740 if (!ev->status)
1741 conn->link_mode |= HCI_LM_SECURE;
1742
1743 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1744
1745 hci_key_change_cfm(conn, ev->status);
1746 }
1747
1748 hci_dev_unlock(hdev);
1749}
1750
1751static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1752{
1753 struct hci_ev_remote_features *ev = (void *) skb->data;
1754 struct hci_conn *conn;
1755
1756 BT_DBG("%s status %d", hdev->name, ev->status);
1757
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001758 hci_dev_lock(hdev);
1759
1760 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001761 if (!conn)
1762 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001763
Johan Hedbergccd556f2010-11-10 17:11:51 +02001764 if (!ev->status)
1765 memcpy(conn->features, ev->features, 8);
1766
1767 if (conn->state != BT_CONFIG)
1768 goto unlock;
1769
1770 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1771 struct hci_cp_read_remote_ext_features cp;
1772 cp.handle = ev->handle;
1773 cp.page = 0x01;
1774 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001775 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001776 goto unlock;
1777 }
1778
Johan Hedberg127178d2010-11-18 22:22:29 +02001779 if (!ev->status) {
1780 struct hci_cp_remote_name_req cp;
1781 memset(&cp, 0, sizeof(cp));
1782 bacpy(&cp.bdaddr, &conn->dst);
1783 cp.pscan_rep_mode = 0x02;
1784 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1785 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001786
Johan Hedberg127178d2010-11-18 22:22:29 +02001787 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001788 conn->state = BT_CONNECTED;
1789 hci_proto_connect_cfm(conn, ev->status);
1790 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001791 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001792
Johan Hedbergccd556f2010-11-10 17:11:51 +02001793unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001794 hci_dev_unlock(hdev);
1795}
1796
1797static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1798{
1799 BT_DBG("%s", hdev->name);
1800}
1801
1802static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1803{
1804 BT_DBG("%s", hdev->name);
1805}
1806
1807static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1808{
1809 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1810 __u16 opcode;
1811
1812 skb_pull(skb, sizeof(*ev));
1813
1814 opcode = __le16_to_cpu(ev->opcode);
1815
1816 switch (opcode) {
1817 case HCI_OP_INQUIRY_CANCEL:
1818 hci_cc_inquiry_cancel(hdev, skb);
1819 break;
1820
1821 case HCI_OP_EXIT_PERIODIC_INQ:
1822 hci_cc_exit_periodic_inq(hdev, skb);
1823 break;
1824
1825 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1826 hci_cc_remote_name_req_cancel(hdev, skb);
1827 break;
1828
1829 case HCI_OP_ROLE_DISCOVERY:
1830 hci_cc_role_discovery(hdev, skb);
1831 break;
1832
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001833 case HCI_OP_READ_LINK_POLICY:
1834 hci_cc_read_link_policy(hdev, skb);
1835 break;
1836
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001837 case HCI_OP_WRITE_LINK_POLICY:
1838 hci_cc_write_link_policy(hdev, skb);
1839 break;
1840
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001841 case HCI_OP_READ_DEF_LINK_POLICY:
1842 hci_cc_read_def_link_policy(hdev, skb);
1843 break;
1844
1845 case HCI_OP_WRITE_DEF_LINK_POLICY:
1846 hci_cc_write_def_link_policy(hdev, skb);
1847 break;
1848
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001849 case HCI_OP_RESET:
1850 hci_cc_reset(hdev, skb);
1851 break;
1852
1853 case HCI_OP_WRITE_LOCAL_NAME:
1854 hci_cc_write_local_name(hdev, skb);
1855 break;
1856
1857 case HCI_OP_READ_LOCAL_NAME:
1858 hci_cc_read_local_name(hdev, skb);
1859 break;
1860
1861 case HCI_OP_WRITE_AUTH_ENABLE:
1862 hci_cc_write_auth_enable(hdev, skb);
1863 break;
1864
1865 case HCI_OP_WRITE_ENCRYPT_MODE:
1866 hci_cc_write_encrypt_mode(hdev, skb);
1867 break;
1868
1869 case HCI_OP_WRITE_SCAN_ENABLE:
1870 hci_cc_write_scan_enable(hdev, skb);
1871 break;
1872
1873 case HCI_OP_READ_CLASS_OF_DEV:
1874 hci_cc_read_class_of_dev(hdev, skb);
1875 break;
1876
1877 case HCI_OP_WRITE_CLASS_OF_DEV:
1878 hci_cc_write_class_of_dev(hdev, skb);
1879 break;
1880
1881 case HCI_OP_READ_VOICE_SETTING:
1882 hci_cc_read_voice_setting(hdev, skb);
1883 break;
1884
1885 case HCI_OP_WRITE_VOICE_SETTING:
1886 hci_cc_write_voice_setting(hdev, skb);
1887 break;
1888
1889 case HCI_OP_HOST_BUFFER_SIZE:
1890 hci_cc_host_buffer_size(hdev, skb);
1891 break;
1892
Marcel Holtmann333140b2008-07-14 20:13:48 +02001893 case HCI_OP_READ_SSP_MODE:
1894 hci_cc_read_ssp_mode(hdev, skb);
1895 break;
1896
1897 case HCI_OP_WRITE_SSP_MODE:
1898 hci_cc_write_ssp_mode(hdev, skb);
1899 break;
1900
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001901 case HCI_OP_READ_LOCAL_VERSION:
1902 hci_cc_read_local_version(hdev, skb);
1903 break;
1904
1905 case HCI_OP_READ_LOCAL_COMMANDS:
1906 hci_cc_read_local_commands(hdev, skb);
1907 break;
1908
1909 case HCI_OP_READ_LOCAL_FEATURES:
1910 hci_cc_read_local_features(hdev, skb);
1911 break;
1912
Andre Guedes971e3a42011-06-30 19:20:52 -03001913 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1914 hci_cc_read_local_ext_features(hdev, skb);
1915 break;
1916
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001917 case HCI_OP_READ_BUFFER_SIZE:
1918 hci_cc_read_buffer_size(hdev, skb);
1919 break;
1920
1921 case HCI_OP_READ_BD_ADDR:
1922 hci_cc_read_bd_addr(hdev, skb);
1923 break;
1924
Johan Hedberg23bb5762010-12-21 23:01:27 +02001925 case HCI_OP_WRITE_CA_TIMEOUT:
1926 hci_cc_write_ca_timeout(hdev, skb);
1927 break;
1928
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03001929 case HCI_OP_READ_LOCAL_AMP_INFO:
1930 hci_cc_read_local_amp_info(hdev, skb);
1931 break;
1932
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001933 case HCI_OP_DELETE_STORED_LINK_KEY:
1934 hci_cc_delete_stored_link_key(hdev, skb);
1935 break;
1936
Johan Hedbergd5859e22011-01-25 01:19:58 +02001937 case HCI_OP_SET_EVENT_MASK:
1938 hci_cc_set_event_mask(hdev, skb);
1939 break;
1940
1941 case HCI_OP_WRITE_INQUIRY_MODE:
1942 hci_cc_write_inquiry_mode(hdev, skb);
1943 break;
1944
1945 case HCI_OP_READ_INQ_RSP_TX_POWER:
1946 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1947 break;
1948
1949 case HCI_OP_SET_EVENT_FLT:
1950 hci_cc_set_event_flt(hdev, skb);
1951 break;
1952
Johan Hedberg980e1a52011-01-22 06:10:07 +02001953 case HCI_OP_PIN_CODE_REPLY:
1954 hci_cc_pin_code_reply(hdev, skb);
1955 break;
1956
1957 case HCI_OP_PIN_CODE_NEG_REPLY:
1958 hci_cc_pin_code_neg_reply(hdev, skb);
1959 break;
1960
Szymon Jancc35938b2011-03-22 13:12:21 +01001961 case HCI_OP_READ_LOCAL_OOB_DATA:
1962 hci_cc_read_local_oob_data_reply(hdev, skb);
1963 break;
1964
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001965 case HCI_OP_LE_READ_BUFFER_SIZE:
1966 hci_cc_le_read_buffer_size(hdev, skb);
1967 break;
1968
Johan Hedberga5c29682011-02-19 12:05:57 -03001969 case HCI_OP_USER_CONFIRM_REPLY:
1970 hci_cc_user_confirm_reply(hdev, skb);
1971 break;
1972
1973 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1974 hci_cc_user_confirm_neg_reply(hdev, skb);
1975 break;
1976
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001977 case HCI_OP_LE_SET_SCAN_ENABLE:
1978 hci_cc_le_set_scan_enable(hdev, skb);
1979 break;
1980
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001981 case HCI_OP_LE_LTK_REPLY:
1982 hci_cc_le_ltk_reply(hdev, skb);
1983 break;
1984
1985 case HCI_OP_LE_LTK_NEG_REPLY:
1986 hci_cc_le_ltk_neg_reply(hdev, skb);
1987 break;
1988
Andre Guedesf9b49302011-06-30 19:20:53 -03001989 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
1990 hci_cc_write_le_host_supported(hdev, skb);
1991 break;
1992
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001993 default:
1994 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1995 break;
1996 }
1997
Ville Tervo6bd32322011-02-16 16:32:41 +02001998 if (ev->opcode != HCI_OP_NOP)
1999 del_timer(&hdev->cmd_timer);
2000
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002001 if (ev->ncmd) {
2002 atomic_set(&hdev->cmd_cnt, 1);
2003 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002004 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002005 }
2006}
2007
2008static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
2009{
2010 struct hci_ev_cmd_status *ev = (void *) skb->data;
2011 __u16 opcode;
2012
2013 skb_pull(skb, sizeof(*ev));
2014
2015 opcode = __le16_to_cpu(ev->opcode);
2016
2017 switch (opcode) {
2018 case HCI_OP_INQUIRY:
2019 hci_cs_inquiry(hdev, ev->status);
2020 break;
2021
2022 case HCI_OP_CREATE_CONN:
2023 hci_cs_create_conn(hdev, ev->status);
2024 break;
2025
2026 case HCI_OP_ADD_SCO:
2027 hci_cs_add_sco(hdev, ev->status);
2028 break;
2029
Marcel Holtmannf8558552008-07-14 20:13:49 +02002030 case HCI_OP_AUTH_REQUESTED:
2031 hci_cs_auth_requested(hdev, ev->status);
2032 break;
2033
2034 case HCI_OP_SET_CONN_ENCRYPT:
2035 hci_cs_set_conn_encrypt(hdev, ev->status);
2036 break;
2037
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002038 case HCI_OP_REMOTE_NAME_REQ:
2039 hci_cs_remote_name_req(hdev, ev->status);
2040 break;
2041
Marcel Holtmann769be972008-07-14 20:13:49 +02002042 case HCI_OP_READ_REMOTE_FEATURES:
2043 hci_cs_read_remote_features(hdev, ev->status);
2044 break;
2045
2046 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2047 hci_cs_read_remote_ext_features(hdev, ev->status);
2048 break;
2049
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002050 case HCI_OP_SETUP_SYNC_CONN:
2051 hci_cs_setup_sync_conn(hdev, ev->status);
2052 break;
2053
2054 case HCI_OP_SNIFF_MODE:
2055 hci_cs_sniff_mode(hdev, ev->status);
2056 break;
2057
2058 case HCI_OP_EXIT_SNIFF_MODE:
2059 hci_cs_exit_sniff_mode(hdev, ev->status);
2060 break;
2061
Johan Hedberg8962ee72011-01-20 12:40:27 +02002062 case HCI_OP_DISCONNECT:
2063 if (ev->status != 0)
2064 mgmt_disconnect_failed(hdev->id);
2065 break;
2066
Ville Tervofcd89c02011-02-10 22:38:47 -03002067 case HCI_OP_LE_CREATE_CONN:
2068 hci_cs_le_create_conn(hdev, ev->status);
2069 break;
2070
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002071 case HCI_OP_LE_START_ENC:
2072 hci_cs_le_start_enc(hdev, ev->status);
2073 break;
2074
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002075 default:
2076 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2077 break;
2078 }
2079
Ville Tervo6bd32322011-02-16 16:32:41 +02002080 if (ev->opcode != HCI_OP_NOP)
2081 del_timer(&hdev->cmd_timer);
2082
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002083 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002084 atomic_set(&hdev->cmd_cnt, 1);
2085 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002086 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002087 }
2088}
2089
2090static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2091{
2092 struct hci_ev_role_change *ev = (void *) skb->data;
2093 struct hci_conn *conn;
2094
2095 BT_DBG("%s status %d", hdev->name, ev->status);
2096
2097 hci_dev_lock(hdev);
2098
2099 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2100 if (conn) {
2101 if (!ev->status) {
2102 if (ev->role)
2103 conn->link_mode &= ~HCI_LM_MASTER;
2104 else
2105 conn->link_mode |= HCI_LM_MASTER;
2106 }
2107
2108 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2109
2110 hci_role_switch_cfm(conn, ev->status, ev->role);
2111 }
2112
2113 hci_dev_unlock(hdev);
2114}
2115
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2117{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002118 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002119 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002120 int i;
2121
2122 skb_pull(skb, sizeof(*ev));
2123
2124 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2125
2126 if (skb->len < ev->num_hndl * 4) {
2127 BT_DBG("%s bad parameters", hdev->name);
2128 return;
2129 }
2130
2131 tasklet_disable(&hdev->tx_task);
2132
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002133 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002134 struct hci_conn *conn;
2135 __u16 handle, count;
2136
Harvey Harrison83985312008-05-02 16:25:46 -07002137 handle = get_unaligned_le16(ptr++);
2138 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002139
2140 conn = hci_conn_hash_lookup_handle(hdev, handle);
2141 if (conn) {
2142 conn->sent -= count;
2143
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002144 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002145 hdev->acl_cnt += count;
2146 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002147 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002148 } else if (conn->type == LE_LINK) {
2149 if (hdev->le_pkts) {
2150 hdev->le_cnt += count;
2151 if (hdev->le_cnt > hdev->le_pkts)
2152 hdev->le_cnt = hdev->le_pkts;
2153 } else {
2154 hdev->acl_cnt += count;
2155 if (hdev->acl_cnt > hdev->acl_pkts)
2156 hdev->acl_cnt = hdev->acl_pkts;
2157 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002158 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002159 hdev->sco_cnt += count;
2160 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002161 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002162 }
2163 }
2164 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002165
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002166 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002167
2168 tasklet_enable(&hdev->tx_task);
2169}
2170
Marcel Holtmann04837f62006-07-03 10:02:33 +02002171static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002172{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002173 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002174 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002175
2176 BT_DBG("%s status %d", hdev->name, ev->status);
2177
2178 hci_dev_lock(hdev);
2179
Marcel Holtmann04837f62006-07-03 10:02:33 +02002180 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2181 if (conn) {
2182 conn->mode = ev->mode;
2183 conn->interval = __le16_to_cpu(ev->interval);
2184
2185 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2186 if (conn->mode == HCI_CM_ACTIVE)
2187 conn->power_save = 1;
2188 else
2189 conn->power_save = 0;
2190 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002191
2192 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2193 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002194 }
2195
2196 hci_dev_unlock(hdev);
2197}
2198
Linus Torvalds1da177e2005-04-16 15:20:36 -07002199static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2200{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002201 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2202 struct hci_conn *conn;
2203
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002204 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002205
2206 hci_dev_lock(hdev);
2207
2208 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002209 if (!conn)
2210 goto unlock;
2211
2212 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002213 hci_conn_hold(conn);
2214 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2215 hci_conn_put(conn);
2216 }
2217
Johan Hedberg03b555e2011-01-04 15:40:05 +02002218 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2219 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2220 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002221 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002222 u8 secure;
2223
2224 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2225 secure = 1;
2226 else
2227 secure = 0;
2228
2229 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2230 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002231
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002232unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002233 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002234}
2235
Linus Torvalds1da177e2005-04-16 15:20:36 -07002236static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2237{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002238 struct hci_ev_link_key_req *ev = (void *) skb->data;
2239 struct hci_cp_link_key_reply cp;
2240 struct hci_conn *conn;
2241 struct link_key *key;
2242
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002243 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002244
2245 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2246 return;
2247
2248 hci_dev_lock(hdev);
2249
2250 key = hci_find_link_key(hdev, &ev->bdaddr);
2251 if (!key) {
2252 BT_DBG("%s link key not found for %s", hdev->name,
2253 batostr(&ev->bdaddr));
2254 goto not_found;
2255 }
2256
2257 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2258 batostr(&ev->bdaddr));
2259
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002260 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2261 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002262 BT_DBG("%s ignoring debug key", hdev->name);
2263 goto not_found;
2264 }
2265
2266 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002267 if (conn) {
2268 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2269 conn->auth_type != 0xff &&
2270 (conn->auth_type & 0x01)) {
2271 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2272 goto not_found;
2273 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002274
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002275 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2276 conn->pending_sec_level == BT_SECURITY_HIGH) {
2277 BT_DBG("%s ignoring key unauthenticated for high \
2278 security", hdev->name);
2279 goto not_found;
2280 }
2281
2282 conn->key_type = key->type;
2283 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002284 }
2285
2286 bacpy(&cp.bdaddr, &ev->bdaddr);
2287 memcpy(cp.link_key, key->val, 16);
2288
2289 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2290
2291 hci_dev_unlock(hdev);
2292
2293 return;
2294
2295not_found:
2296 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2297 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002298}
2299
Linus Torvalds1da177e2005-04-16 15:20:36 -07002300static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2301{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002302 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2303 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002304 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002305
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002306 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002307
2308 hci_dev_lock(hdev);
2309
2310 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2311 if (conn) {
2312 hci_conn_hold(conn);
2313 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002314 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002315
2316 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2317 conn->key_type = ev->key_type;
2318
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002319 hci_conn_put(conn);
2320 }
2321
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002322 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002323 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002324 ev->key_type, pin_len);
2325
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002326 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002327}
2328
Marcel Holtmann04837f62006-07-03 10:02:33 +02002329static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2330{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002331 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002332 struct hci_conn *conn;
2333
2334 BT_DBG("%s status %d", hdev->name, ev->status);
2335
2336 hci_dev_lock(hdev);
2337
2338 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002339 if (conn && !ev->status) {
2340 struct inquiry_entry *ie;
2341
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002342 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2343 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002344 ie->data.clock_offset = ev->clock_offset;
2345 ie->timestamp = jiffies;
2346 }
2347 }
2348
2349 hci_dev_unlock(hdev);
2350}
2351
Marcel Holtmanna8746412008-07-14 20:13:46 +02002352static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2353{
2354 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2355 struct hci_conn *conn;
2356
2357 BT_DBG("%s status %d", hdev->name, ev->status);
2358
2359 hci_dev_lock(hdev);
2360
2361 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2362 if (conn && !ev->status)
2363 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2364
2365 hci_dev_unlock(hdev);
2366}
2367
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002368static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2369{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002370 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002371 struct inquiry_entry *ie;
2372
2373 BT_DBG("%s", hdev->name);
2374
2375 hci_dev_lock(hdev);
2376
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002377 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2378 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002379 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2380 ie->timestamp = jiffies;
2381 }
2382
2383 hci_dev_unlock(hdev);
2384}
2385
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002386static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2387{
2388 struct inquiry_data data;
2389 int num_rsp = *((__u8 *) skb->data);
2390
2391 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2392
2393 if (!num_rsp)
2394 return;
2395
2396 hci_dev_lock(hdev);
2397
2398 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002399 struct inquiry_info_with_rssi_and_pscan_mode *info;
2400 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002401
Johan Hedberge17acd42011-03-30 23:57:16 +03002402 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002403 bacpy(&data.bdaddr, &info->bdaddr);
2404 data.pscan_rep_mode = info->pscan_rep_mode;
2405 data.pscan_period_mode = info->pscan_period_mode;
2406 data.pscan_mode = info->pscan_mode;
2407 memcpy(data.dev_class, info->dev_class, 3);
2408 data.clock_offset = info->clock_offset;
2409 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002410 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002411 hci_inquiry_cache_update(hdev, &data);
Johan Hedberg4c659c32011-11-07 23:13:39 +02002412 mgmt_device_found(hdev->id, &info->bdaddr, ACL_LINK,
Johan Hedberge17acd42011-03-30 23:57:16 +03002413 info->dev_class, info->rssi,
2414 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002415 }
2416 } else {
2417 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2418
Johan Hedberge17acd42011-03-30 23:57:16 +03002419 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002420 bacpy(&data.bdaddr, &info->bdaddr);
2421 data.pscan_rep_mode = info->pscan_rep_mode;
2422 data.pscan_period_mode = info->pscan_period_mode;
2423 data.pscan_mode = 0x00;
2424 memcpy(data.dev_class, info->dev_class, 3);
2425 data.clock_offset = info->clock_offset;
2426 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002427 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002428 hci_inquiry_cache_update(hdev, &data);
Johan Hedberg4c659c32011-11-07 23:13:39 +02002429 mgmt_device_found(hdev->id, &info->bdaddr, ACL_LINK,
Johan Hedberge17acd42011-03-30 23:57:16 +03002430 info->dev_class, info->rssi,
2431 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002432 }
2433 }
2434
2435 hci_dev_unlock(hdev);
2436}
2437
2438static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2439{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002440 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2441 struct hci_conn *conn;
2442
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002443 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002444
Marcel Holtmann41a96212008-07-14 20:13:48 +02002445 hci_dev_lock(hdev);
2446
2447 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002448 if (!conn)
2449 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002450
Johan Hedbergccd556f2010-11-10 17:11:51 +02002451 if (!ev->status && ev->page == 0x01) {
2452 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002453
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002454 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2455 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002456 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002457
Johan Hedbergccd556f2010-11-10 17:11:51 +02002458 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002459 }
2460
Johan Hedbergccd556f2010-11-10 17:11:51 +02002461 if (conn->state != BT_CONFIG)
2462 goto unlock;
2463
Johan Hedberg127178d2010-11-18 22:22:29 +02002464 if (!ev->status) {
2465 struct hci_cp_remote_name_req cp;
2466 memset(&cp, 0, sizeof(cp));
2467 bacpy(&cp.bdaddr, &conn->dst);
2468 cp.pscan_rep_mode = 0x02;
2469 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2470 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002471
Johan Hedberg127178d2010-11-18 22:22:29 +02002472 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002473 conn->state = BT_CONNECTED;
2474 hci_proto_connect_cfm(conn, ev->status);
2475 hci_conn_put(conn);
2476 }
2477
2478unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002479 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002480}
2481
2482static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2483{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002484 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2485 struct hci_conn *conn;
2486
2487 BT_DBG("%s status %d", hdev->name, ev->status);
2488
2489 hci_dev_lock(hdev);
2490
2491 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002492 if (!conn) {
2493 if (ev->link_type == ESCO_LINK)
2494 goto unlock;
2495
2496 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2497 if (!conn)
2498 goto unlock;
2499
2500 conn->type = SCO_LINK;
2501 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002502
Marcel Holtmann732547f2009-04-19 19:14:14 +02002503 switch (ev->status) {
2504 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002505 conn->handle = __le16_to_cpu(ev->handle);
2506 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002507
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002508 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002509 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002510 break;
2511
Stephen Coe705e5712010-02-16 11:29:44 -05002512 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002513 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002514 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002515 case 0x1f: /* Unspecified error */
2516 if (conn->out && conn->attempt < 2) {
2517 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2518 (hdev->esco_type & EDR_ESCO_MASK);
2519 hci_setup_sync(conn, conn->link->handle);
2520 goto unlock;
2521 }
2522 /* fall through */
2523
2524 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002525 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002526 break;
2527 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002528
2529 hci_proto_connect_cfm(conn, ev->status);
2530 if (ev->status)
2531 hci_conn_del(conn);
2532
2533unlock:
2534 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002535}
2536
2537static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2538{
2539 BT_DBG("%s", hdev->name);
2540}
2541
Marcel Holtmann04837f62006-07-03 10:02:33 +02002542static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2543{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002544 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002545
2546 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002547}
2548
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002549static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2550{
2551 struct inquiry_data data;
2552 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2553 int num_rsp = *((__u8 *) skb->data);
2554
2555 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2556
2557 if (!num_rsp)
2558 return;
2559
2560 hci_dev_lock(hdev);
2561
Johan Hedberge17acd42011-03-30 23:57:16 +03002562 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002563 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002564 data.pscan_rep_mode = info->pscan_rep_mode;
2565 data.pscan_period_mode = info->pscan_period_mode;
2566 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002567 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002568 data.clock_offset = info->clock_offset;
2569 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002570 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002571 hci_inquiry_cache_update(hdev, &data);
Johan Hedberg4c659c32011-11-07 23:13:39 +02002572 mgmt_device_found(hdev->id, &info->bdaddr, ACL_LINK,
2573 info->dev_class, info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002574 }
2575
2576 hci_dev_unlock(hdev);
2577}
2578
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002579static inline u8 hci_get_auth_req(struct hci_conn *conn)
2580{
2581 /* If remote requests dedicated bonding follow that lead */
2582 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2583 /* If both remote and local IO capabilities allow MITM
2584 * protection then require it, otherwise don't */
2585 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2586 return 0x02;
2587 else
2588 return 0x03;
2589 }
2590
2591 /* If remote requests no-bonding follow that lead */
2592 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002593 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002594
2595 return conn->auth_type;
2596}
2597
Marcel Holtmann04936842008-07-14 20:13:48 +02002598static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2599{
2600 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2601 struct hci_conn *conn;
2602
2603 BT_DBG("%s", hdev->name);
2604
2605 hci_dev_lock(hdev);
2606
2607 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002608 if (!conn)
2609 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002610
Johan Hedberg03b555e2011-01-04 15:40:05 +02002611 hci_conn_hold(conn);
2612
2613 if (!test_bit(HCI_MGMT, &hdev->flags))
2614 goto unlock;
2615
2616 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2617 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002618 struct hci_cp_io_capability_reply cp;
2619
2620 bacpy(&cp.bdaddr, &ev->bdaddr);
2621 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002622 conn->auth_type = hci_get_auth_req(conn);
2623 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002624
Szymon Jancce85ee12011-03-22 13:12:23 +01002625 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2626 hci_find_remote_oob_data(hdev, &conn->dst))
2627 cp.oob_data = 0x01;
2628 else
2629 cp.oob_data = 0x00;
2630
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002631 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2632 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002633 } else {
2634 struct hci_cp_io_capability_neg_reply cp;
2635
2636 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02002637 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02002638
2639 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2640 sizeof(cp), &cp);
2641 }
2642
2643unlock:
2644 hci_dev_unlock(hdev);
2645}
2646
2647static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2648{
2649 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2650 struct hci_conn *conn;
2651
2652 BT_DBG("%s", hdev->name);
2653
2654 hci_dev_lock(hdev);
2655
2656 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2657 if (!conn)
2658 goto unlock;
2659
Johan Hedberg03b555e2011-01-04 15:40:05 +02002660 conn->remote_cap = ev->capability;
2661 conn->remote_oob = ev->oob_data;
2662 conn->remote_auth = ev->authentication;
2663
2664unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002665 hci_dev_unlock(hdev);
2666}
2667
Johan Hedberga5c29682011-02-19 12:05:57 -03002668static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2669 struct sk_buff *skb)
2670{
2671 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002672 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002673 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002674
2675 BT_DBG("%s", hdev->name);
2676
2677 hci_dev_lock(hdev);
2678
Johan Hedberg7a828902011-04-28 11:28:53 -07002679 if (!test_bit(HCI_MGMT, &hdev->flags))
2680 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002681
Johan Hedberg7a828902011-04-28 11:28:53 -07002682 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2683 if (!conn)
2684 goto unlock;
2685
2686 loc_mitm = (conn->auth_type & 0x01);
2687 rem_mitm = (conn->remote_auth & 0x01);
2688
2689 /* If we require MITM but the remote device can't provide that
2690 * (it has NoInputNoOutput) then reject the confirmation
2691 * request. The only exception is when we're dedicated bonding
2692 * initiators (connect_cfm_cb set) since then we always have the MITM
2693 * bit set. */
2694 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2695 BT_DBG("Rejecting request: remote device can't provide MITM");
2696 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2697 sizeof(ev->bdaddr), &ev->bdaddr);
2698 goto unlock;
2699 }
2700
2701 /* If no side requires MITM protection; auto-accept */
2702 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2703 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002704
2705 /* If we're not the initiators request authorization to
2706 * proceed from user space (mgmt_user_confirm with
2707 * confirm_hint set to 1). */
2708 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2709 BT_DBG("Confirming auto-accept as acceptor");
2710 confirm_hint = 1;
2711 goto confirm;
2712 }
2713
Johan Hedberg9f616562011-04-28 11:28:54 -07002714 BT_DBG("Auto-accept of user confirmation with %ums delay",
2715 hdev->auto_accept_delay);
2716
2717 if (hdev->auto_accept_delay > 0) {
2718 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2719 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2720 goto unlock;
2721 }
2722
Johan Hedberg7a828902011-04-28 11:28:53 -07002723 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2724 sizeof(ev->bdaddr), &ev->bdaddr);
2725 goto unlock;
2726 }
2727
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002728confirm:
2729 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2730 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002731
2732unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002733 hci_dev_unlock(hdev);
2734}
2735
Marcel Holtmann04936842008-07-14 20:13:48 +02002736static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2737{
2738 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2739 struct hci_conn *conn;
2740
2741 BT_DBG("%s", hdev->name);
2742
2743 hci_dev_lock(hdev);
2744
2745 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002746 if (!conn)
2747 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002748
Johan Hedberg2a611692011-02-19 12:06:00 -03002749 /* To avoid duplicate auth_failed events to user space we check
2750 * the HCI_CONN_AUTH_PEND flag which will be set if we
2751 * initiated the authentication. A traditional auth_complete
2752 * event gets always produced as initiator and is also mapped to
2753 * the mgmt_auth_failed event */
2754 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2755 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2756
2757 hci_conn_put(conn);
2758
2759unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002760 hci_dev_unlock(hdev);
2761}
2762
Marcel Holtmann41a96212008-07-14 20:13:48 +02002763static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2764{
2765 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2766 struct inquiry_entry *ie;
2767
2768 BT_DBG("%s", hdev->name);
2769
2770 hci_dev_lock(hdev);
2771
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002772 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2773 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002774 ie->data.ssp_mode = (ev->features[0] & 0x01);
2775
2776 hci_dev_unlock(hdev);
2777}
2778
Szymon Janc2763eda2011-03-22 13:12:22 +01002779static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2780 struct sk_buff *skb)
2781{
2782 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2783 struct oob_data *data;
2784
2785 BT_DBG("%s", hdev->name);
2786
2787 hci_dev_lock(hdev);
2788
Szymon Jance1ba1f12011-04-06 13:01:59 +02002789 if (!test_bit(HCI_MGMT, &hdev->flags))
2790 goto unlock;
2791
Szymon Janc2763eda2011-03-22 13:12:22 +01002792 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2793 if (data) {
2794 struct hci_cp_remote_oob_data_reply cp;
2795
2796 bacpy(&cp.bdaddr, &ev->bdaddr);
2797 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2798 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2799
2800 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2801 &cp);
2802 } else {
2803 struct hci_cp_remote_oob_data_neg_reply cp;
2804
2805 bacpy(&cp.bdaddr, &ev->bdaddr);
2806 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2807 &cp);
2808 }
2809
Szymon Jance1ba1f12011-04-06 13:01:59 +02002810unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002811 hci_dev_unlock(hdev);
2812}
2813
Ville Tervofcd89c02011-02-10 22:38:47 -03002814static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2815{
2816 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2817 struct hci_conn *conn;
2818
2819 BT_DBG("%s status %d", hdev->name, ev->status);
2820
2821 hci_dev_lock(hdev);
2822
2823 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002824 if (!conn) {
2825 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
2826 if (!conn) {
2827 BT_ERR("No memory for new connection");
2828 hci_dev_unlock(hdev);
2829 return;
2830 }
Andre Guedes29b79882011-05-31 14:20:54 -03002831
2832 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002833 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002834
2835 if (ev->status) {
Johan Hedberg4c659c32011-11-07 23:13:39 +02002836 mgmt_connect_failed(hdev->id, &ev->bdaddr, conn->type,
2837 ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002838 hci_proto_connect_cfm(conn, ev->status);
2839 conn->state = BT_CLOSED;
2840 hci_conn_del(conn);
2841 goto unlock;
2842 }
2843
Vinicius Costa Gomescfafccf2011-08-19 21:06:56 -03002844 mgmt_connected(hdev->id, &ev->bdaddr, conn->type);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002845
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03002846 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002847 conn->handle = __le16_to_cpu(ev->handle);
2848 conn->state = BT_CONNECTED;
2849
2850 hci_conn_hold_device(conn);
2851 hci_conn_add_sysfs(conn);
2852
2853 hci_proto_connect_cfm(conn, ev->status);
2854
2855unlock:
2856 hci_dev_unlock(hdev);
2857}
2858
Andre Guedes9aa04c92011-05-26 16:23:51 -03002859static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2860 struct sk_buff *skb)
2861{
Andre Guedese95beb42011-09-26 20:48:35 -03002862 u8 num_reports = skb->data[0];
2863 void *ptr = &skb->data[1];
Andre Guedes9aa04c92011-05-26 16:23:51 -03002864
2865 hci_dev_lock(hdev);
2866
Andre Guedese95beb42011-09-26 20:48:35 -03002867 while (num_reports--) {
2868 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03002869
Andre Guedes9aa04c92011-05-26 16:23:51 -03002870 hci_add_adv_entry(hdev, ev);
Andre Guedese95beb42011-09-26 20:48:35 -03002871
2872 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03002873 }
2874
2875 hci_dev_unlock(hdev);
2876}
2877
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002878static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2879 struct sk_buff *skb)
2880{
2881 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2882 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002883 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002884 struct hci_conn *conn;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002885 struct link_key *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002886
2887 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2888
2889 hci_dev_lock(hdev);
2890
2891 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002892 if (conn == NULL)
2893 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002894
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002895 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
2896 if (ltk == NULL)
2897 goto not_found;
2898
2899 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002900 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomes726b4ff2011-07-08 18:31:45 -03002901 conn->pin_length = ltk->pin_len;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002902
2903 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2904
2905 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002906
2907 return;
2908
2909not_found:
2910 neg.handle = ev->handle;
2911 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
2912 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002913}
2914
Ville Tervofcd89c02011-02-10 22:38:47 -03002915static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2916{
2917 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2918
2919 skb_pull(skb, sizeof(*le_ev));
2920
2921 switch (le_ev->subevent) {
2922 case HCI_EV_LE_CONN_COMPLETE:
2923 hci_le_conn_complete_evt(hdev, skb);
2924 break;
2925
Andre Guedes9aa04c92011-05-26 16:23:51 -03002926 case HCI_EV_LE_ADVERTISING_REPORT:
2927 hci_le_adv_report_evt(hdev, skb);
2928 break;
2929
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002930 case HCI_EV_LE_LTK_REQ:
2931 hci_le_ltk_request_evt(hdev, skb);
2932 break;
2933
Ville Tervofcd89c02011-02-10 22:38:47 -03002934 default:
2935 break;
2936 }
2937}
2938
Linus Torvalds1da177e2005-04-16 15:20:36 -07002939void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2940{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002941 struct hci_event_hdr *hdr = (void *) skb->data;
2942 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002943
2944 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2945
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002946 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002947 case HCI_EV_INQUIRY_COMPLETE:
2948 hci_inquiry_complete_evt(hdev, skb);
2949 break;
2950
2951 case HCI_EV_INQUIRY_RESULT:
2952 hci_inquiry_result_evt(hdev, skb);
2953 break;
2954
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002955 case HCI_EV_CONN_COMPLETE:
2956 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002957 break;
2958
Linus Torvalds1da177e2005-04-16 15:20:36 -07002959 case HCI_EV_CONN_REQUEST:
2960 hci_conn_request_evt(hdev, skb);
2961 break;
2962
Linus Torvalds1da177e2005-04-16 15:20:36 -07002963 case HCI_EV_DISCONN_COMPLETE:
2964 hci_disconn_complete_evt(hdev, skb);
2965 break;
2966
Linus Torvalds1da177e2005-04-16 15:20:36 -07002967 case HCI_EV_AUTH_COMPLETE:
2968 hci_auth_complete_evt(hdev, skb);
2969 break;
2970
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002971 case HCI_EV_REMOTE_NAME:
2972 hci_remote_name_evt(hdev, skb);
2973 break;
2974
Linus Torvalds1da177e2005-04-16 15:20:36 -07002975 case HCI_EV_ENCRYPT_CHANGE:
2976 hci_encrypt_change_evt(hdev, skb);
2977 break;
2978
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002979 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2980 hci_change_link_key_complete_evt(hdev, skb);
2981 break;
2982
2983 case HCI_EV_REMOTE_FEATURES:
2984 hci_remote_features_evt(hdev, skb);
2985 break;
2986
2987 case HCI_EV_REMOTE_VERSION:
2988 hci_remote_version_evt(hdev, skb);
2989 break;
2990
2991 case HCI_EV_QOS_SETUP_COMPLETE:
2992 hci_qos_setup_complete_evt(hdev, skb);
2993 break;
2994
2995 case HCI_EV_CMD_COMPLETE:
2996 hci_cmd_complete_evt(hdev, skb);
2997 break;
2998
2999 case HCI_EV_CMD_STATUS:
3000 hci_cmd_status_evt(hdev, skb);
3001 break;
3002
3003 case HCI_EV_ROLE_CHANGE:
3004 hci_role_change_evt(hdev, skb);
3005 break;
3006
3007 case HCI_EV_NUM_COMP_PKTS:
3008 hci_num_comp_pkts_evt(hdev, skb);
3009 break;
3010
3011 case HCI_EV_MODE_CHANGE:
3012 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003013 break;
3014
3015 case HCI_EV_PIN_CODE_REQ:
3016 hci_pin_code_request_evt(hdev, skb);
3017 break;
3018
3019 case HCI_EV_LINK_KEY_REQ:
3020 hci_link_key_request_evt(hdev, skb);
3021 break;
3022
3023 case HCI_EV_LINK_KEY_NOTIFY:
3024 hci_link_key_notify_evt(hdev, skb);
3025 break;
3026
3027 case HCI_EV_CLOCK_OFFSET:
3028 hci_clock_offset_evt(hdev, skb);
3029 break;
3030
Marcel Holtmanna8746412008-07-14 20:13:46 +02003031 case HCI_EV_PKT_TYPE_CHANGE:
3032 hci_pkt_type_change_evt(hdev, skb);
3033 break;
3034
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003035 case HCI_EV_PSCAN_REP_MODE:
3036 hci_pscan_rep_mode_evt(hdev, skb);
3037 break;
3038
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003039 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3040 hci_inquiry_result_with_rssi_evt(hdev, skb);
3041 break;
3042
3043 case HCI_EV_REMOTE_EXT_FEATURES:
3044 hci_remote_ext_features_evt(hdev, skb);
3045 break;
3046
3047 case HCI_EV_SYNC_CONN_COMPLETE:
3048 hci_sync_conn_complete_evt(hdev, skb);
3049 break;
3050
3051 case HCI_EV_SYNC_CONN_CHANGED:
3052 hci_sync_conn_changed_evt(hdev, skb);
3053 break;
3054
Marcel Holtmann04837f62006-07-03 10:02:33 +02003055 case HCI_EV_SNIFF_SUBRATE:
3056 hci_sniff_subrate_evt(hdev, skb);
3057 break;
3058
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003059 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3060 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003061 break;
3062
Marcel Holtmann04936842008-07-14 20:13:48 +02003063 case HCI_EV_IO_CAPA_REQUEST:
3064 hci_io_capa_request_evt(hdev, skb);
3065 break;
3066
Johan Hedberg03b555e2011-01-04 15:40:05 +02003067 case HCI_EV_IO_CAPA_REPLY:
3068 hci_io_capa_reply_evt(hdev, skb);
3069 break;
3070
Johan Hedberga5c29682011-02-19 12:05:57 -03003071 case HCI_EV_USER_CONFIRM_REQUEST:
3072 hci_user_confirm_request_evt(hdev, skb);
3073 break;
3074
Marcel Holtmann04936842008-07-14 20:13:48 +02003075 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3076 hci_simple_pair_complete_evt(hdev, skb);
3077 break;
3078
Marcel Holtmann41a96212008-07-14 20:13:48 +02003079 case HCI_EV_REMOTE_HOST_FEATURES:
3080 hci_remote_host_features_evt(hdev, skb);
3081 break;
3082
Ville Tervofcd89c02011-02-10 22:38:47 -03003083 case HCI_EV_LE_META:
3084 hci_le_meta_evt(hdev, skb);
3085 break;
3086
Szymon Janc2763eda2011-03-22 13:12:22 +01003087 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3088 hci_remote_oob_data_request_evt(hdev, skb);
3089 break;
3090
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003091 default:
3092 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003093 break;
3094 }
3095
3096 kfree_skb(skb);
3097 hdev->stat.evt_rx++;
3098}
3099
3100/* Generate internal stack event */
3101void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3102{
3103 struct hci_event_hdr *hdr;
3104 struct hci_ev_stack_internal *ev;
3105 struct sk_buff *skb;
3106
3107 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3108 if (!skb)
3109 return;
3110
3111 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3112 hdr->evt = HCI_EV_STACK_INTERNAL;
3113 hdr->plen = sizeof(*ev) + dlen;
3114
3115 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3116 ev->type = type;
3117 memcpy(ev->data, data, dlen);
3118
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003119 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003120 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003121
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003122 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003123 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003124 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003125 kfree_skb(skb);
3126}
Andre Guedese6100a22011-06-30 19:20:54 -03003127
Gustavo F. Padovan669bb392011-10-11 15:57:01 -03003128module_param(enable_le, bool, 0644);
Andre Guedese6100a22011-06-30 19:20:54 -03003129MODULE_PARM_DESC(enable_le, "Enable LE support");