blob: 883040f972de286860ed01c403d6c45a83e8bab6 [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 Guedes5521abe2011-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
Johan Hedberg314b2382011-04-27 10:29:57 -040061 if (test_bit(HCI_MGMT, &hdev->flags) &&
62 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
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
Johan Hedberg314b2382011-04-27 10:29:57 -040079 if (test_bit(HCI_MGMT, &hdev->flags) &&
80 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
81 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020082
83 hci_conn_check_pending(hdev);
84}
85
86static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
87{
88 BT_DBG("%s", hdev->name);
89}
90
91static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
92{
93 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Marcel Holtmanna9de9242007-10-20 13:33:56 +020096 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070097
Marcel Holtmanna9de9242007-10-20 13:33:56 +020098 if (rp->status)
99 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200101 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200103 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
104 if (conn) {
105 if (rp->role)
106 conn->link_mode &= ~HCI_LM_MASTER;
107 else
108 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200110
111 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112}
113
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200114static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
115{
116 struct hci_rp_read_link_policy *rp = (void *) skb->data;
117 struct hci_conn *conn;
118
119 BT_DBG("%s status 0x%x", hdev->name, rp->status);
120
121 if (rp->status)
122 return;
123
124 hci_dev_lock(hdev);
125
126 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
127 if (conn)
128 conn->link_policy = __le16_to_cpu(rp->policy);
129
130 hci_dev_unlock(hdev);
131}
132
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200133static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200135 struct hci_rp_write_link_policy *rp = (void *) skb->data;
136 struct hci_conn *conn;
137 void *sent;
138
139 BT_DBG("%s status 0x%x", hdev->name, rp->status);
140
141 if (rp->status)
142 return;
143
144 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
145 if (!sent)
146 return;
147
148 hci_dev_lock(hdev);
149
150 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200151 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700152 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200153
154 hci_dev_unlock(hdev);
155}
156
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200157static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
158{
159 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
160
161 BT_DBG("%s status 0x%x", hdev->name, rp->status);
162
163 if (rp->status)
164 return;
165
166 hdev->link_policy = __le16_to_cpu(rp->policy);
167}
168
169static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
170{
171 __u8 status = *((__u8 *) skb->data);
172 void *sent;
173
174 BT_DBG("%s status 0x%x", hdev->name, status);
175
176 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
177 if (!sent)
178 return;
179
180 if (!status)
181 hdev->link_policy = get_unaligned_le16(sent);
182
Johan Hedberg23bb5762010-12-21 23:01:27 +0200183 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200184}
185
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200186static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
187{
188 __u8 status = *((__u8 *) skb->data);
189
190 BT_DBG("%s status 0x%x", hdev->name, status);
191
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300192 clear_bit(HCI_RESET, &hdev->flags);
193
Johan Hedberg23bb5762010-12-21 23:01:27 +0200194 hci_req_complete(hdev, HCI_OP_RESET, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200195}
196
197static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
198{
199 __u8 status = *((__u8 *) skb->data);
200 void *sent;
201
202 BT_DBG("%s status 0x%x", hdev->name, status);
203
204 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
205 if (!sent)
206 return;
207
Johan Hedbergb312b1612011-03-16 14:29:37 +0200208 if (test_bit(HCI_MGMT, &hdev->flags))
209 mgmt_set_local_name_complete(hdev->id, sent, status);
210
211 if (status)
212 return;
213
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200214 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200215}
216
217static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
218{
219 struct hci_rp_read_local_name *rp = (void *) skb->data;
220
221 BT_DBG("%s status 0x%x", hdev->name, rp->status);
222
223 if (rp->status)
224 return;
225
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200226 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200227}
228
229static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
230{
231 __u8 status = *((__u8 *) skb->data);
232 void *sent;
233
234 BT_DBG("%s status 0x%x", hdev->name, status);
235
236 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
237 if (!sent)
238 return;
239
240 if (!status) {
241 __u8 param = *((__u8 *) sent);
242
243 if (param == AUTH_ENABLED)
244 set_bit(HCI_AUTH, &hdev->flags);
245 else
246 clear_bit(HCI_AUTH, &hdev->flags);
247 }
248
Johan Hedberg23bb5762010-12-21 23:01:27 +0200249 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200250}
251
252static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
253{
254 __u8 status = *((__u8 *) skb->data);
255 void *sent;
256
257 BT_DBG("%s status 0x%x", hdev->name, status);
258
259 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
260 if (!sent)
261 return;
262
263 if (!status) {
264 __u8 param = *((__u8 *) sent);
265
266 if (param)
267 set_bit(HCI_ENCRYPT, &hdev->flags);
268 else
269 clear_bit(HCI_ENCRYPT, &hdev->flags);
270 }
271
Johan Hedberg23bb5762010-12-21 23:01:27 +0200272 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200273}
274
275static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
276{
277 __u8 status = *((__u8 *) skb->data);
278 void *sent;
279
280 BT_DBG("%s status 0x%x", hdev->name, status);
281
282 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
283 if (!sent)
284 return;
285
286 if (!status) {
287 __u8 param = *((__u8 *) sent);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200288 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200289
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200290 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
291 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200292
Johan Hedberg73f22f62010-12-29 16:00:25 +0200293 if (param & SCAN_INQUIRY) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200294 set_bit(HCI_ISCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200295 if (!old_iscan)
296 mgmt_discoverable(hdev->id, 1);
297 } else if (old_iscan)
Johan Hedberg73f22f62010-12-29 16:00:25 +0200298 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200299
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200300 if (param & SCAN_PAGE) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200301 set_bit(HCI_PSCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200302 if (!old_pscan)
303 mgmt_connectable(hdev->id, 1);
304 } else if (old_pscan)
305 mgmt_connectable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200306 }
307
Johan Hedberg23bb5762010-12-21 23:01:27 +0200308 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200309}
310
311static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
312{
313 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
314
315 BT_DBG("%s status 0x%x", hdev->name, rp->status);
316
317 if (rp->status)
318 return;
319
320 memcpy(hdev->dev_class, rp->dev_class, 3);
321
322 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
323 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
324}
325
326static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
327{
328 __u8 status = *((__u8 *) skb->data);
329 void *sent;
330
331 BT_DBG("%s status 0x%x", hdev->name, status);
332
Marcel Holtmannf383f272008-07-14 20:13:47 +0200333 if (status)
334 return;
335
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200336 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
337 if (!sent)
338 return;
339
Marcel Holtmannf383f272008-07-14 20:13:47 +0200340 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200341}
342
343static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
344{
345 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200347
348 BT_DBG("%s status 0x%x", hdev->name, rp->status);
349
350 if (rp->status)
351 return;
352
353 setting = __le16_to_cpu(rp->voice_setting);
354
Marcel Holtmannf383f272008-07-14 20:13:47 +0200355 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200356 return;
357
358 hdev->voice_setting = setting;
359
360 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
361
362 if (hdev->notify) {
363 tasklet_disable(&hdev->tx_task);
364 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
365 tasklet_enable(&hdev->tx_task);
366 }
367}
368
369static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
370{
371 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200372 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 void *sent;
374
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200375 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376
Marcel Holtmannf383f272008-07-14 20:13:47 +0200377 if (status)
378 return;
379
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200380 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
381 if (!sent)
382 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383
Marcel Holtmannf383f272008-07-14 20:13:47 +0200384 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
Marcel Holtmannf383f272008-07-14 20:13:47 +0200386 if (hdev->voice_setting == setting)
387 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Marcel Holtmannf383f272008-07-14 20:13:47 +0200389 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390
Marcel Holtmannf383f272008-07-14 20:13:47 +0200391 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
392
393 if (hdev->notify) {
394 tasklet_disable(&hdev->tx_task);
395 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
396 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397 }
398}
399
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200400static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200402 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200404 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405
Johan Hedberg23bb5762010-12-21 23:01:27 +0200406 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407}
408
Marcel Holtmann333140b2008-07-14 20:13:48 +0200409static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
410{
411 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
412
413 BT_DBG("%s status 0x%x", hdev->name, rp->status);
414
415 if (rp->status)
416 return;
417
418 hdev->ssp_mode = rp->mode;
419}
420
421static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
422{
423 __u8 status = *((__u8 *) skb->data);
424 void *sent;
425
426 BT_DBG("%s status 0x%x", hdev->name, status);
427
428 if (status)
429 return;
430
431 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
432 if (!sent)
433 return;
434
435 hdev->ssp_mode = *((__u8 *) sent);
436}
437
Johan Hedbergd5859e22011-01-25 01:19:58 +0200438static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
439{
440 if (hdev->features[6] & LMP_EXT_INQ)
441 return 2;
442
443 if (hdev->features[3] & LMP_RSSI_INQ)
444 return 1;
445
446 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
447 hdev->lmp_subver == 0x0757)
448 return 1;
449
450 if (hdev->manufacturer == 15) {
451 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
452 return 1;
453 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
454 return 1;
455 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
456 return 1;
457 }
458
459 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
460 hdev->lmp_subver == 0x1805)
461 return 1;
462
463 return 0;
464}
465
466static void hci_setup_inquiry_mode(struct hci_dev *hdev)
467{
468 u8 mode;
469
470 mode = hci_get_inquiry_mode(hdev);
471
472 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
473}
474
475static void hci_setup_event_mask(struct hci_dev *hdev)
476{
477 /* The second byte is 0xff instead of 0x9f (two reserved bits
478 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
479 * command otherwise */
480 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
481
Ville Tervo7f4f0572011-05-27 11:16:21 +0300482 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
483 * any event mask for pre 1.2 devices */
484 if (hdev->lmp_ver <= 1)
485 return;
486
487 events[4] |= 0x01; /* Flow Specification Complete */
488 events[4] |= 0x02; /* Inquiry Result with RSSI */
489 events[4] |= 0x04; /* Read Remote Extended Features Complete */
490 events[5] |= 0x08; /* Synchronous Connection Complete */
491 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200492
493 if (hdev->features[3] & LMP_RSSI_INQ)
494 events[4] |= 0x04; /* Inquiry Result with RSSI */
495
496 if (hdev->features[5] & LMP_SNIFF_SUBR)
497 events[5] |= 0x20; /* Sniff Subrating */
498
499 if (hdev->features[5] & LMP_PAUSE_ENC)
500 events[5] |= 0x80; /* Encryption Key Refresh Complete */
501
502 if (hdev->features[6] & LMP_EXT_INQ)
503 events[5] |= 0x40; /* Extended Inquiry Result */
504
505 if (hdev->features[6] & LMP_NO_FLUSH)
506 events[7] |= 0x01; /* Enhanced Flush Complete */
507
508 if (hdev->features[7] & LMP_LSTO)
509 events[6] |= 0x80; /* Link Supervision Timeout Changed */
510
511 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
512 events[6] |= 0x01; /* IO Capability Request */
513 events[6] |= 0x02; /* IO Capability Response */
514 events[6] |= 0x04; /* User Confirmation Request */
515 events[6] |= 0x08; /* User Passkey Request */
516 events[6] |= 0x10; /* Remote OOB Data Request */
517 events[6] |= 0x20; /* Simple Pairing Complete */
518 events[7] |= 0x04; /* User Passkey Notification */
519 events[7] |= 0x08; /* Keypress Notification */
520 events[7] |= 0x10; /* Remote Host Supported
521 * Features Notification */
522 }
523
524 if (hdev->features[4] & LMP_LE)
525 events[7] |= 0x20; /* LE Meta-Event */
526
527 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
528}
529
Andre Guedes5521abe2011-06-30 19:20:54 -0300530static void hci_set_le_support(struct hci_dev *hdev)
531{
532 struct hci_cp_write_le_host_supported cp;
533
534 memset(&cp, 0, sizeof(cp));
535
536 if (enable_le) {
537 cp.le = 1;
538 cp.simul = !!(hdev->features[6] & LMP_SIMUL_LE_BR);
539 }
540
541 hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(cp), &cp);
542}
543
Johan Hedbergd5859e22011-01-25 01:19:58 +0200544static void hci_setup(struct hci_dev *hdev)
545{
546 hci_setup_event_mask(hdev);
547
548 if (hdev->lmp_ver > 1)
549 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
550
551 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
552 u8 mode = 0x01;
553 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
554 }
555
556 if (hdev->features[3] & LMP_RSSI_INQ)
557 hci_setup_inquiry_mode(hdev);
558
559 if (hdev->features[7] & LMP_INQ_TX_PWR)
560 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
Andre Guedesd5fa5132011-06-30 19:20:52 -0300561
562 if (hdev->features[7] & LMP_EXTFEATURES) {
563 struct hci_cp_read_local_ext_features cp;
564
565 cp.page = 0x01;
566 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES,
567 sizeof(cp), &cp);
568 }
Andre Guedes5521abe2011-06-30 19:20:54 -0300569
570 if (hdev->features[4] & LMP_LE)
571 hci_set_le_support(hdev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200572}
573
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200574static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
575{
576 struct hci_rp_read_local_version *rp = (void *) skb->data;
577
578 BT_DBG("%s status 0x%x", hdev->name, rp->status);
579
580 if (rp->status)
581 return;
582
583 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200584 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200585 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200586 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200587 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200588
589 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
590 hdev->manufacturer,
591 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200592
593 if (test_bit(HCI_INIT, &hdev->flags))
594 hci_setup(hdev);
595}
596
597static void hci_setup_link_policy(struct hci_dev *hdev)
598{
599 u16 link_policy = 0;
600
601 if (hdev->features[0] & LMP_RSWITCH)
602 link_policy |= HCI_LP_RSWITCH;
603 if (hdev->features[0] & LMP_HOLD)
604 link_policy |= HCI_LP_HOLD;
605 if (hdev->features[0] & LMP_SNIFF)
606 link_policy |= HCI_LP_SNIFF;
607 if (hdev->features[1] & LMP_PARK)
608 link_policy |= HCI_LP_PARK;
609
610 link_policy = cpu_to_le16(link_policy);
611 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
612 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200613}
614
615static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
616{
617 struct hci_rp_read_local_commands *rp = (void *) skb->data;
618
619 BT_DBG("%s status 0x%x", hdev->name, rp->status);
620
621 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200622 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200623
624 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200625
626 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
627 hci_setup_link_policy(hdev);
628
629done:
630 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200631}
632
633static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
634{
635 struct hci_rp_read_local_features *rp = (void *) skb->data;
636
637 BT_DBG("%s status 0x%x", hdev->name, rp->status);
638
639 if (rp->status)
640 return;
641
642 memcpy(hdev->features, rp->features, 8);
643
644 /* Adjust default settings according to features
645 * supported by device. */
646
647 if (hdev->features[0] & LMP_3SLOT)
648 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
649
650 if (hdev->features[0] & LMP_5SLOT)
651 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
652
653 if (hdev->features[1] & LMP_HV2) {
654 hdev->pkt_type |= (HCI_HV2);
655 hdev->esco_type |= (ESCO_HV2);
656 }
657
658 if (hdev->features[1] & LMP_HV3) {
659 hdev->pkt_type |= (HCI_HV3);
660 hdev->esco_type |= (ESCO_HV3);
661 }
662
663 if (hdev->features[3] & LMP_ESCO)
664 hdev->esco_type |= (ESCO_EV3);
665
666 if (hdev->features[4] & LMP_EV4)
667 hdev->esco_type |= (ESCO_EV4);
668
669 if (hdev->features[4] & LMP_EV5)
670 hdev->esco_type |= (ESCO_EV5);
671
Marcel Holtmannefc76882009-02-06 09:13:37 +0100672 if (hdev->features[5] & LMP_EDR_ESCO_2M)
673 hdev->esco_type |= (ESCO_2EV3);
674
675 if (hdev->features[5] & LMP_EDR_ESCO_3M)
676 hdev->esco_type |= (ESCO_3EV3);
677
678 if (hdev->features[5] & LMP_EDR_3S_ESCO)
679 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
680
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200681 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
682 hdev->features[0], hdev->features[1],
683 hdev->features[2], hdev->features[3],
684 hdev->features[4], hdev->features[5],
685 hdev->features[6], hdev->features[7]);
686}
687
Andre Guedesd5fa5132011-06-30 19:20:52 -0300688static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
689 struct sk_buff *skb)
690{
691 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
692
693 BT_DBG("%s status 0x%x", hdev->name, rp->status);
694
695 if (rp->status)
696 return;
697
698 memcpy(hdev->extfeatures, rp->features, 8);
699
700 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
701}
702
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200703static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
704{
705 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
706
707 BT_DBG("%s status 0x%x", hdev->name, rp->status);
708
709 if (rp->status)
710 return;
711
712 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
713 hdev->sco_mtu = rp->sco_mtu;
714 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
715 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
716
717 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
718 hdev->sco_mtu = 64;
719 hdev->sco_pkts = 8;
720 }
721
722 hdev->acl_cnt = hdev->acl_pkts;
723 hdev->sco_cnt = hdev->sco_pkts;
724
725 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
726 hdev->acl_mtu, hdev->acl_pkts,
727 hdev->sco_mtu, hdev->sco_pkts);
728}
729
730static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
731{
732 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
733
734 BT_DBG("%s status 0x%x", hdev->name, rp->status);
735
736 if (!rp->status)
737 bacpy(&hdev->bdaddr, &rp->bdaddr);
738
Johan Hedberg23bb5762010-12-21 23:01:27 +0200739 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
740}
741
742static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
743{
744 __u8 status = *((__u8 *) skb->data);
745
746 BT_DBG("%s status 0x%x", hdev->name, status);
747
748 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200749}
750
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200751static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
752 struct sk_buff *skb)
753{
754 __u8 status = *((__u8 *) skb->data);
755
756 BT_DBG("%s status 0x%x", hdev->name, status);
757
758 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
759}
760
Johan Hedbergd5859e22011-01-25 01:19:58 +0200761static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
762{
763 __u8 status = *((__u8 *) skb->data);
764
765 BT_DBG("%s status 0x%x", hdev->name, status);
766
767 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
768}
769
770static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
771 struct sk_buff *skb)
772{
773 __u8 status = *((__u8 *) skb->data);
774
775 BT_DBG("%s status 0x%x", hdev->name, status);
776
777 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
778}
779
780static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
781 struct sk_buff *skb)
782{
783 __u8 status = *((__u8 *) skb->data);
784
785 BT_DBG("%s status 0x%x", hdev->name, status);
786
787 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
788}
789
790static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
791{
792 __u8 status = *((__u8 *) skb->data);
793
794 BT_DBG("%s status 0x%x", hdev->name, status);
795
796 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
797}
798
Johan Hedberg980e1a52011-01-22 06:10:07 +0200799static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
800{
801 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
802 struct hci_cp_pin_code_reply *cp;
803 struct hci_conn *conn;
804
805 BT_DBG("%s status 0x%x", hdev->name, rp->status);
806
807 if (test_bit(HCI_MGMT, &hdev->flags))
808 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
809
810 if (rp->status != 0)
811 return;
812
813 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
814 if (!cp)
815 return;
816
817 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
818 if (conn)
819 conn->pin_length = cp->pin_len;
820}
821
822static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
823{
824 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
825
826 BT_DBG("%s status 0x%x", hdev->name, rp->status);
827
828 if (test_bit(HCI_MGMT, &hdev->flags))
829 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
830 rp->status);
831}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300832static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
833 struct sk_buff *skb)
834{
835 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
836
837 BT_DBG("%s status 0x%x", hdev->name, rp->status);
838
839 if (rp->status)
840 return;
841
842 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
843 hdev->le_pkts = rp->le_max_pkt;
844
845 hdev->le_cnt = hdev->le_pkts;
846
847 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
848
849 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
850}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200851
Johan Hedberga5c29682011-02-19 12:05:57 -0300852static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
853{
854 struct hci_rp_user_confirm_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_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
860 rp->status);
861}
862
863static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
864 struct sk_buff *skb)
865{
866 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
867
868 BT_DBG("%s status 0x%x", hdev->name, rp->status);
869
870 if (test_bit(HCI_MGMT, &hdev->flags))
871 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
872 rp->status);
873}
874
Szymon Jancc35938b2011-03-22 13:12:21 +0100875static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
876 struct sk_buff *skb)
877{
878 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
879
880 BT_DBG("%s status 0x%x", hdev->name, rp->status);
881
882 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
883 rp->randomizer, rp->status);
884}
885
Andre Guedes726e1332011-05-26 16:23:52 -0300886static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
887 struct sk_buff *skb)
888{
889 struct hci_cp_le_set_scan_enable *cp;
890 __u8 status = *((__u8 *) skb->data);
891
892 BT_DBG("%s status 0x%x", hdev->name, status);
893
894 if (status)
895 return;
896
897 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
898 if (!cp)
899 return;
900
901 hci_dev_lock(hdev);
902
Andre Guedes45e600f2011-05-26 16:23:53 -0300903 if (cp->enable == 0x01) {
904 del_timer(&hdev->adv_timer);
Andre Guedes726e1332011-05-26 16:23:52 -0300905 hci_adv_entries_clear(hdev);
Andre Guedes45e600f2011-05-26 16:23:53 -0300906 } else if (cp->enable == 0x00) {
907 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
908 }
Andre Guedes726e1332011-05-26 16:23:52 -0300909
910 hci_dev_unlock(hdev);
911}
912
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -0300913static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
914{
915 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
916
917 BT_DBG("%s status 0x%x", hdev->name, rp->status);
918
919 if (rp->status)
920 return;
921
922 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
923}
924
925static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
926{
927 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
928
929 BT_DBG("%s status 0x%x", hdev->name, rp->status);
930
931 if (rp->status)
932 return;
933
934 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
935}
936
Andre Guedese326af42011-06-30 19:20:53 -0300937static inline void hci_cc_write_le_host_supported(struct hci_dev *hdev,
938 struct sk_buff *skb)
939{
940 struct hci_cp_read_local_ext_features cp;
941 __u8 status = *((__u8 *) skb->data);
942
943 BT_DBG("%s status 0x%x", hdev->name, status);
944
945 if (status)
946 return;
947
948 cp.page = 0x01;
949 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp), &cp);
950}
951
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200952static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
953{
954 BT_DBG("%s status 0x%x", hdev->name, status);
955
956 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200957 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200958 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -0400959 return;
960 }
961
962 if (test_bit(HCI_MGMT, &hdev->flags) &&
963 !test_and_set_bit(HCI_INQUIRY,
964 &hdev->flags))
965 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200966}
967
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
969{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200970 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700971 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700972
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200973 BT_DBG("%s status 0x%x", hdev->name, status);
974
975 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700976 if (!cp)
977 return;
978
979 hci_dev_lock(hdev);
980
981 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
982
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200983 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984
985 if (status) {
986 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200987 if (status != 0x0c || conn->attempt > 2) {
988 conn->state = BT_CLOSED;
989 hci_proto_connect_cfm(conn, status);
990 hci_conn_del(conn);
991 } else
992 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 }
994 } else {
995 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -0800996 conn = hci_conn_add(hdev, ACL_LINK, 0, &cp->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700997 if (conn) {
998 conn->out = 1;
999 conn->link_mode |= HCI_LM_MASTER;
1000 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001001 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002 }
1003 }
1004
1005 hci_dev_unlock(hdev);
1006}
1007
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001008static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001009{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001010 struct hci_cp_add_sco *cp;
1011 struct hci_conn *acl, *sco;
1012 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001013
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001014 BT_DBG("%s status 0x%x", hdev->name, status);
1015
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001016 if (!status)
1017 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001019 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1020 if (!cp)
1021 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001022
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001023 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001025 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001026
1027 hci_dev_lock(hdev);
1028
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001029 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001030 if (acl) {
1031 sco = acl->link;
1032 if (sco) {
1033 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001034
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001035 hci_proto_connect_cfm(sco, status);
1036 hci_conn_del(sco);
1037 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001038 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001039
1040 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001041}
1042
Marcel Holtmannf8558552008-07-14 20:13:49 +02001043static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1044{
1045 struct hci_cp_auth_requested *cp;
1046 struct hci_conn *conn;
1047
1048 BT_DBG("%s status 0x%x", hdev->name, status);
1049
1050 if (!status)
1051 return;
1052
1053 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1054 if (!cp)
1055 return;
1056
1057 hci_dev_lock(hdev);
1058
1059 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1060 if (conn) {
1061 if (conn->state == BT_CONFIG) {
1062 hci_proto_connect_cfm(conn, status);
1063 hci_conn_put(conn);
1064 }
1065 }
1066
1067 hci_dev_unlock(hdev);
1068}
1069
1070static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1071{
1072 struct hci_cp_set_conn_encrypt *cp;
1073 struct hci_conn *conn;
1074
1075 BT_DBG("%s status 0x%x", hdev->name, status);
1076
1077 if (!status)
1078 return;
1079
1080 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1081 if (!cp)
1082 return;
1083
1084 hci_dev_lock(hdev);
1085
1086 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1087 if (conn) {
1088 if (conn->state == BT_CONFIG) {
1089 hci_proto_connect_cfm(conn, status);
1090 hci_conn_put(conn);
1091 }
1092 }
1093
1094 hci_dev_unlock(hdev);
1095}
1096
Johan Hedberg127178d2010-11-18 22:22:29 +02001097static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001098 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001099{
Johan Hedberg392599b2010-11-18 22:22:28 +02001100 if (conn->state != BT_CONFIG || !conn->out)
1101 return 0;
1102
Johan Hedberg765c2a92011-01-19 12:06:52 +05301103 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001104 return 0;
1105
1106 /* Only request authentication for SSP connections or non-SSP
1107 * devices with sec_level HIGH */
1108 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Johan Hedberg765c2a92011-01-19 12:06:52 +05301109 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001110 return 0;
1111
Johan Hedberg392599b2010-11-18 22:22:28 +02001112 return 1;
1113}
1114
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001115static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1116{
Johan Hedberg127178d2010-11-18 22:22:29 +02001117 struct hci_cp_remote_name_req *cp;
1118 struct hci_conn *conn;
1119
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001120 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001121
1122 /* If successful wait for the name req complete event before
1123 * checking for the need to do authentication */
1124 if (!status)
1125 return;
1126
1127 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1128 if (!cp)
1129 return;
1130
1131 hci_dev_lock(hdev);
1132
1133 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001134 if (!conn)
1135 goto unlock;
1136
1137 if (!hci_outgoing_auth_needed(hdev, conn))
1138 goto unlock;
1139
1140 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001141 struct hci_cp_auth_requested cp;
1142 cp.handle = __cpu_to_le16(conn->handle);
1143 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1144 }
1145
Johan Hedberg79c6c702011-04-28 11:28:55 -07001146unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001147 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001148}
1149
Marcel Holtmann769be972008-07-14 20:13:49 +02001150static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1151{
1152 struct hci_cp_read_remote_features *cp;
1153 struct hci_conn *conn;
1154
1155 BT_DBG("%s status 0x%x", hdev->name, status);
1156
1157 if (!status)
1158 return;
1159
1160 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1161 if (!cp)
1162 return;
1163
1164 hci_dev_lock(hdev);
1165
1166 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1167 if (conn) {
1168 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001169 hci_proto_connect_cfm(conn, status);
1170 hci_conn_put(conn);
1171 }
1172 }
1173
1174 hci_dev_unlock(hdev);
1175}
1176
1177static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1178{
1179 struct hci_cp_read_remote_ext_features *cp;
1180 struct hci_conn *conn;
1181
1182 BT_DBG("%s status 0x%x", hdev->name, status);
1183
1184 if (!status)
1185 return;
1186
1187 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1188 if (!cp)
1189 return;
1190
1191 hci_dev_lock(hdev);
1192
1193 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1194 if (conn) {
1195 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001196 hci_proto_connect_cfm(conn, status);
1197 hci_conn_put(conn);
1198 }
1199 }
1200
1201 hci_dev_unlock(hdev);
1202}
1203
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001204static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1205{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001206 struct hci_cp_setup_sync_conn *cp;
1207 struct hci_conn *acl, *sco;
1208 __u16 handle;
1209
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001210 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001211
1212 if (!status)
1213 return;
1214
1215 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1216 if (!cp)
1217 return;
1218
1219 handle = __le16_to_cpu(cp->handle);
1220
1221 BT_DBG("%s handle %d", hdev->name, handle);
1222
1223 hci_dev_lock(hdev);
1224
1225 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001226 if (acl) {
1227 sco = acl->link;
1228 if (sco) {
1229 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001230
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001231 hci_proto_connect_cfm(sco, status);
1232 hci_conn_del(sco);
1233 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001234 }
1235
1236 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001237}
1238
1239static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1240{
1241 struct hci_cp_sniff_mode *cp;
1242 struct hci_conn *conn;
1243
1244 BT_DBG("%s status 0x%x", hdev->name, status);
1245
1246 if (!status)
1247 return;
1248
1249 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1250 if (!cp)
1251 return;
1252
1253 hci_dev_lock(hdev);
1254
1255 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001256 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001257 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1258
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001259 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1260 hci_sco_setup(conn, status);
1261 }
1262
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001263 hci_dev_unlock(hdev);
1264}
1265
1266static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1267{
1268 struct hci_cp_exit_sniff_mode *cp;
1269 struct hci_conn *conn;
1270
1271 BT_DBG("%s status 0x%x", hdev->name, status);
1272
1273 if (!status)
1274 return;
1275
1276 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1277 if (!cp)
1278 return;
1279
1280 hci_dev_lock(hdev);
1281
1282 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001283 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001284 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1285
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001286 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1287 hci_sco_setup(conn, status);
1288 }
1289
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001290 hci_dev_unlock(hdev);
1291}
1292
Ville Tervofcd89c02011-02-10 22:38:47 -03001293static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1294{
1295 struct hci_cp_le_create_conn *cp;
1296 struct hci_conn *conn;
1297
1298 BT_DBG("%s status 0x%x", hdev->name, status);
1299
1300 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1301 if (!cp)
1302 return;
1303
1304 hci_dev_lock(hdev);
1305
1306 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1307
1308 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1309 conn);
1310
1311 if (status) {
1312 if (conn && conn->state == BT_CONNECT) {
1313 conn->state = BT_CLOSED;
1314 hci_proto_connect_cfm(conn, status);
1315 hci_conn_del(conn);
1316 }
1317 } else {
1318 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001319 conn = hci_conn_add(hdev, LE_LINK, 0, &cp->peer_addr);
Andre Guedes149c0972011-05-31 14:20:54 -03001320 if (conn) {
1321 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001322 conn->out = 1;
Andre Guedes149c0972011-05-31 14:20:54 -03001323 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001324 BT_ERR("No memory for new connection");
Andre Guedes149c0972011-05-31 14:20:54 -03001325 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001326 }
1327 }
1328
1329 hci_dev_unlock(hdev);
1330}
1331
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001332static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1333{
1334 BT_DBG("%s status 0x%x", hdev->name, status);
1335}
1336
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001337static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1338{
1339 __u8 status = *((__u8 *) skb->data);
1340
1341 BT_DBG("%s status %d", hdev->name, status);
1342
Johan Hedberg314b2382011-04-27 10:29:57 -04001343 if (test_bit(HCI_MGMT, &hdev->flags) &&
1344 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1345 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001346
Johan Hedberg23bb5762010-12-21 23:01:27 +02001347 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001348
1349 hci_conn_check_pending(hdev);
1350}
1351
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1353{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001354 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001355 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001356 int num_rsp = *((__u8 *) skb->data);
1357
1358 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1359
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001360 if (!num_rsp)
1361 return;
1362
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001364
Johan Hedberg314b2382011-04-27 10:29:57 -04001365 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
1366
1367 if (test_bit(HCI_MGMT, &hdev->flags))
1368 mgmt_discovering(hdev->id, 1);
1369 }
1370
Johan Hedberge17acd42011-03-30 23:57:16 +03001371 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372 bacpy(&data.bdaddr, &info->bdaddr);
1373 data.pscan_rep_mode = info->pscan_rep_mode;
1374 data.pscan_period_mode = info->pscan_period_mode;
1375 data.pscan_mode = info->pscan_mode;
1376 memcpy(data.dev_class, info->dev_class, 3);
1377 data.clock_offset = info->clock_offset;
1378 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001379 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001380 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03001381 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class, 0,
1382 NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001383 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001384
Linus Torvalds1da177e2005-04-16 15:20:36 -07001385 hci_dev_unlock(hdev);
1386}
1387
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001388static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001389{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001390 struct hci_ev_conn_complete *ev = (void *) skb->data;
1391 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001392
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001393 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001394
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001396
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001397 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001398 if (!conn) {
1399 if (ev->link_type != SCO_LINK)
1400 goto unlock;
1401
1402 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1403 if (!conn)
1404 goto unlock;
1405
1406 conn->type = SCO_LINK;
1407 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001408
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001409 if (!ev->status) {
1410 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001411
1412 if (conn->type == ACL_LINK) {
1413 conn->state = BT_CONFIG;
1414 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001415 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedbergf7520542011-01-20 12:34:39 +02001416 mgmt_connected(hdev->id, &ev->bdaddr);
Marcel Holtmann769be972008-07-14 20:13:49 +02001417 } else
1418 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001419
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001420 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001421 hci_conn_add_sysfs(conn);
1422
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001423 if (test_bit(HCI_AUTH, &hdev->flags))
1424 conn->link_mode |= HCI_LM_AUTH;
1425
1426 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1427 conn->link_mode |= HCI_LM_ENCRYPT;
1428
1429 /* Get remote features */
1430 if (conn->type == ACL_LINK) {
1431 struct hci_cp_read_remote_features cp;
1432 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001433 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1434 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001435 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001436
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001437 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001438 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001439 struct hci_cp_change_conn_ptype cp;
1440 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001441 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1442 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1443 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001444 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001445 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001446 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001447 if (conn->type == ACL_LINK)
1448 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1449 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001450
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001451 if (conn->type == ACL_LINK)
1452 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001453
Marcel Holtmann769be972008-07-14 20:13:49 +02001454 if (ev->status) {
1455 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001456 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001457 } else if (ev->link_type != ACL_LINK)
1458 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001459
1460unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001462
1463 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001464}
1465
Linus Torvalds1da177e2005-04-16 15:20:36 -07001466static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1467{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001468 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001469 int mask = hdev->link_mode;
1470
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001471 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1472 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001473
1474 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1475
Szymon Janc138d22e2011-02-17 16:44:23 +01001476 if ((mask & HCI_LM_ACCEPT) &&
1477 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001478 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001479 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001480 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001481
1482 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001483
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001484 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1485 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001486 memcpy(ie->data.dev_class, ev->dev_class, 3);
1487
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1489 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001490 /* pkt_type not yet used for incoming connections */
1491 conn = hci_conn_add(hdev, ev->link_type, 0, &ev->bdaddr);
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001492 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001493 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001494 hci_dev_unlock(hdev);
1495 return;
1496 }
1497 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001498
Linus Torvalds1da177e2005-04-16 15:20:36 -07001499 memcpy(conn->dev_class, ev->dev_class, 3);
1500 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001501
Linus Torvalds1da177e2005-04-16 15:20:36 -07001502 hci_dev_unlock(hdev);
1503
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001504 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1505 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001507 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001508
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001509 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1510 cp.role = 0x00; /* Become master */
1511 else
1512 cp.role = 0x01; /* Remain slave */
1513
1514 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1515 sizeof(cp), &cp);
1516 } else {
1517 struct hci_cp_accept_sync_conn_req cp;
1518
1519 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001520 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001521
1522 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1523 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1524 cp.max_latency = cpu_to_le16(0xffff);
1525 cp.content_format = cpu_to_le16(hdev->voice_setting);
1526 cp.retrans_effort = 0xff;
1527
1528 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1529 sizeof(cp), &cp);
1530 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001531 } else {
1532 /* Connection rejected */
1533 struct hci_cp_reject_conn_req cp;
1534
1535 bacpy(&cp.bdaddr, &ev->bdaddr);
1536 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001537 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001538 }
1539}
1540
Linus Torvalds1da177e2005-04-16 15:20:36 -07001541static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1542{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001543 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001544 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545
1546 BT_DBG("%s status %d", hdev->name, ev->status);
1547
Johan Hedberg8962ee72011-01-20 12:40:27 +02001548 if (ev->status) {
1549 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001550 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001551 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001552
1553 hci_dev_lock(hdev);
1554
Marcel Holtmann04837f62006-07-03 10:02:33 +02001555 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001556 if (!conn)
1557 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001558
Johan Hedbergf7520542011-01-20 12:34:39 +02001559 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001560
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001561 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedbergf7520542011-01-20 12:34:39 +02001562 mgmt_disconnected(hdev->id, &conn->dst);
1563
1564 hci_proto_disconn_cfm(conn, ev->reason);
1565 hci_conn_del(conn);
1566
1567unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001568 hci_dev_unlock(hdev);
1569}
1570
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001571static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1572{
1573 struct hci_ev_auth_complete *ev = (void *) skb->data;
1574 struct hci_conn *conn;
1575
1576 BT_DBG("%s status %d", hdev->name, ev->status);
1577
1578 hci_dev_lock(hdev);
1579
1580 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001581 if (!conn)
1582 goto unlock;
1583
1584 if (!ev->status) {
1585 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1586 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1587 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001588 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001589 conn->link_mode |= HCI_LM_AUTH;
1590 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001591 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001592 } else {
1593 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1594 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001595
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001596 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1597 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001598
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001599 if (conn->state == BT_CONFIG) {
1600 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1601 struct hci_cp_set_conn_encrypt cp;
1602 cp.handle = ev->handle;
1603 cp.encrypt = 0x01;
1604 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1605 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001606 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001607 conn->state = BT_CONNECTED;
1608 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001609 hci_conn_put(conn);
1610 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001611 } else {
1612 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001613
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001614 hci_conn_hold(conn);
1615 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1616 hci_conn_put(conn);
1617 }
1618
1619 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1620 if (!ev->status) {
1621 struct hci_cp_set_conn_encrypt cp;
1622 cp.handle = ev->handle;
1623 cp.encrypt = 0x01;
1624 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1625 &cp);
1626 } else {
1627 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1628 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001629 }
1630 }
1631
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001632unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001633 hci_dev_unlock(hdev);
1634}
1635
1636static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1637{
Johan Hedberg127178d2010-11-18 22:22:29 +02001638 struct hci_ev_remote_name *ev = (void *) skb->data;
1639 struct hci_conn *conn;
1640
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001641 BT_DBG("%s", hdev->name);
1642
1643 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001644
1645 hci_dev_lock(hdev);
1646
Johan Hedberga88a9652011-03-30 13:18:12 +03001647 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1648 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1649
Johan Hedberg127178d2010-11-18 22:22:29 +02001650 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001651 if (!conn)
1652 goto unlock;
1653
1654 if (!hci_outgoing_auth_needed(hdev, conn))
1655 goto unlock;
1656
1657 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001658 struct hci_cp_auth_requested cp;
1659 cp.handle = __cpu_to_le16(conn->handle);
1660 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1661 }
1662
Johan Hedberg79c6c702011-04-28 11:28:55 -07001663unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001664 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001665}
1666
1667static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1668{
1669 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1670 struct hci_conn *conn;
1671
1672 BT_DBG("%s status %d", hdev->name, ev->status);
1673
1674 hci_dev_lock(hdev);
1675
1676 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1677 if (conn) {
1678 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001679 if (ev->encrypt) {
1680 /* Encryption implies authentication */
1681 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001682 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomes64532ec2011-06-09 18:50:53 -03001683 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001684 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001685 conn->link_mode &= ~HCI_LM_ENCRYPT;
1686 }
1687
1688 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1689
Marcel Holtmannf8558552008-07-14 20:13:49 +02001690 if (conn->state == BT_CONFIG) {
1691 if (!ev->status)
1692 conn->state = BT_CONNECTED;
1693
1694 hci_proto_connect_cfm(conn, ev->status);
1695 hci_conn_put(conn);
1696 } else
1697 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001698 }
1699
1700 hci_dev_unlock(hdev);
1701}
1702
1703static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1704{
1705 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1706 struct hci_conn *conn;
1707
1708 BT_DBG("%s status %d", hdev->name, ev->status);
1709
1710 hci_dev_lock(hdev);
1711
1712 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1713 if (conn) {
1714 if (!ev->status)
1715 conn->link_mode |= HCI_LM_SECURE;
1716
1717 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1718
1719 hci_key_change_cfm(conn, ev->status);
1720 }
1721
1722 hci_dev_unlock(hdev);
1723}
1724
1725static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1726{
1727 struct hci_ev_remote_features *ev = (void *) skb->data;
1728 struct hci_conn *conn;
1729
1730 BT_DBG("%s status %d", hdev->name, ev->status);
1731
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001732 hci_dev_lock(hdev);
1733
1734 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001735 if (!conn)
1736 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001737
Johan Hedbergccd556f2010-11-10 17:11:51 +02001738 if (!ev->status)
1739 memcpy(conn->features, ev->features, 8);
1740
1741 if (conn->state != BT_CONFIG)
1742 goto unlock;
1743
1744 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1745 struct hci_cp_read_remote_ext_features cp;
1746 cp.handle = ev->handle;
1747 cp.page = 0x01;
1748 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001749 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001750 goto unlock;
1751 }
1752
Johan Hedberg127178d2010-11-18 22:22:29 +02001753 if (!ev->status) {
1754 struct hci_cp_remote_name_req cp;
1755 memset(&cp, 0, sizeof(cp));
1756 bacpy(&cp.bdaddr, &conn->dst);
1757 cp.pscan_rep_mode = 0x02;
1758 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1759 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001760
Johan Hedberg127178d2010-11-18 22:22:29 +02001761 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001762 conn->state = BT_CONNECTED;
1763 hci_proto_connect_cfm(conn, ev->status);
1764 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001765 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001766
Johan Hedbergccd556f2010-11-10 17:11:51 +02001767unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001768 hci_dev_unlock(hdev);
1769}
1770
1771static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1772{
1773 BT_DBG("%s", hdev->name);
1774}
1775
1776static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1777{
1778 BT_DBG("%s", hdev->name);
1779}
1780
1781static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1782{
1783 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1784 __u16 opcode;
1785
1786 skb_pull(skb, sizeof(*ev));
1787
1788 opcode = __le16_to_cpu(ev->opcode);
1789
1790 switch (opcode) {
1791 case HCI_OP_INQUIRY_CANCEL:
1792 hci_cc_inquiry_cancel(hdev, skb);
1793 break;
1794
1795 case HCI_OP_EXIT_PERIODIC_INQ:
1796 hci_cc_exit_periodic_inq(hdev, skb);
1797 break;
1798
1799 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1800 hci_cc_remote_name_req_cancel(hdev, skb);
1801 break;
1802
1803 case HCI_OP_ROLE_DISCOVERY:
1804 hci_cc_role_discovery(hdev, skb);
1805 break;
1806
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001807 case HCI_OP_READ_LINK_POLICY:
1808 hci_cc_read_link_policy(hdev, skb);
1809 break;
1810
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001811 case HCI_OP_WRITE_LINK_POLICY:
1812 hci_cc_write_link_policy(hdev, skb);
1813 break;
1814
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001815 case HCI_OP_READ_DEF_LINK_POLICY:
1816 hci_cc_read_def_link_policy(hdev, skb);
1817 break;
1818
1819 case HCI_OP_WRITE_DEF_LINK_POLICY:
1820 hci_cc_write_def_link_policy(hdev, skb);
1821 break;
1822
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001823 case HCI_OP_RESET:
1824 hci_cc_reset(hdev, skb);
1825 break;
1826
1827 case HCI_OP_WRITE_LOCAL_NAME:
1828 hci_cc_write_local_name(hdev, skb);
1829 break;
1830
1831 case HCI_OP_READ_LOCAL_NAME:
1832 hci_cc_read_local_name(hdev, skb);
1833 break;
1834
1835 case HCI_OP_WRITE_AUTH_ENABLE:
1836 hci_cc_write_auth_enable(hdev, skb);
1837 break;
1838
1839 case HCI_OP_WRITE_ENCRYPT_MODE:
1840 hci_cc_write_encrypt_mode(hdev, skb);
1841 break;
1842
1843 case HCI_OP_WRITE_SCAN_ENABLE:
1844 hci_cc_write_scan_enable(hdev, skb);
1845 break;
1846
1847 case HCI_OP_READ_CLASS_OF_DEV:
1848 hci_cc_read_class_of_dev(hdev, skb);
1849 break;
1850
1851 case HCI_OP_WRITE_CLASS_OF_DEV:
1852 hci_cc_write_class_of_dev(hdev, skb);
1853 break;
1854
1855 case HCI_OP_READ_VOICE_SETTING:
1856 hci_cc_read_voice_setting(hdev, skb);
1857 break;
1858
1859 case HCI_OP_WRITE_VOICE_SETTING:
1860 hci_cc_write_voice_setting(hdev, skb);
1861 break;
1862
1863 case HCI_OP_HOST_BUFFER_SIZE:
1864 hci_cc_host_buffer_size(hdev, skb);
1865 break;
1866
Marcel Holtmann333140b2008-07-14 20:13:48 +02001867 case HCI_OP_READ_SSP_MODE:
1868 hci_cc_read_ssp_mode(hdev, skb);
1869 break;
1870
1871 case HCI_OP_WRITE_SSP_MODE:
1872 hci_cc_write_ssp_mode(hdev, skb);
1873 break;
1874
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001875 case HCI_OP_READ_LOCAL_VERSION:
1876 hci_cc_read_local_version(hdev, skb);
1877 break;
1878
1879 case HCI_OP_READ_LOCAL_COMMANDS:
1880 hci_cc_read_local_commands(hdev, skb);
1881 break;
1882
1883 case HCI_OP_READ_LOCAL_FEATURES:
1884 hci_cc_read_local_features(hdev, skb);
1885 break;
1886
Andre Guedesd5fa5132011-06-30 19:20:52 -03001887 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1888 hci_cc_read_local_ext_features(hdev, skb);
1889 break;
1890
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001891 case HCI_OP_READ_BUFFER_SIZE:
1892 hci_cc_read_buffer_size(hdev, skb);
1893 break;
1894
1895 case HCI_OP_READ_BD_ADDR:
1896 hci_cc_read_bd_addr(hdev, skb);
1897 break;
1898
Johan Hedberg23bb5762010-12-21 23:01:27 +02001899 case HCI_OP_WRITE_CA_TIMEOUT:
1900 hci_cc_write_ca_timeout(hdev, skb);
1901 break;
1902
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001903 case HCI_OP_DELETE_STORED_LINK_KEY:
1904 hci_cc_delete_stored_link_key(hdev, skb);
1905 break;
1906
Johan Hedbergd5859e22011-01-25 01:19:58 +02001907 case HCI_OP_SET_EVENT_MASK:
1908 hci_cc_set_event_mask(hdev, skb);
1909 break;
1910
1911 case HCI_OP_WRITE_INQUIRY_MODE:
1912 hci_cc_write_inquiry_mode(hdev, skb);
1913 break;
1914
1915 case HCI_OP_READ_INQ_RSP_TX_POWER:
1916 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1917 break;
1918
1919 case HCI_OP_SET_EVENT_FLT:
1920 hci_cc_set_event_flt(hdev, skb);
1921 break;
1922
Johan Hedberg980e1a52011-01-22 06:10:07 +02001923 case HCI_OP_PIN_CODE_REPLY:
1924 hci_cc_pin_code_reply(hdev, skb);
1925 break;
1926
1927 case HCI_OP_PIN_CODE_NEG_REPLY:
1928 hci_cc_pin_code_neg_reply(hdev, skb);
1929 break;
1930
Szymon Jancc35938b2011-03-22 13:12:21 +01001931 case HCI_OP_READ_LOCAL_OOB_DATA:
1932 hci_cc_read_local_oob_data_reply(hdev, skb);
1933 break;
1934
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001935 case HCI_OP_LE_READ_BUFFER_SIZE:
1936 hci_cc_le_read_buffer_size(hdev, skb);
1937 break;
1938
Johan Hedberga5c29682011-02-19 12:05:57 -03001939 case HCI_OP_USER_CONFIRM_REPLY:
1940 hci_cc_user_confirm_reply(hdev, skb);
1941 break;
1942
1943 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1944 hci_cc_user_confirm_neg_reply(hdev, skb);
1945 break;
1946
Andre Guedes726e1332011-05-26 16:23:52 -03001947 case HCI_OP_LE_SET_SCAN_ENABLE:
1948 hci_cc_le_set_scan_enable(hdev, skb);
1949 break;
1950
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001951 case HCI_OP_LE_LTK_REPLY:
1952 hci_cc_le_ltk_reply(hdev, skb);
1953 break;
1954
1955 case HCI_OP_LE_LTK_NEG_REPLY:
1956 hci_cc_le_ltk_neg_reply(hdev, skb);
1957 break;
1958
Andre Guedese326af42011-06-30 19:20:53 -03001959 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
1960 hci_cc_write_le_host_supported(hdev, skb);
1961 break;
1962
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001963 default:
1964 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1965 break;
1966 }
1967
Ville Tervo6bd32322011-02-16 16:32:41 +02001968 if (ev->opcode != HCI_OP_NOP)
1969 del_timer(&hdev->cmd_timer);
1970
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001971 if (ev->ncmd) {
1972 atomic_set(&hdev->cmd_cnt, 1);
1973 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01001974 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001975 }
1976}
1977
1978static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1979{
1980 struct hci_ev_cmd_status *ev = (void *) skb->data;
1981 __u16 opcode;
1982
1983 skb_pull(skb, sizeof(*ev));
1984
1985 opcode = __le16_to_cpu(ev->opcode);
1986
1987 switch (opcode) {
1988 case HCI_OP_INQUIRY:
1989 hci_cs_inquiry(hdev, ev->status);
1990 break;
1991
1992 case HCI_OP_CREATE_CONN:
1993 hci_cs_create_conn(hdev, ev->status);
1994 break;
1995
1996 case HCI_OP_ADD_SCO:
1997 hci_cs_add_sco(hdev, ev->status);
1998 break;
1999
Marcel Holtmannf8558552008-07-14 20:13:49 +02002000 case HCI_OP_AUTH_REQUESTED:
2001 hci_cs_auth_requested(hdev, ev->status);
2002 break;
2003
2004 case HCI_OP_SET_CONN_ENCRYPT:
2005 hci_cs_set_conn_encrypt(hdev, ev->status);
2006 break;
2007
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002008 case HCI_OP_REMOTE_NAME_REQ:
2009 hci_cs_remote_name_req(hdev, ev->status);
2010 break;
2011
Marcel Holtmann769be972008-07-14 20:13:49 +02002012 case HCI_OP_READ_REMOTE_FEATURES:
2013 hci_cs_read_remote_features(hdev, ev->status);
2014 break;
2015
2016 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2017 hci_cs_read_remote_ext_features(hdev, ev->status);
2018 break;
2019
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002020 case HCI_OP_SETUP_SYNC_CONN:
2021 hci_cs_setup_sync_conn(hdev, ev->status);
2022 break;
2023
2024 case HCI_OP_SNIFF_MODE:
2025 hci_cs_sniff_mode(hdev, ev->status);
2026 break;
2027
2028 case HCI_OP_EXIT_SNIFF_MODE:
2029 hci_cs_exit_sniff_mode(hdev, ev->status);
2030 break;
2031
Johan Hedberg8962ee72011-01-20 12:40:27 +02002032 case HCI_OP_DISCONNECT:
2033 if (ev->status != 0)
2034 mgmt_disconnect_failed(hdev->id);
2035 break;
2036
Ville Tervofcd89c02011-02-10 22:38:47 -03002037 case HCI_OP_LE_CREATE_CONN:
2038 hci_cs_le_create_conn(hdev, ev->status);
2039 break;
2040
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002041 case HCI_OP_LE_START_ENC:
2042 hci_cs_le_start_enc(hdev, ev->status);
2043 break;
2044
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002045 default:
2046 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2047 break;
2048 }
2049
Ville Tervo6bd32322011-02-16 16:32:41 +02002050 if (ev->opcode != HCI_OP_NOP)
2051 del_timer(&hdev->cmd_timer);
2052
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002053 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002054 atomic_set(&hdev->cmd_cnt, 1);
2055 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002056 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002057 }
2058}
2059
2060static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2061{
2062 struct hci_ev_role_change *ev = (void *) skb->data;
2063 struct hci_conn *conn;
2064
2065 BT_DBG("%s status %d", hdev->name, ev->status);
2066
2067 hci_dev_lock(hdev);
2068
2069 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2070 if (conn) {
2071 if (!ev->status) {
2072 if (ev->role)
2073 conn->link_mode &= ~HCI_LM_MASTER;
2074 else
2075 conn->link_mode |= HCI_LM_MASTER;
2076 }
2077
2078 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2079
2080 hci_role_switch_cfm(conn, ev->status, ev->role);
2081 }
2082
2083 hci_dev_unlock(hdev);
2084}
2085
Linus Torvalds1da177e2005-04-16 15:20:36 -07002086static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2087{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002088 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002089 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002090 int i;
2091
2092 skb_pull(skb, sizeof(*ev));
2093
2094 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2095
2096 if (skb->len < ev->num_hndl * 4) {
2097 BT_DBG("%s bad parameters", hdev->name);
2098 return;
2099 }
2100
2101 tasklet_disable(&hdev->tx_task);
2102
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002103 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002104 struct hci_conn *conn;
2105 __u16 handle, count;
2106
Harvey Harrison83985312008-05-02 16:25:46 -07002107 handle = get_unaligned_le16(ptr++);
2108 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002109
2110 conn = hci_conn_hash_lookup_handle(hdev, handle);
2111 if (conn) {
2112 conn->sent -= count;
2113
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002114 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002115 hdev->acl_cnt += count;
2116 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002117 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002118 } else if (conn->type == LE_LINK) {
2119 if (hdev->le_pkts) {
2120 hdev->le_cnt += count;
2121 if (hdev->le_cnt > hdev->le_pkts)
2122 hdev->le_cnt = hdev->le_pkts;
2123 } else {
2124 hdev->acl_cnt += count;
2125 if (hdev->acl_cnt > hdev->acl_pkts)
2126 hdev->acl_cnt = hdev->acl_pkts;
2127 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002128 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002129 hdev->sco_cnt += count;
2130 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002131 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002132 }
2133 }
2134 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002135
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002136 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002137
2138 tasklet_enable(&hdev->tx_task);
2139}
2140
Marcel Holtmann04837f62006-07-03 10:02:33 +02002141static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002142{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002143 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002144 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002145
2146 BT_DBG("%s status %d", hdev->name, ev->status);
2147
2148 hci_dev_lock(hdev);
2149
Marcel Holtmann04837f62006-07-03 10:02:33 +02002150 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2151 if (conn) {
2152 conn->mode = ev->mode;
2153 conn->interval = __le16_to_cpu(ev->interval);
2154
2155 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2156 if (conn->mode == HCI_CM_ACTIVE)
2157 conn->power_save = 1;
2158 else
2159 conn->power_save = 0;
2160 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002161
2162 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2163 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002164 }
2165
2166 hci_dev_unlock(hdev);
2167}
2168
Linus Torvalds1da177e2005-04-16 15:20:36 -07002169static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2170{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002171 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2172 struct hci_conn *conn;
2173
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002174 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002175
2176 hci_dev_lock(hdev);
2177
2178 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Marcel Holtmann3d7a9d12009-05-09 12:09:21 -07002179 if (conn && conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002180 hci_conn_hold(conn);
2181 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2182 hci_conn_put(conn);
2183 }
2184
Johan Hedberg03b555e2011-01-04 15:40:05 +02002185 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2186 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2187 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002188 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002189 u8 secure;
2190
2191 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2192 secure = 1;
2193 else
2194 secure = 0;
2195
2196 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2197 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002198
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002199 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002200}
2201
Linus Torvalds1da177e2005-04-16 15:20:36 -07002202static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2203{
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002204 struct hci_ev_link_key_req *ev = (void *) skb->data;
2205 struct hci_cp_link_key_reply cp;
2206 struct hci_conn *conn;
2207 struct link_key *key;
2208
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002209 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002210
2211 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2212 return;
2213
2214 hci_dev_lock(hdev);
2215
2216 key = hci_find_link_key(hdev, &ev->bdaddr);
2217 if (!key) {
2218 BT_DBG("%s link key not found for %s", hdev->name,
2219 batostr(&ev->bdaddr));
2220 goto not_found;
2221 }
2222
2223 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2224 batostr(&ev->bdaddr));
2225
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002226 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2227 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002228 BT_DBG("%s ignoring debug key", hdev->name);
2229 goto not_found;
2230 }
2231
2232 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002233 if (conn) {
2234 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2235 conn->auth_type != 0xff &&
2236 (conn->auth_type & 0x01)) {
2237 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2238 goto not_found;
2239 }
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002240
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002241 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2242 conn->pending_sec_level == BT_SECURITY_HIGH) {
2243 BT_DBG("%s ignoring key unauthenticated for high \
2244 security", hdev->name);
2245 goto not_found;
2246 }
2247
2248 conn->key_type = key->type;
2249 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002250 }
2251
2252 bacpy(&cp.bdaddr, &ev->bdaddr);
2253 memcpy(cp.link_key, key->val, 16);
2254
2255 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2256
2257 hci_dev_unlock(hdev);
2258
2259 return;
2260
2261not_found:
2262 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2263 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002264}
2265
Linus Torvalds1da177e2005-04-16 15:20:36 -07002266static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2267{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002268 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2269 struct hci_conn *conn;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002270 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002271
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002272 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002273
2274 hci_dev_lock(hdev);
2275
2276 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2277 if (conn) {
2278 hci_conn_hold(conn);
2279 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002280 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002281
2282 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2283 conn->key_type = ev->key_type;
2284
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002285 hci_conn_put(conn);
2286 }
2287
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002288 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002289 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002290 ev->key_type, pin_len);
2291
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002292 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002293}
2294
Marcel Holtmann04837f62006-07-03 10:02:33 +02002295static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2296{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002297 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002298 struct hci_conn *conn;
2299
2300 BT_DBG("%s status %d", hdev->name, ev->status);
2301
2302 hci_dev_lock(hdev);
2303
2304 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002305 if (conn && !ev->status) {
2306 struct inquiry_entry *ie;
2307
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002308 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2309 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002310 ie->data.clock_offset = ev->clock_offset;
2311 ie->timestamp = jiffies;
2312 }
2313 }
2314
2315 hci_dev_unlock(hdev);
2316}
2317
Marcel Holtmanna8746412008-07-14 20:13:46 +02002318static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2319{
2320 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2321 struct hci_conn *conn;
2322
2323 BT_DBG("%s status %d", hdev->name, ev->status);
2324
2325 hci_dev_lock(hdev);
2326
2327 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2328 if (conn && !ev->status)
2329 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2330
2331 hci_dev_unlock(hdev);
2332}
2333
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002334static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2335{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002336 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002337 struct inquiry_entry *ie;
2338
2339 BT_DBG("%s", hdev->name);
2340
2341 hci_dev_lock(hdev);
2342
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002343 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2344 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002345 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2346 ie->timestamp = jiffies;
2347 }
2348
2349 hci_dev_unlock(hdev);
2350}
2351
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002352static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2353{
2354 struct inquiry_data data;
2355 int num_rsp = *((__u8 *) skb->data);
2356
2357 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2358
2359 if (!num_rsp)
2360 return;
2361
2362 hci_dev_lock(hdev);
2363
Johan Hedberg314b2382011-04-27 10:29:57 -04002364 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2365
2366 if (test_bit(HCI_MGMT, &hdev->flags))
2367 mgmt_discovering(hdev->id, 1);
2368 }
2369
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002370 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002371 struct inquiry_info_with_rssi_and_pscan_mode *info;
2372 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002373
Johan Hedberge17acd42011-03-30 23:57:16 +03002374 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002375 bacpy(&data.bdaddr, &info->bdaddr);
2376 data.pscan_rep_mode = info->pscan_rep_mode;
2377 data.pscan_period_mode = info->pscan_period_mode;
2378 data.pscan_mode = info->pscan_mode;
2379 memcpy(data.dev_class, info->dev_class, 3);
2380 data.clock_offset = info->clock_offset;
2381 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002382 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002383 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002384 mgmt_device_found(hdev->id, &info->bdaddr,
2385 info->dev_class, info->rssi,
2386 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002387 }
2388 } else {
2389 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2390
Johan Hedberge17acd42011-03-30 23:57:16 +03002391 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002392 bacpy(&data.bdaddr, &info->bdaddr);
2393 data.pscan_rep_mode = info->pscan_rep_mode;
2394 data.pscan_period_mode = info->pscan_period_mode;
2395 data.pscan_mode = 0x00;
2396 memcpy(data.dev_class, info->dev_class, 3);
2397 data.clock_offset = info->clock_offset;
2398 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002399 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002400 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002401 mgmt_device_found(hdev->id, &info->bdaddr,
2402 info->dev_class, info->rssi,
2403 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002404 }
2405 }
2406
2407 hci_dev_unlock(hdev);
2408}
2409
2410static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2411{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002412 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2413 struct hci_conn *conn;
2414
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002415 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002416
Marcel Holtmann41a96212008-07-14 20:13:48 +02002417 hci_dev_lock(hdev);
2418
2419 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002420 if (!conn)
2421 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002422
Johan Hedbergccd556f2010-11-10 17:11:51 +02002423 if (!ev->status && ev->page == 0x01) {
2424 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002425
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002426 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2427 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002428 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002429
Johan Hedbergccd556f2010-11-10 17:11:51 +02002430 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002431 }
2432
Johan Hedbergccd556f2010-11-10 17:11:51 +02002433 if (conn->state != BT_CONFIG)
2434 goto unlock;
2435
Johan Hedberg127178d2010-11-18 22:22:29 +02002436 if (!ev->status) {
2437 struct hci_cp_remote_name_req cp;
2438 memset(&cp, 0, sizeof(cp));
2439 bacpy(&cp.bdaddr, &conn->dst);
2440 cp.pscan_rep_mode = 0x02;
2441 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2442 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002443
Johan Hedberg127178d2010-11-18 22:22:29 +02002444 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002445 conn->state = BT_CONNECTED;
2446 hci_proto_connect_cfm(conn, ev->status);
2447 hci_conn_put(conn);
2448 }
2449
2450unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002451 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002452}
2453
2454static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2455{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002456 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2457 struct hci_conn *conn;
2458
2459 BT_DBG("%s status %d", hdev->name, ev->status);
2460
2461 hci_dev_lock(hdev);
2462
2463 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002464 if (!conn) {
2465 if (ev->link_type == ESCO_LINK)
2466 goto unlock;
2467
2468 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2469 if (!conn)
2470 goto unlock;
2471
2472 conn->type = SCO_LINK;
2473 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002474
Marcel Holtmann732547f2009-04-19 19:14:14 +02002475 switch (ev->status) {
2476 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002477 conn->handle = __le16_to_cpu(ev->handle);
2478 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002479
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002480 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002481 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002482 break;
2483
Nick Pelly5c9b4de2009-09-22 15:19:46 -07002484 case 0x10: /* Connection Accept Timeout */
Stephen Coe705e5712010-02-16 11:29:44 -05002485 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002486 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002487 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002488 case 0x1f: /* Unspecified error */
2489 if (conn->out && conn->attempt < 2) {
2490 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2491 (hdev->esco_type & EDR_ESCO_MASK);
2492 hci_setup_sync(conn, conn->link->handle);
2493 goto unlock;
2494 }
2495 /* fall through */
2496
2497 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002498 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002499 break;
2500 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002501
2502 hci_proto_connect_cfm(conn, ev->status);
2503 if (ev->status)
2504 hci_conn_del(conn);
2505
2506unlock:
2507 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002508}
2509
2510static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2511{
2512 BT_DBG("%s", hdev->name);
2513}
2514
Marcel Holtmann04837f62006-07-03 10:02:33 +02002515static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2516{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002517 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002518
2519 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002520}
2521
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002522static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2523{
2524 struct inquiry_data data;
2525 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2526 int num_rsp = *((__u8 *) skb->data);
2527
2528 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2529
2530 if (!num_rsp)
2531 return;
2532
Johan Hedberg314b2382011-04-27 10:29:57 -04002533 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2534
2535 if (test_bit(HCI_MGMT, &hdev->flags))
2536 mgmt_discovering(hdev->id, 1);
2537 }
2538
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002539 hci_dev_lock(hdev);
2540
Johan Hedberge17acd42011-03-30 23:57:16 +03002541 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002542 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002543 data.pscan_rep_mode = info->pscan_rep_mode;
2544 data.pscan_period_mode = info->pscan_period_mode;
2545 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002546 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002547 data.clock_offset = info->clock_offset;
2548 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002549 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002550 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002551 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class,
2552 info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002553 }
2554
2555 hci_dev_unlock(hdev);
2556}
2557
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002558static inline u8 hci_get_auth_req(struct hci_conn *conn)
2559{
2560 /* If remote requests dedicated bonding follow that lead */
2561 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2562 /* If both remote and local IO capabilities allow MITM
2563 * protection then require it, otherwise don't */
2564 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2565 return 0x02;
2566 else
2567 return 0x03;
2568 }
2569
2570 /* If remote requests no-bonding follow that lead */
2571 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002572 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002573
2574 return conn->auth_type;
2575}
2576
Marcel Holtmann04936842008-07-14 20:13:48 +02002577static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2578{
2579 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2580 struct hci_conn *conn;
2581
2582 BT_DBG("%s", hdev->name);
2583
2584 hci_dev_lock(hdev);
2585
2586 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002587 if (!conn)
2588 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002589
Johan Hedberg03b555e2011-01-04 15:40:05 +02002590 hci_conn_hold(conn);
2591
2592 if (!test_bit(HCI_MGMT, &hdev->flags))
2593 goto unlock;
2594
2595 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2596 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002597 struct hci_cp_io_capability_reply cp;
2598
2599 bacpy(&cp.bdaddr, &ev->bdaddr);
2600 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002601 conn->auth_type = hci_get_auth_req(conn);
2602 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002603
Szymon Jancce85ee12011-03-22 13:12:23 +01002604 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2605 hci_find_remote_oob_data(hdev, &conn->dst))
2606 cp.oob_data = 0x01;
2607 else
2608 cp.oob_data = 0x00;
2609
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002610 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2611 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002612 } else {
2613 struct hci_cp_io_capability_neg_reply cp;
2614
2615 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedbergbe771592011-04-28 11:28:57 -07002616 cp.reason = 0x18; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02002617
2618 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2619 sizeof(cp), &cp);
2620 }
2621
2622unlock:
2623 hci_dev_unlock(hdev);
2624}
2625
2626static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2627{
2628 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2629 struct hci_conn *conn;
2630
2631 BT_DBG("%s", hdev->name);
2632
2633 hci_dev_lock(hdev);
2634
2635 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2636 if (!conn)
2637 goto unlock;
2638
Johan Hedberg03b555e2011-01-04 15:40:05 +02002639 conn->remote_cap = ev->capability;
2640 conn->remote_oob = ev->oob_data;
2641 conn->remote_auth = ev->authentication;
2642
2643unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002644 hci_dev_unlock(hdev);
2645}
2646
Johan Hedberga5c29682011-02-19 12:05:57 -03002647static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2648 struct sk_buff *skb)
2649{
2650 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002651 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002652 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002653
2654 BT_DBG("%s", hdev->name);
2655
2656 hci_dev_lock(hdev);
2657
Johan Hedberg7a828902011-04-28 11:28:53 -07002658 if (!test_bit(HCI_MGMT, &hdev->flags))
2659 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002660
Johan Hedberg7a828902011-04-28 11:28:53 -07002661 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2662 if (!conn)
2663 goto unlock;
2664
2665 loc_mitm = (conn->auth_type & 0x01);
2666 rem_mitm = (conn->remote_auth & 0x01);
2667
2668 /* If we require MITM but the remote device can't provide that
2669 * (it has NoInputNoOutput) then reject the confirmation
2670 * request. The only exception is when we're dedicated bonding
2671 * initiators (connect_cfm_cb set) since then we always have the MITM
2672 * bit set. */
2673 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2674 BT_DBG("Rejecting request: remote device can't provide MITM");
2675 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2676 sizeof(ev->bdaddr), &ev->bdaddr);
2677 goto unlock;
2678 }
2679
2680 /* If no side requires MITM protection; auto-accept */
2681 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2682 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002683
2684 /* If we're not the initiators request authorization to
2685 * proceed from user space (mgmt_user_confirm with
2686 * confirm_hint set to 1). */
2687 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2688 BT_DBG("Confirming auto-accept as acceptor");
2689 confirm_hint = 1;
2690 goto confirm;
2691 }
2692
Johan Hedberg9f616562011-04-28 11:28:54 -07002693 BT_DBG("Auto-accept of user confirmation with %ums delay",
2694 hdev->auto_accept_delay);
2695
2696 if (hdev->auto_accept_delay > 0) {
2697 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2698 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2699 goto unlock;
2700 }
2701
Johan Hedberg7a828902011-04-28 11:28:53 -07002702 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2703 sizeof(ev->bdaddr), &ev->bdaddr);
2704 goto unlock;
2705 }
2706
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002707confirm:
2708 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2709 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002710
2711unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002712 hci_dev_unlock(hdev);
2713}
2714
Marcel Holtmann04936842008-07-14 20:13:48 +02002715static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2716{
2717 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2718 struct hci_conn *conn;
2719
2720 BT_DBG("%s", hdev->name);
2721
2722 hci_dev_lock(hdev);
2723
2724 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002725 if (!conn)
2726 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002727
Johan Hedberg2a611692011-02-19 12:06:00 -03002728 /* To avoid duplicate auth_failed events to user space we check
2729 * the HCI_CONN_AUTH_PEND flag which will be set if we
2730 * initiated the authentication. A traditional auth_complete
2731 * event gets always produced as initiator and is also mapped to
2732 * the mgmt_auth_failed event */
2733 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2734 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2735
2736 hci_conn_put(conn);
2737
2738unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002739 hci_dev_unlock(hdev);
2740}
2741
Marcel Holtmann41a96212008-07-14 20:13:48 +02002742static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2743{
2744 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2745 struct inquiry_entry *ie;
2746
2747 BT_DBG("%s", hdev->name);
2748
2749 hci_dev_lock(hdev);
2750
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002751 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2752 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002753 ie->data.ssp_mode = (ev->features[0] & 0x01);
2754
2755 hci_dev_unlock(hdev);
2756}
2757
Szymon Janc2763eda2011-03-22 13:12:22 +01002758static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2759 struct sk_buff *skb)
2760{
2761 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2762 struct oob_data *data;
2763
2764 BT_DBG("%s", hdev->name);
2765
2766 hci_dev_lock(hdev);
2767
Szymon Jance1ba1f12011-04-06 13:01:59 +02002768 if (!test_bit(HCI_MGMT, &hdev->flags))
2769 goto unlock;
2770
Szymon Janc2763eda2011-03-22 13:12:22 +01002771 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2772 if (data) {
2773 struct hci_cp_remote_oob_data_reply cp;
2774
2775 bacpy(&cp.bdaddr, &ev->bdaddr);
2776 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2777 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2778
2779 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2780 &cp);
2781 } else {
2782 struct hci_cp_remote_oob_data_neg_reply cp;
2783
2784 bacpy(&cp.bdaddr, &ev->bdaddr);
2785 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2786 &cp);
2787 }
2788
Szymon Jance1ba1f12011-04-06 13:01:59 +02002789unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002790 hci_dev_unlock(hdev);
2791}
2792
Ville Tervofcd89c02011-02-10 22:38:47 -03002793static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2794{
2795 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2796 struct hci_conn *conn;
2797
2798 BT_DBG("%s status %d", hdev->name, ev->status);
2799
2800 hci_dev_lock(hdev);
2801
2802 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002803 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08002804 conn = hci_conn_add(hdev, LE_LINK, 0, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002805 if (!conn) {
2806 BT_ERR("No memory for new connection");
2807 hci_dev_unlock(hdev);
2808 return;
2809 }
Andre Guedes149c0972011-05-31 14:20:54 -03002810
2811 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002812 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002813
2814 if (ev->status) {
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002815 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002816 hci_proto_connect_cfm(conn, ev->status);
2817 conn->state = BT_CLOSED;
2818 hci_conn_del(conn);
2819 goto unlock;
2820 }
2821
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002822 mgmt_connected(hdev->id, &ev->bdaddr);
2823
Vinicius Costa Gomes403d2c82011-06-09 18:50:50 -03002824 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002825 conn->handle = __le16_to_cpu(ev->handle);
2826 conn->state = BT_CONNECTED;
2827
2828 hci_conn_hold_device(conn);
2829 hci_conn_add_sysfs(conn);
2830
2831 hci_proto_connect_cfm(conn, ev->status);
2832
2833unlock:
2834 hci_dev_unlock(hdev);
2835}
2836
Andre Guedes5df108f2011-05-26 16:23:51 -03002837static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2838 struct sk_buff *skb)
2839{
2840 struct hci_ev_le_advertising_info *ev;
2841 u8 num_reports;
2842
2843 num_reports = skb->data[0];
2844 ev = (void *) &skb->data[1];
2845
2846 hci_dev_lock(hdev);
2847
2848 hci_add_adv_entry(hdev, ev);
2849
2850 while (--num_reports) {
2851 ev = (void *) (ev->data + ev->length + 1);
2852 hci_add_adv_entry(hdev, ev);
2853 }
2854
2855 hci_dev_unlock(hdev);
2856}
2857
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002858static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2859 struct sk_buff *skb)
2860{
2861 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2862 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03002863 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002864 struct hci_conn *conn;
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03002865 struct link_key *ltk;
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002866
2867 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2868
2869 hci_dev_lock(hdev);
2870
2871 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03002872 if (conn == NULL)
2873 goto not_found;
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002874
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03002875 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
2876 if (ltk == NULL)
2877 goto not_found;
2878
2879 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002880 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002881
2882 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2883
2884 hci_dev_unlock(hdev);
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03002885
2886 return;
2887
2888not_found:
2889 neg.handle = ev->handle;
2890 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
2891 hci_dev_unlock(hdev);
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002892}
2893
Ville Tervofcd89c02011-02-10 22:38:47 -03002894static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2895{
2896 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2897
2898 skb_pull(skb, sizeof(*le_ev));
2899
2900 switch (le_ev->subevent) {
2901 case HCI_EV_LE_CONN_COMPLETE:
2902 hci_le_conn_complete_evt(hdev, skb);
2903 break;
2904
Andre Guedes5df108f2011-05-26 16:23:51 -03002905 case HCI_EV_LE_ADVERTISING_REPORT:
2906 hci_le_adv_report_evt(hdev, skb);
2907 break;
2908
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002909 case HCI_EV_LE_LTK_REQ:
2910 hci_le_ltk_request_evt(hdev, skb);
2911 break;
2912
Ville Tervofcd89c02011-02-10 22:38:47 -03002913 default:
2914 break;
2915 }
2916}
2917
Linus Torvalds1da177e2005-04-16 15:20:36 -07002918void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2919{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002920 struct hci_event_hdr *hdr = (void *) skb->data;
2921 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002922
2923 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2924
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002925 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002926 case HCI_EV_INQUIRY_COMPLETE:
2927 hci_inquiry_complete_evt(hdev, skb);
2928 break;
2929
2930 case HCI_EV_INQUIRY_RESULT:
2931 hci_inquiry_result_evt(hdev, skb);
2932 break;
2933
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002934 case HCI_EV_CONN_COMPLETE:
2935 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002936 break;
2937
Linus Torvalds1da177e2005-04-16 15:20:36 -07002938 case HCI_EV_CONN_REQUEST:
2939 hci_conn_request_evt(hdev, skb);
2940 break;
2941
Linus Torvalds1da177e2005-04-16 15:20:36 -07002942 case HCI_EV_DISCONN_COMPLETE:
2943 hci_disconn_complete_evt(hdev, skb);
2944 break;
2945
Linus Torvalds1da177e2005-04-16 15:20:36 -07002946 case HCI_EV_AUTH_COMPLETE:
2947 hci_auth_complete_evt(hdev, skb);
2948 break;
2949
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002950 case HCI_EV_REMOTE_NAME:
2951 hci_remote_name_evt(hdev, skb);
2952 break;
2953
Linus Torvalds1da177e2005-04-16 15:20:36 -07002954 case HCI_EV_ENCRYPT_CHANGE:
2955 hci_encrypt_change_evt(hdev, skb);
2956 break;
2957
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002958 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2959 hci_change_link_key_complete_evt(hdev, skb);
2960 break;
2961
2962 case HCI_EV_REMOTE_FEATURES:
2963 hci_remote_features_evt(hdev, skb);
2964 break;
2965
2966 case HCI_EV_REMOTE_VERSION:
2967 hci_remote_version_evt(hdev, skb);
2968 break;
2969
2970 case HCI_EV_QOS_SETUP_COMPLETE:
2971 hci_qos_setup_complete_evt(hdev, skb);
2972 break;
2973
2974 case HCI_EV_CMD_COMPLETE:
2975 hci_cmd_complete_evt(hdev, skb);
2976 break;
2977
2978 case HCI_EV_CMD_STATUS:
2979 hci_cmd_status_evt(hdev, skb);
2980 break;
2981
2982 case HCI_EV_ROLE_CHANGE:
2983 hci_role_change_evt(hdev, skb);
2984 break;
2985
2986 case HCI_EV_NUM_COMP_PKTS:
2987 hci_num_comp_pkts_evt(hdev, skb);
2988 break;
2989
2990 case HCI_EV_MODE_CHANGE:
2991 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002992 break;
2993
2994 case HCI_EV_PIN_CODE_REQ:
2995 hci_pin_code_request_evt(hdev, skb);
2996 break;
2997
2998 case HCI_EV_LINK_KEY_REQ:
2999 hci_link_key_request_evt(hdev, skb);
3000 break;
3001
3002 case HCI_EV_LINK_KEY_NOTIFY:
3003 hci_link_key_notify_evt(hdev, skb);
3004 break;
3005
3006 case HCI_EV_CLOCK_OFFSET:
3007 hci_clock_offset_evt(hdev, skb);
3008 break;
3009
Marcel Holtmanna8746412008-07-14 20:13:46 +02003010 case HCI_EV_PKT_TYPE_CHANGE:
3011 hci_pkt_type_change_evt(hdev, skb);
3012 break;
3013
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003014 case HCI_EV_PSCAN_REP_MODE:
3015 hci_pscan_rep_mode_evt(hdev, skb);
3016 break;
3017
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003018 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3019 hci_inquiry_result_with_rssi_evt(hdev, skb);
3020 break;
3021
3022 case HCI_EV_REMOTE_EXT_FEATURES:
3023 hci_remote_ext_features_evt(hdev, skb);
3024 break;
3025
3026 case HCI_EV_SYNC_CONN_COMPLETE:
3027 hci_sync_conn_complete_evt(hdev, skb);
3028 break;
3029
3030 case HCI_EV_SYNC_CONN_CHANGED:
3031 hci_sync_conn_changed_evt(hdev, skb);
3032 break;
3033
Marcel Holtmann04837f62006-07-03 10:02:33 +02003034 case HCI_EV_SNIFF_SUBRATE:
3035 hci_sniff_subrate_evt(hdev, skb);
3036 break;
3037
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003038 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3039 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003040 break;
3041
Marcel Holtmann04936842008-07-14 20:13:48 +02003042 case HCI_EV_IO_CAPA_REQUEST:
3043 hci_io_capa_request_evt(hdev, skb);
3044 break;
3045
Johan Hedberg03b555e2011-01-04 15:40:05 +02003046 case HCI_EV_IO_CAPA_REPLY:
3047 hci_io_capa_reply_evt(hdev, skb);
3048 break;
3049
Johan Hedberga5c29682011-02-19 12:05:57 -03003050 case HCI_EV_USER_CONFIRM_REQUEST:
3051 hci_user_confirm_request_evt(hdev, skb);
3052 break;
3053
Marcel Holtmann04936842008-07-14 20:13:48 +02003054 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3055 hci_simple_pair_complete_evt(hdev, skb);
3056 break;
3057
Marcel Holtmann41a96212008-07-14 20:13:48 +02003058 case HCI_EV_REMOTE_HOST_FEATURES:
3059 hci_remote_host_features_evt(hdev, skb);
3060 break;
3061
Ville Tervofcd89c02011-02-10 22:38:47 -03003062 case HCI_EV_LE_META:
3063 hci_le_meta_evt(hdev, skb);
3064 break;
3065
Szymon Janc2763eda2011-03-22 13:12:22 +01003066 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3067 hci_remote_oob_data_request_evt(hdev, skb);
3068 break;
3069
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003070 default:
3071 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003072 break;
3073 }
3074
3075 kfree_skb(skb);
3076 hdev->stat.evt_rx++;
3077}
3078
3079/* Generate internal stack event */
3080void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3081{
3082 struct hci_event_hdr *hdr;
3083 struct hci_ev_stack_internal *ev;
3084 struct sk_buff *skb;
3085
3086 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3087 if (!skb)
3088 return;
3089
3090 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3091 hdr->evt = HCI_EV_STACK_INTERNAL;
3092 hdr->plen = sizeof(*ev) + dlen;
3093
3094 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3095 ev->type = type;
3096 memcpy(ev->data, data, dlen);
3097
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003098 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003099 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003100
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003101 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003102 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003103 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003104 kfree_skb(skb);
3105}
Andre Guedes5521abe2011-06-30 19:20:54 -03003106
3107module_param(enable_le, bool, 0444);
3108MODULE_PARM_DESC(enable_le, "Enable LE support");