blob: 8c81a75381fbee505fa6be69bd89196a5beed7af [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI event handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28
29#include <linux/types.h>
30#include <linux/errno.h>
31#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#include <linux/slab.h>
33#include <linux/poll.h>
34#include <linux/fcntl.h>
35#include <linux/init.h>
36#include <linux/skbuff.h>
37#include <linux/interrupt.h>
38#include <linux/notifier.h>
39#include <net/sock.h>
40
41#include <asm/system.h>
Andrei Emeltchenko70f230202010-12-01 16:58:25 +020042#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070043#include <asm/unaligned.h>
44
45#include <net/bluetooth/bluetooth.h>
46#include <net/bluetooth/hci_core.h>
47
Andre Guedese6100a22011-06-30 19:20:54 -030048static int enable_le;
49
Linus Torvalds1da177e2005-04-16 15:20:36 -070050/* Handle HCI Event packets */
51
Marcel Holtmanna9de9242007-10-20 13:33:56 +020052static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070053{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020054 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
Marcel Holtmanna9de9242007-10-20 13:33:56 +020056 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070057
Marcel Holtmanna9de9242007-10-20 13:33:56 +020058 if (status)
59 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070060
Oliver Neukum2d20a262011-08-30 15:52:18 +020061 if (test_and_clear_bit(HCI_INQUIRY, &hdev->flags) &&
62 test_bit(HCI_MGMT, &hdev->flags))
Johan Hedberg314b2382011-04-27 10:29:57 -040063 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
Oliver Neukum2d20a262011-08-30 15:52:18 +020079 if (test_and_clear_bit(HCI_INQUIRY, &hdev->flags) &&
80 test_bit(HCI_MGMT, &hdev->flags))
Johan Hedberg314b2382011-04-27 10:29:57 -040081 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{
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200277 __u8 param, status = *((__u8 *) skb->data);
278 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200279 void *sent;
280
281 BT_DBG("%s status 0x%x", hdev->name, status);
282
283 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
284 if (!sent)
285 return;
286
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200287 if (status != 0)
288 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200289
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200290 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200291
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200292 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
293 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200294
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200295 if (param & SCAN_INQUIRY) {
296 set_bit(HCI_ISCAN, &hdev->flags);
297 if (!old_iscan)
298 mgmt_discoverable(hdev->id, 1);
299 } else if (old_iscan)
300 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200301
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200302 if (param & SCAN_PAGE) {
303 set_bit(HCI_PSCAN, &hdev->flags);
304 if (!old_pscan)
305 mgmt_connectable(hdev->id, 1);
306 } else if (old_pscan)
307 mgmt_connectable(hdev->id, 0);
308
309done:
Johan Hedberg23bb5762010-12-21 23:01:27 +0200310 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200311}
312
313static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
314{
315 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
316
317 BT_DBG("%s status 0x%x", hdev->name, rp->status);
318
319 if (rp->status)
320 return;
321
322 memcpy(hdev->dev_class, rp->dev_class, 3);
323
324 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
325 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
326}
327
328static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
329{
330 __u8 status = *((__u8 *) skb->data);
331 void *sent;
332
333 BT_DBG("%s status 0x%x", hdev->name, status);
334
Marcel Holtmannf383f272008-07-14 20:13:47 +0200335 if (status)
336 return;
337
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200338 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
339 if (!sent)
340 return;
341
Marcel Holtmannf383f272008-07-14 20:13:47 +0200342 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200343}
344
345static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
346{
347 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200349
350 BT_DBG("%s status 0x%x", hdev->name, rp->status);
351
352 if (rp->status)
353 return;
354
355 setting = __le16_to_cpu(rp->voice_setting);
356
Marcel Holtmannf383f272008-07-14 20:13:47 +0200357 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200358 return;
359
360 hdev->voice_setting = setting;
361
362 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
363
364 if (hdev->notify) {
365 tasklet_disable(&hdev->tx_task);
366 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
367 tasklet_enable(&hdev->tx_task);
368 }
369}
370
371static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
372{
373 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200374 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375 void *sent;
376
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200377 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378
Marcel Holtmannf383f272008-07-14 20:13:47 +0200379 if (status)
380 return;
381
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200382 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
383 if (!sent)
384 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
Marcel Holtmannf383f272008-07-14 20:13:47 +0200386 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387
Marcel Holtmannf383f272008-07-14 20:13:47 +0200388 if (hdev->voice_setting == setting)
389 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390
Marcel Holtmannf383f272008-07-14 20:13:47 +0200391 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392
Marcel Holtmannf383f272008-07-14 20:13:47 +0200393 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
394
395 if (hdev->notify) {
396 tasklet_disable(&hdev->tx_task);
397 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
398 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 }
400}
401
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200402static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200404 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200406 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
Johan Hedberg23bb5762010-12-21 23:01:27 +0200408 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409}
410
Marcel Holtmann333140b2008-07-14 20:13:48 +0200411static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
412{
413 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
414
415 BT_DBG("%s status 0x%x", hdev->name, rp->status);
416
417 if (rp->status)
418 return;
419
420 hdev->ssp_mode = rp->mode;
421}
422
423static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
424{
425 __u8 status = *((__u8 *) skb->data);
426 void *sent;
427
428 BT_DBG("%s status 0x%x", hdev->name, status);
429
430 if (status)
431 return;
432
433 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
434 if (!sent)
435 return;
436
437 hdev->ssp_mode = *((__u8 *) sent);
438}
439
Johan Hedbergd5859e22011-01-25 01:19:58 +0200440static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
441{
442 if (hdev->features[6] & LMP_EXT_INQ)
443 return 2;
444
445 if (hdev->features[3] & LMP_RSSI_INQ)
446 return 1;
447
448 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
449 hdev->lmp_subver == 0x0757)
450 return 1;
451
452 if (hdev->manufacturer == 15) {
453 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
454 return 1;
455 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
456 return 1;
457 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
458 return 1;
459 }
460
461 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
462 hdev->lmp_subver == 0x1805)
463 return 1;
464
465 return 0;
466}
467
468static void hci_setup_inquiry_mode(struct hci_dev *hdev)
469{
470 u8 mode;
471
472 mode = hci_get_inquiry_mode(hdev);
473
474 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
475}
476
477static void hci_setup_event_mask(struct hci_dev *hdev)
478{
479 /* The second byte is 0xff instead of 0x9f (two reserved bits
480 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
481 * command otherwise */
482 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
483
Ville Tervo6de6c182011-05-27 11:16:21 +0300484 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
485 * any event mask for pre 1.2 devices */
486 if (hdev->lmp_ver <= 1)
487 return;
488
489 events[4] |= 0x01; /* Flow Specification Complete */
490 events[4] |= 0x02; /* Inquiry Result with RSSI */
491 events[4] |= 0x04; /* Read Remote Extended Features Complete */
492 events[5] |= 0x08; /* Synchronous Connection Complete */
493 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200494
495 if (hdev->features[3] & LMP_RSSI_INQ)
496 events[4] |= 0x04; /* Inquiry Result with RSSI */
497
498 if (hdev->features[5] & LMP_SNIFF_SUBR)
499 events[5] |= 0x20; /* Sniff Subrating */
500
501 if (hdev->features[5] & LMP_PAUSE_ENC)
502 events[5] |= 0x80; /* Encryption Key Refresh Complete */
503
504 if (hdev->features[6] & LMP_EXT_INQ)
505 events[5] |= 0x40; /* Extended Inquiry Result */
506
507 if (hdev->features[6] & LMP_NO_FLUSH)
508 events[7] |= 0x01; /* Enhanced Flush Complete */
509
510 if (hdev->features[7] & LMP_LSTO)
511 events[6] |= 0x80; /* Link Supervision Timeout Changed */
512
513 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
514 events[6] |= 0x01; /* IO Capability Request */
515 events[6] |= 0x02; /* IO Capability Response */
516 events[6] |= 0x04; /* User Confirmation Request */
517 events[6] |= 0x08; /* User Passkey Request */
518 events[6] |= 0x10; /* Remote OOB Data Request */
519 events[6] |= 0x20; /* Simple Pairing Complete */
520 events[7] |= 0x04; /* User Passkey Notification */
521 events[7] |= 0x08; /* Keypress Notification */
522 events[7] |= 0x10; /* Remote Host Supported
523 * Features Notification */
524 }
525
526 if (hdev->features[4] & LMP_LE)
527 events[7] |= 0x20; /* LE Meta-Event */
528
529 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
530}
531
Andre Guedese6100a22011-06-30 19:20:54 -0300532static void hci_set_le_support(struct hci_dev *hdev)
533{
534 struct hci_cp_write_le_host_supported cp;
535
536 memset(&cp, 0, sizeof(cp));
537
538 if (enable_le) {
539 cp.le = 1;
540 cp.simul = !!(hdev->features[6] & LMP_SIMUL_LE_BR);
541 }
542
543 hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(cp), &cp);
544}
545
Johan Hedbergd5859e22011-01-25 01:19:58 +0200546static void hci_setup(struct hci_dev *hdev)
547{
548 hci_setup_event_mask(hdev);
549
550 if (hdev->lmp_ver > 1)
551 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
552
553 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
554 u8 mode = 0x01;
555 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
556 }
557
558 if (hdev->features[3] & LMP_RSSI_INQ)
559 hci_setup_inquiry_mode(hdev);
560
561 if (hdev->features[7] & LMP_INQ_TX_PWR)
562 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
Andre Guedes971e3a42011-06-30 19:20:52 -0300563
564 if (hdev->features[7] & LMP_EXTFEATURES) {
565 struct hci_cp_read_local_ext_features cp;
566
567 cp.page = 0x01;
568 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES,
569 sizeof(cp), &cp);
570 }
Andre Guedese6100a22011-06-30 19:20:54 -0300571
572 if (hdev->features[4] & LMP_LE)
573 hci_set_le_support(hdev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200574}
575
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200576static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
577{
578 struct hci_rp_read_local_version *rp = (void *) skb->data;
579
580 BT_DBG("%s status 0x%x", hdev->name, rp->status);
581
582 if (rp->status)
583 return;
584
585 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200586 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200587 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200588 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200589 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200590
591 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
592 hdev->manufacturer,
593 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200594
595 if (test_bit(HCI_INIT, &hdev->flags))
596 hci_setup(hdev);
597}
598
599static void hci_setup_link_policy(struct hci_dev *hdev)
600{
601 u16 link_policy = 0;
602
603 if (hdev->features[0] & LMP_RSWITCH)
604 link_policy |= HCI_LP_RSWITCH;
605 if (hdev->features[0] & LMP_HOLD)
606 link_policy |= HCI_LP_HOLD;
607 if (hdev->features[0] & LMP_SNIFF)
608 link_policy |= HCI_LP_SNIFF;
609 if (hdev->features[1] & LMP_PARK)
610 link_policy |= HCI_LP_PARK;
611
612 link_policy = cpu_to_le16(link_policy);
613 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
614 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200615}
616
617static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
618{
619 struct hci_rp_read_local_commands *rp = (void *) skb->data;
620
621 BT_DBG("%s status 0x%x", hdev->name, rp->status);
622
623 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200624 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200625
626 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200627
628 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
629 hci_setup_link_policy(hdev);
630
631done:
632 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200633}
634
635static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
636{
637 struct hci_rp_read_local_features *rp = (void *) skb->data;
638
639 BT_DBG("%s status 0x%x", hdev->name, rp->status);
640
641 if (rp->status)
642 return;
643
644 memcpy(hdev->features, rp->features, 8);
645
646 /* Adjust default settings according to features
647 * supported by device. */
648
649 if (hdev->features[0] & LMP_3SLOT)
650 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
651
652 if (hdev->features[0] & LMP_5SLOT)
653 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
654
655 if (hdev->features[1] & LMP_HV2) {
656 hdev->pkt_type |= (HCI_HV2);
657 hdev->esco_type |= (ESCO_HV2);
658 }
659
660 if (hdev->features[1] & LMP_HV3) {
661 hdev->pkt_type |= (HCI_HV3);
662 hdev->esco_type |= (ESCO_HV3);
663 }
664
665 if (hdev->features[3] & LMP_ESCO)
666 hdev->esco_type |= (ESCO_EV3);
667
668 if (hdev->features[4] & LMP_EV4)
669 hdev->esco_type |= (ESCO_EV4);
670
671 if (hdev->features[4] & LMP_EV5)
672 hdev->esco_type |= (ESCO_EV5);
673
Marcel Holtmannefc76882009-02-06 09:13:37 +0100674 if (hdev->features[5] & LMP_EDR_ESCO_2M)
675 hdev->esco_type |= (ESCO_2EV3);
676
677 if (hdev->features[5] & LMP_EDR_ESCO_3M)
678 hdev->esco_type |= (ESCO_3EV3);
679
680 if (hdev->features[5] & LMP_EDR_3S_ESCO)
681 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
682
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200683 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
684 hdev->features[0], hdev->features[1],
685 hdev->features[2], hdev->features[3],
686 hdev->features[4], hdev->features[5],
687 hdev->features[6], hdev->features[7]);
688}
689
Andre Guedes971e3a42011-06-30 19:20:52 -0300690static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
691 struct sk_buff *skb)
692{
693 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
694
695 BT_DBG("%s status 0x%x", hdev->name, rp->status);
696
697 if (rp->status)
698 return;
699
700 memcpy(hdev->extfeatures, rp->features, 8);
701
702 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
703}
704
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200705static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
706{
707 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
708
709 BT_DBG("%s status 0x%x", hdev->name, rp->status);
710
711 if (rp->status)
712 return;
713
714 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
715 hdev->sco_mtu = rp->sco_mtu;
716 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
717 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
718
719 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
720 hdev->sco_mtu = 64;
721 hdev->sco_pkts = 8;
722 }
723
724 hdev->acl_cnt = hdev->acl_pkts;
725 hdev->sco_cnt = hdev->sco_pkts;
726
727 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
728 hdev->acl_mtu, hdev->acl_pkts,
729 hdev->sco_mtu, hdev->sco_pkts);
730}
731
732static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
733{
734 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
735
736 BT_DBG("%s status 0x%x", hdev->name, rp->status);
737
738 if (!rp->status)
739 bacpy(&hdev->bdaddr, &rp->bdaddr);
740
Johan Hedberg23bb5762010-12-21 23:01:27 +0200741 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
742}
743
744static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
745{
746 __u8 status = *((__u8 *) skb->data);
747
748 BT_DBG("%s status 0x%x", hdev->name, status);
749
750 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200751}
752
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300753static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
754 struct sk_buff *skb)
755{
756 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
757
758 BT_DBG("%s status 0x%x", hdev->name, rp->status);
759
760 if (rp->status)
761 return;
762
763 hdev->amp_status = rp->amp_status;
764 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
765 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
766 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
767 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
768 hdev->amp_type = rp->amp_type;
769 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
770 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
771 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
772 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
773
774 hci_req_complete(hdev, HCI_OP_READ_LOCAL_AMP_INFO, rp->status);
775}
776
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200777static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
778 struct sk_buff *skb)
779{
780 __u8 status = *((__u8 *) skb->data);
781
782 BT_DBG("%s status 0x%x", hdev->name, status);
783
784 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
785}
786
Johan Hedbergd5859e22011-01-25 01:19:58 +0200787static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
788{
789 __u8 status = *((__u8 *) skb->data);
790
791 BT_DBG("%s status 0x%x", hdev->name, status);
792
793 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
794}
795
796static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
797 struct sk_buff *skb)
798{
799 __u8 status = *((__u8 *) skb->data);
800
801 BT_DBG("%s status 0x%x", hdev->name, status);
802
803 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
804}
805
806static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
807 struct sk_buff *skb)
808{
809 __u8 status = *((__u8 *) skb->data);
810
811 BT_DBG("%s status 0x%x", hdev->name, status);
812
813 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
814}
815
816static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
817{
818 __u8 status = *((__u8 *) skb->data);
819
820 BT_DBG("%s status 0x%x", hdev->name, status);
821
822 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
823}
824
Johan Hedberg980e1a52011-01-22 06:10:07 +0200825static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
826{
827 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
828 struct hci_cp_pin_code_reply *cp;
829 struct hci_conn *conn;
830
831 BT_DBG("%s status 0x%x", hdev->name, rp->status);
832
833 if (test_bit(HCI_MGMT, &hdev->flags))
834 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
835
836 if (rp->status != 0)
837 return;
838
839 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
840 if (!cp)
841 return;
842
843 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
844 if (conn)
845 conn->pin_length = cp->pin_len;
846}
847
848static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
849{
850 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
851
852 BT_DBG("%s status 0x%x", hdev->name, rp->status);
853
854 if (test_bit(HCI_MGMT, &hdev->flags))
855 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
856 rp->status);
857}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300858static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
859 struct sk_buff *skb)
860{
861 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
862
863 BT_DBG("%s status 0x%x", hdev->name, rp->status);
864
865 if (rp->status)
866 return;
867
868 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
869 hdev->le_pkts = rp->le_max_pkt;
870
871 hdev->le_cnt = hdev->le_pkts;
872
873 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
874
875 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
876}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200877
Johan Hedberga5c29682011-02-19 12:05:57 -0300878static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
879{
880 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
881
882 BT_DBG("%s status 0x%x", hdev->name, rp->status);
883
884 if (test_bit(HCI_MGMT, &hdev->flags))
885 mgmt_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
886 rp->status);
887}
888
889static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
890 struct sk_buff *skb)
891{
892 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
893
894 BT_DBG("%s status 0x%x", hdev->name, rp->status);
895
896 if (test_bit(HCI_MGMT, &hdev->flags))
897 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
898 rp->status);
899}
900
Szymon Jancc35938b2011-03-22 13:12:21 +0100901static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
902 struct sk_buff *skb)
903{
904 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
905
906 BT_DBG("%s status 0x%x", hdev->name, rp->status);
907
908 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
909 rp->randomizer, rp->status);
910}
911
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300912static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
913 struct sk_buff *skb)
914{
915 struct hci_cp_le_set_scan_enable *cp;
916 __u8 status = *((__u8 *) skb->data);
917
918 BT_DBG("%s status 0x%x", hdev->name, status);
919
920 if (status)
921 return;
922
923 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
924 if (!cp)
925 return;
926
Andre Guedes35815082011-05-26 16:23:53 -0300927 if (cp->enable == 0x01) {
928 del_timer(&hdev->adv_timer);
Andre Guedesa8f13c82011-09-09 18:56:24 -0300929
930 hci_dev_lock(hdev);
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300931 hci_adv_entries_clear(hdev);
Andre Guedesa8f13c82011-09-09 18:56:24 -0300932 hci_dev_unlock(hdev);
Andre Guedes35815082011-05-26 16:23:53 -0300933 } else if (cp->enable == 0x00) {
934 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
935 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300936}
937
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300938static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
939{
940 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
941
942 BT_DBG("%s status 0x%x", hdev->name, rp->status);
943
944 if (rp->status)
945 return;
946
947 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
948}
949
950static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
951{
952 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
953
954 BT_DBG("%s status 0x%x", hdev->name, rp->status);
955
956 if (rp->status)
957 return;
958
959 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
960}
961
Andre Guedesf9b49302011-06-30 19:20:53 -0300962static inline void hci_cc_write_le_host_supported(struct hci_dev *hdev,
963 struct sk_buff *skb)
964{
965 struct hci_cp_read_local_ext_features cp;
966 __u8 status = *((__u8 *) skb->data);
967
968 BT_DBG("%s status 0x%x", hdev->name, status);
969
970 if (status)
971 return;
972
973 cp.page = 0x01;
974 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp), &cp);
975}
976
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200977static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
978{
979 BT_DBG("%s status 0x%x", hdev->name, status);
980
981 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200982 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200983 hci_conn_check_pending(hdev);
Johan Hedberg164a6e72011-11-01 17:06:44 +0200984 if (test_bit(HCI_MGMT, &hdev->flags))
985 mgmt_inquiry_failed(hdev->id, status);
Johan Hedberg314b2382011-04-27 10:29:57 -0400986 return;
987 }
988
Oliver Neukum2d20a262011-08-30 15:52:18 +0200989 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags) &&
990 test_bit(HCI_MGMT, &hdev->flags))
Johan Hedberg314b2382011-04-27 10:29:57 -0400991 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200992}
993
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
995{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200996 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700997 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200999 BT_DBG("%s status 0x%x", hdev->name, status);
1000
1001 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002 if (!cp)
1003 return;
1004
1005 hci_dev_lock(hdev);
1006
1007 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1008
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001009 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010
1011 if (status) {
1012 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001013 if (status != 0x0c || conn->attempt > 2) {
1014 conn->state = BT_CLOSED;
1015 hci_proto_connect_cfm(conn, status);
1016 hci_conn_del(conn);
1017 } else
1018 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001019 }
1020 } else {
1021 if (!conn) {
1022 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1023 if (conn) {
1024 conn->out = 1;
1025 conn->link_mode |= HCI_LM_MASTER;
1026 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001027 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001028 }
1029 }
1030
1031 hci_dev_unlock(hdev);
1032}
1033
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001034static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001035{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001036 struct hci_cp_add_sco *cp;
1037 struct hci_conn *acl, *sco;
1038 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001040 BT_DBG("%s status 0x%x", hdev->name, status);
1041
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001042 if (!status)
1043 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001045 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1046 if (!cp)
1047 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001048
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001049 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001051 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001052
1053 hci_dev_lock(hdev);
1054
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001055 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001056 if (acl) {
1057 sco = acl->link;
1058 if (sco) {
1059 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001060
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001061 hci_proto_connect_cfm(sco, status);
1062 hci_conn_del(sco);
1063 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001064 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001065
1066 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001067}
1068
Marcel Holtmannf8558552008-07-14 20:13:49 +02001069static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1070{
1071 struct hci_cp_auth_requested *cp;
1072 struct hci_conn *conn;
1073
1074 BT_DBG("%s status 0x%x", hdev->name, status);
1075
1076 if (!status)
1077 return;
1078
1079 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1080 if (!cp)
1081 return;
1082
1083 hci_dev_lock(hdev);
1084
1085 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1086 if (conn) {
1087 if (conn->state == BT_CONFIG) {
1088 hci_proto_connect_cfm(conn, status);
1089 hci_conn_put(conn);
1090 }
1091 }
1092
1093 hci_dev_unlock(hdev);
1094}
1095
1096static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1097{
1098 struct hci_cp_set_conn_encrypt *cp;
1099 struct hci_conn *conn;
1100
1101 BT_DBG("%s status 0x%x", hdev->name, status);
1102
1103 if (!status)
1104 return;
1105
1106 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1107 if (!cp)
1108 return;
1109
1110 hci_dev_lock(hdev);
1111
1112 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1113 if (conn) {
1114 if (conn->state == BT_CONFIG) {
1115 hci_proto_connect_cfm(conn, status);
1116 hci_conn_put(conn);
1117 }
1118 }
1119
1120 hci_dev_unlock(hdev);
1121}
1122
Johan Hedberg127178d2010-11-18 22:22:29 +02001123static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001124 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001125{
Johan Hedberg392599b2010-11-18 22:22:28 +02001126 if (conn->state != BT_CONFIG || !conn->out)
1127 return 0;
1128
Johan Hedberg765c2a92011-01-19 12:06:52 +05301129 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001130 return 0;
1131
1132 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001133 * devices with sec_level HIGH or if MITM protection is requested */
Johan Hedberg392599b2010-11-18 22:22:28 +02001134 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001135 conn->pending_sec_level != BT_SECURITY_HIGH &&
1136 !(conn->auth_type & 0x01))
Johan Hedberg392599b2010-11-18 22:22:28 +02001137 return 0;
1138
Johan Hedberg392599b2010-11-18 22:22:28 +02001139 return 1;
1140}
1141
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001142static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1143{
Johan Hedberg127178d2010-11-18 22:22:29 +02001144 struct hci_cp_remote_name_req *cp;
1145 struct hci_conn *conn;
1146
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001147 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001148
1149 /* If successful wait for the name req complete event before
1150 * checking for the need to do authentication */
1151 if (!status)
1152 return;
1153
1154 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1155 if (!cp)
1156 return;
1157
1158 hci_dev_lock(hdev);
1159
1160 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001161 if (!conn)
1162 goto unlock;
1163
1164 if (!hci_outgoing_auth_needed(hdev, conn))
1165 goto unlock;
1166
1167 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001168 struct hci_cp_auth_requested cp;
1169 cp.handle = __cpu_to_le16(conn->handle);
1170 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1171 }
1172
Johan Hedberg79c6c702011-04-28 11:28:55 -07001173unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001174 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001175}
1176
Marcel Holtmann769be972008-07-14 20:13:49 +02001177static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1178{
1179 struct hci_cp_read_remote_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_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
1204static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1205{
1206 struct hci_cp_read_remote_ext_features *cp;
1207 struct hci_conn *conn;
1208
1209 BT_DBG("%s status 0x%x", hdev->name, status);
1210
1211 if (!status)
1212 return;
1213
1214 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1215 if (!cp)
1216 return;
1217
1218 hci_dev_lock(hdev);
1219
1220 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1221 if (conn) {
1222 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001223 hci_proto_connect_cfm(conn, status);
1224 hci_conn_put(conn);
1225 }
1226 }
1227
1228 hci_dev_unlock(hdev);
1229}
1230
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001231static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1232{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001233 struct hci_cp_setup_sync_conn *cp;
1234 struct hci_conn *acl, *sco;
1235 __u16 handle;
1236
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001237 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001238
1239 if (!status)
1240 return;
1241
1242 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1243 if (!cp)
1244 return;
1245
1246 handle = __le16_to_cpu(cp->handle);
1247
1248 BT_DBG("%s handle %d", hdev->name, handle);
1249
1250 hci_dev_lock(hdev);
1251
1252 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001253 if (acl) {
1254 sco = acl->link;
1255 if (sco) {
1256 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001257
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001258 hci_proto_connect_cfm(sco, status);
1259 hci_conn_del(sco);
1260 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001261 }
1262
1263 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001264}
1265
1266static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1267{
1268 struct hci_cp_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_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
1293static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1294{
1295 struct hci_cp_exit_sniff_mode *cp;
1296 struct hci_conn *conn;
1297
1298 BT_DBG("%s status 0x%x", hdev->name, status);
1299
1300 if (!status)
1301 return;
1302
1303 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1304 if (!cp)
1305 return;
1306
1307 hci_dev_lock(hdev);
1308
1309 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001310 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001311 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1312
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001313 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1314 hci_sco_setup(conn, status);
1315 }
1316
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001317 hci_dev_unlock(hdev);
1318}
1319
Ville Tervofcd89c02011-02-10 22:38:47 -03001320static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1321{
1322 struct hci_cp_le_create_conn *cp;
1323 struct hci_conn *conn;
1324
1325 BT_DBG("%s status 0x%x", hdev->name, status);
1326
1327 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1328 if (!cp)
1329 return;
1330
1331 hci_dev_lock(hdev);
1332
1333 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1334
1335 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1336 conn);
1337
1338 if (status) {
1339 if (conn && conn->state == BT_CONNECT) {
1340 conn->state = BT_CLOSED;
1341 hci_proto_connect_cfm(conn, status);
1342 hci_conn_del(conn);
1343 }
1344 } else {
1345 if (!conn) {
1346 conn = hci_conn_add(hdev, LE_LINK, &cp->peer_addr);
Andre Guedes29b79882011-05-31 14:20:54 -03001347 if (conn) {
1348 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001349 conn->out = 1;
Andre Guedes29b79882011-05-31 14:20:54 -03001350 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001351 BT_ERR("No memory for new connection");
Andre Guedes29b79882011-05-31 14:20:54 -03001352 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001353 }
1354 }
1355
1356 hci_dev_unlock(hdev);
1357}
1358
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001359static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1360{
1361 BT_DBG("%s status 0x%x", hdev->name, status);
1362}
1363
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001364static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1365{
1366 __u8 status = *((__u8 *) skb->data);
1367
1368 BT_DBG("%s status %d", hdev->name, status);
1369
Oliver Neukum2d20a262011-08-30 15:52:18 +02001370 if (test_and_clear_bit(HCI_INQUIRY, &hdev->flags) &&
1371 test_bit(HCI_MGMT, &hdev->flags))
Johan Hedberg314b2382011-04-27 10:29:57 -04001372 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001373
Johan Hedberg23bb5762010-12-21 23:01:27 +02001374 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001375
1376 hci_conn_check_pending(hdev);
1377}
1378
Linus Torvalds1da177e2005-04-16 15:20:36 -07001379static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1380{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001381 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001382 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001383 int num_rsp = *((__u8 *) skb->data);
1384
1385 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1386
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001387 if (!num_rsp)
1388 return;
1389
Linus Torvalds1da177e2005-04-16 15:20:36 -07001390 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001391
Johan Hedberg314b2382011-04-27 10:29:57 -04001392 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
1393
1394 if (test_bit(HCI_MGMT, &hdev->flags))
1395 mgmt_discovering(hdev->id, 1);
1396 }
1397
Johan Hedberge17acd42011-03-30 23:57:16 +03001398 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001399 bacpy(&data.bdaddr, &info->bdaddr);
1400 data.pscan_rep_mode = info->pscan_rep_mode;
1401 data.pscan_period_mode = info->pscan_period_mode;
1402 data.pscan_mode = info->pscan_mode;
1403 memcpy(data.dev_class, info->dev_class, 3);
1404 data.clock_offset = info->clock_offset;
1405 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001406 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001407 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03001408 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class, 0,
1409 NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001410 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001411
Linus Torvalds1da177e2005-04-16 15:20:36 -07001412 hci_dev_unlock(hdev);
1413}
1414
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001415static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001416{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001417 struct hci_ev_conn_complete *ev = (void *) skb->data;
1418 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001419
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001420 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001421
Linus Torvalds1da177e2005-04-16 15:20:36 -07001422 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001423
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001424 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001425 if (!conn) {
1426 if (ev->link_type != SCO_LINK)
1427 goto unlock;
1428
1429 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1430 if (!conn)
1431 goto unlock;
1432
1433 conn->type = SCO_LINK;
1434 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001435
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001436 if (!ev->status) {
1437 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001438
1439 if (conn->type == ACL_LINK) {
1440 conn->state = BT_CONFIG;
1441 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001442 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Vinicius Costa Gomescfafccf2011-08-19 21:06:56 -03001443 mgmt_connected(hdev->id, &ev->bdaddr, conn->type);
Marcel Holtmann769be972008-07-14 20:13:49 +02001444 } else
1445 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001446
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001447 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001448 hci_conn_add_sysfs(conn);
1449
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001450 if (test_bit(HCI_AUTH, &hdev->flags))
1451 conn->link_mode |= HCI_LM_AUTH;
1452
1453 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1454 conn->link_mode |= HCI_LM_ENCRYPT;
1455
1456 /* Get remote features */
1457 if (conn->type == ACL_LINK) {
1458 struct hci_cp_read_remote_features cp;
1459 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001460 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1461 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001462 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001463
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001464 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001465 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001466 struct hci_cp_change_conn_ptype cp;
1467 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001468 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1469 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1470 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001471 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001472 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001473 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001474 if (conn->type == ACL_LINK)
1475 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1476 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001477
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001478 if (conn->type == ACL_LINK)
1479 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001480
Marcel Holtmann769be972008-07-14 20:13:49 +02001481 if (ev->status) {
1482 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001483 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001484 } else if (ev->link_type != ACL_LINK)
1485 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001486
1487unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001489
1490 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001491}
1492
Linus Torvalds1da177e2005-04-16 15:20:36 -07001493static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1494{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001495 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001496 int mask = hdev->link_mode;
1497
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001498 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1499 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001500
1501 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1502
Szymon Janc138d22e2011-02-17 16:44:23 +01001503 if ((mask & HCI_LM_ACCEPT) &&
1504 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001505 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001506 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001508
1509 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001510
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001511 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1512 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001513 memcpy(ie->data.dev_class, ev->dev_class, 3);
1514
Linus Torvalds1da177e2005-04-16 15:20:36 -07001515 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1516 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001517 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1518 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001519 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001520 hci_dev_unlock(hdev);
1521 return;
1522 }
1523 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001524
Linus Torvalds1da177e2005-04-16 15:20:36 -07001525 memcpy(conn->dev_class, ev->dev_class, 3);
1526 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001527
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528 hci_dev_unlock(hdev);
1529
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001530 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1531 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001532
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001533 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001534
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001535 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1536 cp.role = 0x00; /* Become master */
1537 else
1538 cp.role = 0x01; /* Remain slave */
1539
1540 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1541 sizeof(cp), &cp);
1542 } else {
1543 struct hci_cp_accept_sync_conn_req cp;
1544
1545 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001546 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001547
1548 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1549 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1550 cp.max_latency = cpu_to_le16(0xffff);
1551 cp.content_format = cpu_to_le16(hdev->voice_setting);
1552 cp.retrans_effort = 0xff;
1553
1554 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1555 sizeof(cp), &cp);
1556 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001557 } else {
1558 /* Connection rejected */
1559 struct hci_cp_reject_conn_req cp;
1560
1561 bacpy(&cp.bdaddr, &ev->bdaddr);
1562 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001563 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001564 }
1565}
1566
Linus Torvalds1da177e2005-04-16 15:20:36 -07001567static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1568{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001569 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001570 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001571
1572 BT_DBG("%s status %d", hdev->name, ev->status);
1573
Johan Hedberg8962ee72011-01-20 12:40:27 +02001574 if (ev->status) {
1575 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001576 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001577 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001578
1579 hci_dev_lock(hdev);
1580
Marcel Holtmann04837f62006-07-03 10:02:33 +02001581 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001582 if (!conn)
1583 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001584
Johan Hedbergf7520542011-01-20 12:34:39 +02001585 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001586
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001587 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedbergf7520542011-01-20 12:34:39 +02001588 mgmt_disconnected(hdev->id, &conn->dst);
1589
1590 hci_proto_disconn_cfm(conn, ev->reason);
1591 hci_conn_del(conn);
1592
1593unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001594 hci_dev_unlock(hdev);
1595}
1596
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001597static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1598{
1599 struct hci_ev_auth_complete *ev = (void *) skb->data;
1600 struct hci_conn *conn;
1601
1602 BT_DBG("%s status %d", hdev->name, ev->status);
1603
1604 hci_dev_lock(hdev);
1605
1606 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001607 if (!conn)
1608 goto unlock;
1609
1610 if (!ev->status) {
1611 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1612 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1613 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001614 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001615 conn->link_mode |= HCI_LM_AUTH;
1616 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001617 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001618 } else {
1619 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1620 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001621
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001622 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1623 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001624
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001625 if (conn->state == BT_CONFIG) {
1626 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1627 struct hci_cp_set_conn_encrypt cp;
1628 cp.handle = ev->handle;
1629 cp.encrypt = 0x01;
1630 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1631 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001632 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001633 conn->state = BT_CONNECTED;
1634 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001635 hci_conn_put(conn);
1636 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001637 } else {
1638 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001639
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001640 hci_conn_hold(conn);
1641 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1642 hci_conn_put(conn);
1643 }
1644
1645 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1646 if (!ev->status) {
1647 struct hci_cp_set_conn_encrypt cp;
1648 cp.handle = ev->handle;
1649 cp.encrypt = 0x01;
1650 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1651 &cp);
1652 } else {
1653 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1654 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001655 }
1656 }
1657
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001658unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001659 hci_dev_unlock(hdev);
1660}
1661
1662static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1663{
Johan Hedberg127178d2010-11-18 22:22:29 +02001664 struct hci_ev_remote_name *ev = (void *) skb->data;
1665 struct hci_conn *conn;
1666
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001667 BT_DBG("%s", hdev->name);
1668
1669 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001670
1671 hci_dev_lock(hdev);
1672
Johan Hedberga88a9652011-03-30 13:18:12 +03001673 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1674 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1675
Johan Hedberg127178d2010-11-18 22:22:29 +02001676 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001677 if (!conn)
1678 goto unlock;
1679
1680 if (!hci_outgoing_auth_needed(hdev, conn))
1681 goto unlock;
1682
1683 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001684 struct hci_cp_auth_requested cp;
1685 cp.handle = __cpu_to_le16(conn->handle);
1686 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1687 }
1688
Johan Hedberg79c6c702011-04-28 11:28:55 -07001689unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001690 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001691}
1692
1693static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1694{
1695 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1696 struct hci_conn *conn;
1697
1698 BT_DBG("%s status %d", hdev->name, ev->status);
1699
1700 hci_dev_lock(hdev);
1701
1702 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1703 if (conn) {
1704 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001705 if (ev->encrypt) {
1706 /* Encryption implies authentication */
1707 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001708 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03001709 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001710 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001711 conn->link_mode &= ~HCI_LM_ENCRYPT;
1712 }
1713
1714 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1715
Marcel Holtmannf8558552008-07-14 20:13:49 +02001716 if (conn->state == BT_CONFIG) {
1717 if (!ev->status)
1718 conn->state = BT_CONNECTED;
1719
1720 hci_proto_connect_cfm(conn, ev->status);
1721 hci_conn_put(conn);
1722 } else
1723 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001724 }
1725
1726 hci_dev_unlock(hdev);
1727}
1728
1729static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1730{
1731 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1732 struct hci_conn *conn;
1733
1734 BT_DBG("%s status %d", hdev->name, ev->status);
1735
1736 hci_dev_lock(hdev);
1737
1738 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1739 if (conn) {
1740 if (!ev->status)
1741 conn->link_mode |= HCI_LM_SECURE;
1742
1743 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1744
1745 hci_key_change_cfm(conn, ev->status);
1746 }
1747
1748 hci_dev_unlock(hdev);
1749}
1750
1751static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1752{
1753 struct hci_ev_remote_features *ev = (void *) skb->data;
1754 struct hci_conn *conn;
1755
1756 BT_DBG("%s status %d", hdev->name, ev->status);
1757
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001758 hci_dev_lock(hdev);
1759
1760 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001761 if (!conn)
1762 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001763
Johan Hedbergccd556f2010-11-10 17:11:51 +02001764 if (!ev->status)
1765 memcpy(conn->features, ev->features, 8);
1766
1767 if (conn->state != BT_CONFIG)
1768 goto unlock;
1769
1770 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1771 struct hci_cp_read_remote_ext_features cp;
1772 cp.handle = ev->handle;
1773 cp.page = 0x01;
1774 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001775 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001776 goto unlock;
1777 }
1778
Johan Hedberg127178d2010-11-18 22:22:29 +02001779 if (!ev->status) {
1780 struct hci_cp_remote_name_req cp;
1781 memset(&cp, 0, sizeof(cp));
1782 bacpy(&cp.bdaddr, &conn->dst);
1783 cp.pscan_rep_mode = 0x02;
1784 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1785 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001786
Johan Hedberg127178d2010-11-18 22:22:29 +02001787 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001788 conn->state = BT_CONNECTED;
1789 hci_proto_connect_cfm(conn, ev->status);
1790 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001791 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001792
Johan Hedbergccd556f2010-11-10 17:11:51 +02001793unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001794 hci_dev_unlock(hdev);
1795}
1796
1797static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1798{
1799 BT_DBG("%s", hdev->name);
1800}
1801
1802static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1803{
1804 BT_DBG("%s", hdev->name);
1805}
1806
1807static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1808{
1809 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1810 __u16 opcode;
1811
1812 skb_pull(skb, sizeof(*ev));
1813
1814 opcode = __le16_to_cpu(ev->opcode);
1815
1816 switch (opcode) {
1817 case HCI_OP_INQUIRY_CANCEL:
1818 hci_cc_inquiry_cancel(hdev, skb);
1819 break;
1820
1821 case HCI_OP_EXIT_PERIODIC_INQ:
1822 hci_cc_exit_periodic_inq(hdev, skb);
1823 break;
1824
1825 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1826 hci_cc_remote_name_req_cancel(hdev, skb);
1827 break;
1828
1829 case HCI_OP_ROLE_DISCOVERY:
1830 hci_cc_role_discovery(hdev, skb);
1831 break;
1832
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001833 case HCI_OP_READ_LINK_POLICY:
1834 hci_cc_read_link_policy(hdev, skb);
1835 break;
1836
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001837 case HCI_OP_WRITE_LINK_POLICY:
1838 hci_cc_write_link_policy(hdev, skb);
1839 break;
1840
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001841 case HCI_OP_READ_DEF_LINK_POLICY:
1842 hci_cc_read_def_link_policy(hdev, skb);
1843 break;
1844
1845 case HCI_OP_WRITE_DEF_LINK_POLICY:
1846 hci_cc_write_def_link_policy(hdev, skb);
1847 break;
1848
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001849 case HCI_OP_RESET:
1850 hci_cc_reset(hdev, skb);
1851 break;
1852
1853 case HCI_OP_WRITE_LOCAL_NAME:
1854 hci_cc_write_local_name(hdev, skb);
1855 break;
1856
1857 case HCI_OP_READ_LOCAL_NAME:
1858 hci_cc_read_local_name(hdev, skb);
1859 break;
1860
1861 case HCI_OP_WRITE_AUTH_ENABLE:
1862 hci_cc_write_auth_enable(hdev, skb);
1863 break;
1864
1865 case HCI_OP_WRITE_ENCRYPT_MODE:
1866 hci_cc_write_encrypt_mode(hdev, skb);
1867 break;
1868
1869 case HCI_OP_WRITE_SCAN_ENABLE:
1870 hci_cc_write_scan_enable(hdev, skb);
1871 break;
1872
1873 case HCI_OP_READ_CLASS_OF_DEV:
1874 hci_cc_read_class_of_dev(hdev, skb);
1875 break;
1876
1877 case HCI_OP_WRITE_CLASS_OF_DEV:
1878 hci_cc_write_class_of_dev(hdev, skb);
1879 break;
1880
1881 case HCI_OP_READ_VOICE_SETTING:
1882 hci_cc_read_voice_setting(hdev, skb);
1883 break;
1884
1885 case HCI_OP_WRITE_VOICE_SETTING:
1886 hci_cc_write_voice_setting(hdev, skb);
1887 break;
1888
1889 case HCI_OP_HOST_BUFFER_SIZE:
1890 hci_cc_host_buffer_size(hdev, skb);
1891 break;
1892
Marcel Holtmann333140b2008-07-14 20:13:48 +02001893 case HCI_OP_READ_SSP_MODE:
1894 hci_cc_read_ssp_mode(hdev, skb);
1895 break;
1896
1897 case HCI_OP_WRITE_SSP_MODE:
1898 hci_cc_write_ssp_mode(hdev, skb);
1899 break;
1900
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001901 case HCI_OP_READ_LOCAL_VERSION:
1902 hci_cc_read_local_version(hdev, skb);
1903 break;
1904
1905 case HCI_OP_READ_LOCAL_COMMANDS:
1906 hci_cc_read_local_commands(hdev, skb);
1907 break;
1908
1909 case HCI_OP_READ_LOCAL_FEATURES:
1910 hci_cc_read_local_features(hdev, skb);
1911 break;
1912
Andre Guedes971e3a42011-06-30 19:20:52 -03001913 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1914 hci_cc_read_local_ext_features(hdev, skb);
1915 break;
1916
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001917 case HCI_OP_READ_BUFFER_SIZE:
1918 hci_cc_read_buffer_size(hdev, skb);
1919 break;
1920
1921 case HCI_OP_READ_BD_ADDR:
1922 hci_cc_read_bd_addr(hdev, skb);
1923 break;
1924
Johan Hedberg23bb5762010-12-21 23:01:27 +02001925 case HCI_OP_WRITE_CA_TIMEOUT:
1926 hci_cc_write_ca_timeout(hdev, skb);
1927 break;
1928
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03001929 case HCI_OP_READ_LOCAL_AMP_INFO:
1930 hci_cc_read_local_amp_info(hdev, skb);
1931 break;
1932
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001933 case HCI_OP_DELETE_STORED_LINK_KEY:
1934 hci_cc_delete_stored_link_key(hdev, skb);
1935 break;
1936
Johan Hedbergd5859e22011-01-25 01:19:58 +02001937 case HCI_OP_SET_EVENT_MASK:
1938 hci_cc_set_event_mask(hdev, skb);
1939 break;
1940
1941 case HCI_OP_WRITE_INQUIRY_MODE:
1942 hci_cc_write_inquiry_mode(hdev, skb);
1943 break;
1944
1945 case HCI_OP_READ_INQ_RSP_TX_POWER:
1946 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1947 break;
1948
1949 case HCI_OP_SET_EVENT_FLT:
1950 hci_cc_set_event_flt(hdev, skb);
1951 break;
1952
Johan Hedberg980e1a52011-01-22 06:10:07 +02001953 case HCI_OP_PIN_CODE_REPLY:
1954 hci_cc_pin_code_reply(hdev, skb);
1955 break;
1956
1957 case HCI_OP_PIN_CODE_NEG_REPLY:
1958 hci_cc_pin_code_neg_reply(hdev, skb);
1959 break;
1960
Szymon Jancc35938b2011-03-22 13:12:21 +01001961 case HCI_OP_READ_LOCAL_OOB_DATA:
1962 hci_cc_read_local_oob_data_reply(hdev, skb);
1963 break;
1964
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001965 case HCI_OP_LE_READ_BUFFER_SIZE:
1966 hci_cc_le_read_buffer_size(hdev, skb);
1967 break;
1968
Johan Hedberga5c29682011-02-19 12:05:57 -03001969 case HCI_OP_USER_CONFIRM_REPLY:
1970 hci_cc_user_confirm_reply(hdev, skb);
1971 break;
1972
1973 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1974 hci_cc_user_confirm_neg_reply(hdev, skb);
1975 break;
1976
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001977 case HCI_OP_LE_SET_SCAN_ENABLE:
1978 hci_cc_le_set_scan_enable(hdev, skb);
1979 break;
1980
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001981 case HCI_OP_LE_LTK_REPLY:
1982 hci_cc_le_ltk_reply(hdev, skb);
1983 break;
1984
1985 case HCI_OP_LE_LTK_NEG_REPLY:
1986 hci_cc_le_ltk_neg_reply(hdev, skb);
1987 break;
1988
Andre Guedesf9b49302011-06-30 19:20:53 -03001989 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
1990 hci_cc_write_le_host_supported(hdev, skb);
1991 break;
1992
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001993 default:
1994 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1995 break;
1996 }
1997
Ville Tervo6bd32322011-02-16 16:32:41 +02001998 if (ev->opcode != HCI_OP_NOP)
1999 del_timer(&hdev->cmd_timer);
2000
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002001 if (ev->ncmd) {
2002 atomic_set(&hdev->cmd_cnt, 1);
2003 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002004 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002005 }
2006}
2007
2008static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
2009{
2010 struct hci_ev_cmd_status *ev = (void *) skb->data;
2011 __u16 opcode;
2012
2013 skb_pull(skb, sizeof(*ev));
2014
2015 opcode = __le16_to_cpu(ev->opcode);
2016
2017 switch (opcode) {
2018 case HCI_OP_INQUIRY:
2019 hci_cs_inquiry(hdev, ev->status);
2020 break;
2021
2022 case HCI_OP_CREATE_CONN:
2023 hci_cs_create_conn(hdev, ev->status);
2024 break;
2025
2026 case HCI_OP_ADD_SCO:
2027 hci_cs_add_sco(hdev, ev->status);
2028 break;
2029
Marcel Holtmannf8558552008-07-14 20:13:49 +02002030 case HCI_OP_AUTH_REQUESTED:
2031 hci_cs_auth_requested(hdev, ev->status);
2032 break;
2033
2034 case HCI_OP_SET_CONN_ENCRYPT:
2035 hci_cs_set_conn_encrypt(hdev, ev->status);
2036 break;
2037
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002038 case HCI_OP_REMOTE_NAME_REQ:
2039 hci_cs_remote_name_req(hdev, ev->status);
2040 break;
2041
Marcel Holtmann769be972008-07-14 20:13:49 +02002042 case HCI_OP_READ_REMOTE_FEATURES:
2043 hci_cs_read_remote_features(hdev, ev->status);
2044 break;
2045
2046 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2047 hci_cs_read_remote_ext_features(hdev, ev->status);
2048 break;
2049
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002050 case HCI_OP_SETUP_SYNC_CONN:
2051 hci_cs_setup_sync_conn(hdev, ev->status);
2052 break;
2053
2054 case HCI_OP_SNIFF_MODE:
2055 hci_cs_sniff_mode(hdev, ev->status);
2056 break;
2057
2058 case HCI_OP_EXIT_SNIFF_MODE:
2059 hci_cs_exit_sniff_mode(hdev, ev->status);
2060 break;
2061
Johan Hedberg8962ee72011-01-20 12:40:27 +02002062 case HCI_OP_DISCONNECT:
2063 if (ev->status != 0)
2064 mgmt_disconnect_failed(hdev->id);
2065 break;
2066
Ville Tervofcd89c02011-02-10 22:38:47 -03002067 case HCI_OP_LE_CREATE_CONN:
2068 hci_cs_le_create_conn(hdev, ev->status);
2069 break;
2070
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002071 case HCI_OP_LE_START_ENC:
2072 hci_cs_le_start_enc(hdev, ev->status);
2073 break;
2074
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002075 default:
2076 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2077 break;
2078 }
2079
Ville Tervo6bd32322011-02-16 16:32:41 +02002080 if (ev->opcode != HCI_OP_NOP)
2081 del_timer(&hdev->cmd_timer);
2082
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002083 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002084 atomic_set(&hdev->cmd_cnt, 1);
2085 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002086 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002087 }
2088}
2089
2090static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2091{
2092 struct hci_ev_role_change *ev = (void *) skb->data;
2093 struct hci_conn *conn;
2094
2095 BT_DBG("%s status %d", hdev->name, ev->status);
2096
2097 hci_dev_lock(hdev);
2098
2099 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2100 if (conn) {
2101 if (!ev->status) {
2102 if (ev->role)
2103 conn->link_mode &= ~HCI_LM_MASTER;
2104 else
2105 conn->link_mode |= HCI_LM_MASTER;
2106 }
2107
2108 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2109
2110 hci_role_switch_cfm(conn, ev->status, ev->role);
2111 }
2112
2113 hci_dev_unlock(hdev);
2114}
2115
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2117{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002118 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002119 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002120 int i;
2121
2122 skb_pull(skb, sizeof(*ev));
2123
2124 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2125
2126 if (skb->len < ev->num_hndl * 4) {
2127 BT_DBG("%s bad parameters", hdev->name);
2128 return;
2129 }
2130
2131 tasklet_disable(&hdev->tx_task);
2132
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002133 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002134 struct hci_conn *conn;
2135 __u16 handle, count;
2136
Harvey Harrison83985312008-05-02 16:25:46 -07002137 handle = get_unaligned_le16(ptr++);
2138 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002139
2140 conn = hci_conn_hash_lookup_handle(hdev, handle);
2141 if (conn) {
2142 conn->sent -= count;
2143
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002144 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002145 hdev->acl_cnt += count;
2146 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002147 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002148 } else if (conn->type == LE_LINK) {
2149 if (hdev->le_pkts) {
2150 hdev->le_cnt += count;
2151 if (hdev->le_cnt > hdev->le_pkts)
2152 hdev->le_cnt = hdev->le_pkts;
2153 } else {
2154 hdev->acl_cnt += count;
2155 if (hdev->acl_cnt > hdev->acl_pkts)
2156 hdev->acl_cnt = hdev->acl_pkts;
2157 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002158 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002159 hdev->sco_cnt += count;
2160 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002161 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002162 }
2163 }
2164 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002165
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002166 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002167
2168 tasklet_enable(&hdev->tx_task);
2169}
2170
Marcel Holtmann04837f62006-07-03 10:02:33 +02002171static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002172{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002173 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002174 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002175
2176 BT_DBG("%s status %d", hdev->name, ev->status);
2177
2178 hci_dev_lock(hdev);
2179
Marcel Holtmann04837f62006-07-03 10:02:33 +02002180 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2181 if (conn) {
2182 conn->mode = ev->mode;
2183 conn->interval = __le16_to_cpu(ev->interval);
2184
2185 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2186 if (conn->mode == HCI_CM_ACTIVE)
2187 conn->power_save = 1;
2188 else
2189 conn->power_save = 0;
2190 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002191
2192 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2193 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002194 }
2195
2196 hci_dev_unlock(hdev);
2197}
2198
Linus Torvalds1da177e2005-04-16 15:20:36 -07002199static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2200{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002201 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2202 struct hci_conn *conn;
2203
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002204 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002205
2206 hci_dev_lock(hdev);
2207
2208 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002209 if (!conn)
2210 goto unlock;
2211
2212 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002213 hci_conn_hold(conn);
2214 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2215 hci_conn_put(conn);
2216 }
2217
Johan Hedberg03b555e2011-01-04 15:40:05 +02002218 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2219 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2220 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002221 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002222 u8 secure;
2223
2224 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2225 secure = 1;
2226 else
2227 secure = 0;
2228
2229 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2230 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002231
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002232unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002233 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002234}
2235
Linus Torvalds1da177e2005-04-16 15:20:36 -07002236static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2237{
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002238 struct hci_ev_link_key_req *ev = (void *) skb->data;
2239 struct hci_cp_link_key_reply cp;
2240 struct hci_conn *conn;
2241 struct link_key *key;
2242
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002243 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002244
2245 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2246 return;
2247
2248 hci_dev_lock(hdev);
2249
2250 key = hci_find_link_key(hdev, &ev->bdaddr);
2251 if (!key) {
2252 BT_DBG("%s link key not found for %s", hdev->name,
2253 batostr(&ev->bdaddr));
2254 goto not_found;
2255 }
2256
2257 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2258 batostr(&ev->bdaddr));
2259
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002260 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2261 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002262 BT_DBG("%s ignoring debug key", hdev->name);
2263 goto not_found;
2264 }
2265
2266 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002267 if (conn) {
2268 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2269 conn->auth_type != 0xff &&
2270 (conn->auth_type & 0x01)) {
2271 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2272 goto not_found;
2273 }
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002274
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002275 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2276 conn->pending_sec_level == BT_SECURITY_HIGH) {
2277 BT_DBG("%s ignoring key unauthenticated for high \
2278 security", hdev->name);
2279 goto not_found;
2280 }
2281
2282 conn->key_type = key->type;
2283 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002284 }
2285
2286 bacpy(&cp.bdaddr, &ev->bdaddr);
2287 memcpy(cp.link_key, key->val, 16);
2288
2289 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2290
2291 hci_dev_unlock(hdev);
2292
2293 return;
2294
2295not_found:
2296 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2297 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002298}
2299
Linus Torvalds1da177e2005-04-16 15:20:36 -07002300static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2301{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002302 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2303 struct hci_conn *conn;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002304 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002305
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002306 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002307
2308 hci_dev_lock(hdev);
2309
2310 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2311 if (conn) {
2312 hci_conn_hold(conn);
2313 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002314 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002315
2316 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2317 conn->key_type = ev->key_type;
2318
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002319 hci_conn_put(conn);
2320 }
2321
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002322 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002323 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002324 ev->key_type, pin_len);
2325
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002326 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002327}
2328
Marcel Holtmann04837f62006-07-03 10:02:33 +02002329static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2330{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002331 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002332 struct hci_conn *conn;
2333
2334 BT_DBG("%s status %d", hdev->name, ev->status);
2335
2336 hci_dev_lock(hdev);
2337
2338 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002339 if (conn && !ev->status) {
2340 struct inquiry_entry *ie;
2341
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002342 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2343 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002344 ie->data.clock_offset = ev->clock_offset;
2345 ie->timestamp = jiffies;
2346 }
2347 }
2348
2349 hci_dev_unlock(hdev);
2350}
2351
Marcel Holtmanna8746412008-07-14 20:13:46 +02002352static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2353{
2354 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2355 struct hci_conn *conn;
2356
2357 BT_DBG("%s status %d", hdev->name, ev->status);
2358
2359 hci_dev_lock(hdev);
2360
2361 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2362 if (conn && !ev->status)
2363 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2364
2365 hci_dev_unlock(hdev);
2366}
2367
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002368static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2369{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002370 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002371 struct inquiry_entry *ie;
2372
2373 BT_DBG("%s", hdev->name);
2374
2375 hci_dev_lock(hdev);
2376
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002377 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2378 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002379 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2380 ie->timestamp = jiffies;
2381 }
2382
2383 hci_dev_unlock(hdev);
2384}
2385
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002386static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2387{
2388 struct inquiry_data data;
2389 int num_rsp = *((__u8 *) skb->data);
2390
2391 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2392
2393 if (!num_rsp)
2394 return;
2395
2396 hci_dev_lock(hdev);
2397
Johan Hedberg314b2382011-04-27 10:29:57 -04002398 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2399
2400 if (test_bit(HCI_MGMT, &hdev->flags))
2401 mgmt_discovering(hdev->id, 1);
2402 }
2403
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002404 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002405 struct inquiry_info_with_rssi_and_pscan_mode *info;
2406 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002407
Johan Hedberge17acd42011-03-30 23:57:16 +03002408 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002409 bacpy(&data.bdaddr, &info->bdaddr);
2410 data.pscan_rep_mode = info->pscan_rep_mode;
2411 data.pscan_period_mode = info->pscan_period_mode;
2412 data.pscan_mode = info->pscan_mode;
2413 memcpy(data.dev_class, info->dev_class, 3);
2414 data.clock_offset = info->clock_offset;
2415 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002416 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002417 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002418 mgmt_device_found(hdev->id, &info->bdaddr,
2419 info->dev_class, info->rssi,
2420 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002421 }
2422 } else {
2423 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2424
Johan Hedberge17acd42011-03-30 23:57:16 +03002425 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002426 bacpy(&data.bdaddr, &info->bdaddr);
2427 data.pscan_rep_mode = info->pscan_rep_mode;
2428 data.pscan_period_mode = info->pscan_period_mode;
2429 data.pscan_mode = 0x00;
2430 memcpy(data.dev_class, info->dev_class, 3);
2431 data.clock_offset = info->clock_offset;
2432 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002433 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002434 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002435 mgmt_device_found(hdev->id, &info->bdaddr,
2436 info->dev_class, info->rssi,
2437 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002438 }
2439 }
2440
2441 hci_dev_unlock(hdev);
2442}
2443
2444static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2445{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002446 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2447 struct hci_conn *conn;
2448
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002449 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002450
Marcel Holtmann41a96212008-07-14 20:13:48 +02002451 hci_dev_lock(hdev);
2452
2453 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002454 if (!conn)
2455 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002456
Johan Hedbergccd556f2010-11-10 17:11:51 +02002457 if (!ev->status && ev->page == 0x01) {
2458 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002459
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002460 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2461 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002462 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002463
Johan Hedbergccd556f2010-11-10 17:11:51 +02002464 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002465 }
2466
Johan Hedbergccd556f2010-11-10 17:11:51 +02002467 if (conn->state != BT_CONFIG)
2468 goto unlock;
2469
Johan Hedberg127178d2010-11-18 22:22:29 +02002470 if (!ev->status) {
2471 struct hci_cp_remote_name_req cp;
2472 memset(&cp, 0, sizeof(cp));
2473 bacpy(&cp.bdaddr, &conn->dst);
2474 cp.pscan_rep_mode = 0x02;
2475 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2476 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002477
Johan Hedberg127178d2010-11-18 22:22:29 +02002478 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002479 conn->state = BT_CONNECTED;
2480 hci_proto_connect_cfm(conn, ev->status);
2481 hci_conn_put(conn);
2482 }
2483
2484unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002485 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002486}
2487
2488static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2489{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002490 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2491 struct hci_conn *conn;
2492
2493 BT_DBG("%s status %d", hdev->name, ev->status);
2494
2495 hci_dev_lock(hdev);
2496
2497 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002498 if (!conn) {
2499 if (ev->link_type == ESCO_LINK)
2500 goto unlock;
2501
2502 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2503 if (!conn)
2504 goto unlock;
2505
2506 conn->type = SCO_LINK;
2507 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002508
Marcel Holtmann732547f2009-04-19 19:14:14 +02002509 switch (ev->status) {
2510 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002511 conn->handle = __le16_to_cpu(ev->handle);
2512 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002513
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002514 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002515 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002516 break;
2517
Stephen Coe705e5712010-02-16 11:29:44 -05002518 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002519 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002520 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002521 case 0x1f: /* Unspecified error */
2522 if (conn->out && conn->attempt < 2) {
2523 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2524 (hdev->esco_type & EDR_ESCO_MASK);
2525 hci_setup_sync(conn, conn->link->handle);
2526 goto unlock;
2527 }
2528 /* fall through */
2529
2530 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002531 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002532 break;
2533 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002534
2535 hci_proto_connect_cfm(conn, ev->status);
2536 if (ev->status)
2537 hci_conn_del(conn);
2538
2539unlock:
2540 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002541}
2542
2543static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2544{
2545 BT_DBG("%s", hdev->name);
2546}
2547
Marcel Holtmann04837f62006-07-03 10:02:33 +02002548static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2549{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002550 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002551
2552 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002553}
2554
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002555static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2556{
2557 struct inquiry_data data;
2558 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2559 int num_rsp = *((__u8 *) skb->data);
2560
2561 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2562
2563 if (!num_rsp)
2564 return;
2565
Johan Hedberg314b2382011-04-27 10:29:57 -04002566 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2567
2568 if (test_bit(HCI_MGMT, &hdev->flags))
2569 mgmt_discovering(hdev->id, 1);
2570 }
2571
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002572 hci_dev_lock(hdev);
2573
Johan Hedberge17acd42011-03-30 23:57:16 +03002574 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002575 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002576 data.pscan_rep_mode = info->pscan_rep_mode;
2577 data.pscan_period_mode = info->pscan_period_mode;
2578 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002579 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002580 data.clock_offset = info->clock_offset;
2581 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002582 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002583 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002584 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class,
2585 info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002586 }
2587
2588 hci_dev_unlock(hdev);
2589}
2590
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002591static inline u8 hci_get_auth_req(struct hci_conn *conn)
2592{
2593 /* If remote requests dedicated bonding follow that lead */
2594 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2595 /* If both remote and local IO capabilities allow MITM
2596 * protection then require it, otherwise don't */
2597 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2598 return 0x02;
2599 else
2600 return 0x03;
2601 }
2602
2603 /* If remote requests no-bonding follow that lead */
2604 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002605 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002606
2607 return conn->auth_type;
2608}
2609
Marcel Holtmann04936842008-07-14 20:13:48 +02002610static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2611{
2612 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2613 struct hci_conn *conn;
2614
2615 BT_DBG("%s", hdev->name);
2616
2617 hci_dev_lock(hdev);
2618
2619 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002620 if (!conn)
2621 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002622
Johan Hedberg03b555e2011-01-04 15:40:05 +02002623 hci_conn_hold(conn);
2624
2625 if (!test_bit(HCI_MGMT, &hdev->flags))
2626 goto unlock;
2627
2628 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2629 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002630 struct hci_cp_io_capability_reply cp;
2631
2632 bacpy(&cp.bdaddr, &ev->bdaddr);
2633 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002634 conn->auth_type = hci_get_auth_req(conn);
2635 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002636
Szymon Jancce85ee12011-03-22 13:12:23 +01002637 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2638 hci_find_remote_oob_data(hdev, &conn->dst))
2639 cp.oob_data = 0x01;
2640 else
2641 cp.oob_data = 0x00;
2642
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002643 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2644 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002645 } else {
2646 struct hci_cp_io_capability_neg_reply cp;
2647
2648 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedbergbe771592011-04-28 11:28:57 -07002649 cp.reason = 0x18; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02002650
2651 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2652 sizeof(cp), &cp);
2653 }
2654
2655unlock:
2656 hci_dev_unlock(hdev);
2657}
2658
2659static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2660{
2661 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2662 struct hci_conn *conn;
2663
2664 BT_DBG("%s", hdev->name);
2665
2666 hci_dev_lock(hdev);
2667
2668 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2669 if (!conn)
2670 goto unlock;
2671
Johan Hedberg03b555e2011-01-04 15:40:05 +02002672 conn->remote_cap = ev->capability;
2673 conn->remote_oob = ev->oob_data;
2674 conn->remote_auth = ev->authentication;
2675
2676unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002677 hci_dev_unlock(hdev);
2678}
2679
Johan Hedberga5c29682011-02-19 12:05:57 -03002680static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2681 struct sk_buff *skb)
2682{
2683 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002684 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002685 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002686
2687 BT_DBG("%s", hdev->name);
2688
2689 hci_dev_lock(hdev);
2690
Johan Hedberg7a828902011-04-28 11:28:53 -07002691 if (!test_bit(HCI_MGMT, &hdev->flags))
2692 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002693
Johan Hedberg7a828902011-04-28 11:28:53 -07002694 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2695 if (!conn)
2696 goto unlock;
2697
2698 loc_mitm = (conn->auth_type & 0x01);
2699 rem_mitm = (conn->remote_auth & 0x01);
2700
2701 /* If we require MITM but the remote device can't provide that
2702 * (it has NoInputNoOutput) then reject the confirmation
2703 * request. The only exception is when we're dedicated bonding
2704 * initiators (connect_cfm_cb set) since then we always have the MITM
2705 * bit set. */
2706 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2707 BT_DBG("Rejecting request: remote device can't provide MITM");
2708 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2709 sizeof(ev->bdaddr), &ev->bdaddr);
2710 goto unlock;
2711 }
2712
2713 /* If no side requires MITM protection; auto-accept */
2714 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2715 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002716
2717 /* If we're not the initiators request authorization to
2718 * proceed from user space (mgmt_user_confirm with
2719 * confirm_hint set to 1). */
2720 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2721 BT_DBG("Confirming auto-accept as acceptor");
2722 confirm_hint = 1;
2723 goto confirm;
2724 }
2725
Johan Hedberg9f616562011-04-28 11:28:54 -07002726 BT_DBG("Auto-accept of user confirmation with %ums delay",
2727 hdev->auto_accept_delay);
2728
2729 if (hdev->auto_accept_delay > 0) {
2730 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2731 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2732 goto unlock;
2733 }
2734
Johan Hedberg7a828902011-04-28 11:28:53 -07002735 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2736 sizeof(ev->bdaddr), &ev->bdaddr);
2737 goto unlock;
2738 }
2739
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002740confirm:
2741 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2742 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002743
2744unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002745 hci_dev_unlock(hdev);
2746}
2747
Marcel Holtmann04936842008-07-14 20:13:48 +02002748static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2749{
2750 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2751 struct hci_conn *conn;
2752
2753 BT_DBG("%s", hdev->name);
2754
2755 hci_dev_lock(hdev);
2756
2757 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002758 if (!conn)
2759 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002760
Johan Hedberg2a611692011-02-19 12:06:00 -03002761 /* To avoid duplicate auth_failed events to user space we check
2762 * the HCI_CONN_AUTH_PEND flag which will be set if we
2763 * initiated the authentication. A traditional auth_complete
2764 * event gets always produced as initiator and is also mapped to
2765 * the mgmt_auth_failed event */
2766 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2767 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2768
2769 hci_conn_put(conn);
2770
2771unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002772 hci_dev_unlock(hdev);
2773}
2774
Marcel Holtmann41a96212008-07-14 20:13:48 +02002775static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2776{
2777 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2778 struct inquiry_entry *ie;
2779
2780 BT_DBG("%s", hdev->name);
2781
2782 hci_dev_lock(hdev);
2783
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002784 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2785 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002786 ie->data.ssp_mode = (ev->features[0] & 0x01);
2787
2788 hci_dev_unlock(hdev);
2789}
2790
Szymon Janc2763eda2011-03-22 13:12:22 +01002791static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2792 struct sk_buff *skb)
2793{
2794 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2795 struct oob_data *data;
2796
2797 BT_DBG("%s", hdev->name);
2798
2799 hci_dev_lock(hdev);
2800
Szymon Jance1ba1f12011-04-06 13:01:59 +02002801 if (!test_bit(HCI_MGMT, &hdev->flags))
2802 goto unlock;
2803
Szymon Janc2763eda2011-03-22 13:12:22 +01002804 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2805 if (data) {
2806 struct hci_cp_remote_oob_data_reply cp;
2807
2808 bacpy(&cp.bdaddr, &ev->bdaddr);
2809 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2810 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2811
2812 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2813 &cp);
2814 } else {
2815 struct hci_cp_remote_oob_data_neg_reply cp;
2816
2817 bacpy(&cp.bdaddr, &ev->bdaddr);
2818 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2819 &cp);
2820 }
2821
Szymon Jance1ba1f12011-04-06 13:01:59 +02002822unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002823 hci_dev_unlock(hdev);
2824}
2825
Ville Tervofcd89c02011-02-10 22:38:47 -03002826static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2827{
2828 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2829 struct hci_conn *conn;
2830
2831 BT_DBG("%s status %d", hdev->name, ev->status);
2832
2833 hci_dev_lock(hdev);
2834
2835 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002836 if (!conn) {
2837 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
2838 if (!conn) {
2839 BT_ERR("No memory for new connection");
2840 hci_dev_unlock(hdev);
2841 return;
2842 }
Andre Guedes29b79882011-05-31 14:20:54 -03002843
2844 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002845 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002846
2847 if (ev->status) {
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002848 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002849 hci_proto_connect_cfm(conn, ev->status);
2850 conn->state = BT_CLOSED;
2851 hci_conn_del(conn);
2852 goto unlock;
2853 }
2854
Vinicius Costa Gomescfafccf2011-08-19 21:06:56 -03002855 mgmt_connected(hdev->id, &ev->bdaddr, conn->type);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002856
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03002857 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002858 conn->handle = __le16_to_cpu(ev->handle);
2859 conn->state = BT_CONNECTED;
2860
2861 hci_conn_hold_device(conn);
2862 hci_conn_add_sysfs(conn);
2863
2864 hci_proto_connect_cfm(conn, ev->status);
2865
2866unlock:
2867 hci_dev_unlock(hdev);
2868}
2869
Andre Guedes9aa04c92011-05-26 16:23:51 -03002870static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2871 struct sk_buff *skb)
2872{
Andre Guedese95beb42011-09-26 20:48:35 -03002873 u8 num_reports = skb->data[0];
2874 void *ptr = &skb->data[1];
Andre Guedes9aa04c92011-05-26 16:23:51 -03002875
2876 hci_dev_lock(hdev);
2877
Andre Guedese95beb42011-09-26 20:48:35 -03002878 while (num_reports--) {
2879 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03002880
Andre Guedes9aa04c92011-05-26 16:23:51 -03002881 hci_add_adv_entry(hdev, ev);
Andre Guedese95beb42011-09-26 20:48:35 -03002882
2883 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03002884 }
2885
2886 hci_dev_unlock(hdev);
2887}
2888
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002889static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2890 struct sk_buff *skb)
2891{
2892 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2893 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002894 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002895 struct hci_conn *conn;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002896 struct link_key *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002897
2898 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2899
2900 hci_dev_lock(hdev);
2901
2902 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002903 if (conn == NULL)
2904 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002905
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002906 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
2907 if (ltk == NULL)
2908 goto not_found;
2909
2910 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002911 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomes726b4ff2011-07-08 18:31:45 -03002912 conn->pin_length = ltk->pin_len;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002913
2914 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2915
2916 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002917
2918 return;
2919
2920not_found:
2921 neg.handle = ev->handle;
2922 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
2923 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002924}
2925
Ville Tervofcd89c02011-02-10 22:38:47 -03002926static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2927{
2928 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2929
2930 skb_pull(skb, sizeof(*le_ev));
2931
2932 switch (le_ev->subevent) {
2933 case HCI_EV_LE_CONN_COMPLETE:
2934 hci_le_conn_complete_evt(hdev, skb);
2935 break;
2936
Andre Guedes9aa04c92011-05-26 16:23:51 -03002937 case HCI_EV_LE_ADVERTISING_REPORT:
2938 hci_le_adv_report_evt(hdev, skb);
2939 break;
2940
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002941 case HCI_EV_LE_LTK_REQ:
2942 hci_le_ltk_request_evt(hdev, skb);
2943 break;
2944
Ville Tervofcd89c02011-02-10 22:38:47 -03002945 default:
2946 break;
2947 }
2948}
2949
Linus Torvalds1da177e2005-04-16 15:20:36 -07002950void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2951{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002952 struct hci_event_hdr *hdr = (void *) skb->data;
2953 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002954
2955 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2956
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002957 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002958 case HCI_EV_INQUIRY_COMPLETE:
2959 hci_inquiry_complete_evt(hdev, skb);
2960 break;
2961
2962 case HCI_EV_INQUIRY_RESULT:
2963 hci_inquiry_result_evt(hdev, skb);
2964 break;
2965
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002966 case HCI_EV_CONN_COMPLETE:
2967 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002968 break;
2969
Linus Torvalds1da177e2005-04-16 15:20:36 -07002970 case HCI_EV_CONN_REQUEST:
2971 hci_conn_request_evt(hdev, skb);
2972 break;
2973
Linus Torvalds1da177e2005-04-16 15:20:36 -07002974 case HCI_EV_DISCONN_COMPLETE:
2975 hci_disconn_complete_evt(hdev, skb);
2976 break;
2977
Linus Torvalds1da177e2005-04-16 15:20:36 -07002978 case HCI_EV_AUTH_COMPLETE:
2979 hci_auth_complete_evt(hdev, skb);
2980 break;
2981
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002982 case HCI_EV_REMOTE_NAME:
2983 hci_remote_name_evt(hdev, skb);
2984 break;
2985
Linus Torvalds1da177e2005-04-16 15:20:36 -07002986 case HCI_EV_ENCRYPT_CHANGE:
2987 hci_encrypt_change_evt(hdev, skb);
2988 break;
2989
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002990 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2991 hci_change_link_key_complete_evt(hdev, skb);
2992 break;
2993
2994 case HCI_EV_REMOTE_FEATURES:
2995 hci_remote_features_evt(hdev, skb);
2996 break;
2997
2998 case HCI_EV_REMOTE_VERSION:
2999 hci_remote_version_evt(hdev, skb);
3000 break;
3001
3002 case HCI_EV_QOS_SETUP_COMPLETE:
3003 hci_qos_setup_complete_evt(hdev, skb);
3004 break;
3005
3006 case HCI_EV_CMD_COMPLETE:
3007 hci_cmd_complete_evt(hdev, skb);
3008 break;
3009
3010 case HCI_EV_CMD_STATUS:
3011 hci_cmd_status_evt(hdev, skb);
3012 break;
3013
3014 case HCI_EV_ROLE_CHANGE:
3015 hci_role_change_evt(hdev, skb);
3016 break;
3017
3018 case HCI_EV_NUM_COMP_PKTS:
3019 hci_num_comp_pkts_evt(hdev, skb);
3020 break;
3021
3022 case HCI_EV_MODE_CHANGE:
3023 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003024 break;
3025
3026 case HCI_EV_PIN_CODE_REQ:
3027 hci_pin_code_request_evt(hdev, skb);
3028 break;
3029
3030 case HCI_EV_LINK_KEY_REQ:
3031 hci_link_key_request_evt(hdev, skb);
3032 break;
3033
3034 case HCI_EV_LINK_KEY_NOTIFY:
3035 hci_link_key_notify_evt(hdev, skb);
3036 break;
3037
3038 case HCI_EV_CLOCK_OFFSET:
3039 hci_clock_offset_evt(hdev, skb);
3040 break;
3041
Marcel Holtmanna8746412008-07-14 20:13:46 +02003042 case HCI_EV_PKT_TYPE_CHANGE:
3043 hci_pkt_type_change_evt(hdev, skb);
3044 break;
3045
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003046 case HCI_EV_PSCAN_REP_MODE:
3047 hci_pscan_rep_mode_evt(hdev, skb);
3048 break;
3049
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003050 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3051 hci_inquiry_result_with_rssi_evt(hdev, skb);
3052 break;
3053
3054 case HCI_EV_REMOTE_EXT_FEATURES:
3055 hci_remote_ext_features_evt(hdev, skb);
3056 break;
3057
3058 case HCI_EV_SYNC_CONN_COMPLETE:
3059 hci_sync_conn_complete_evt(hdev, skb);
3060 break;
3061
3062 case HCI_EV_SYNC_CONN_CHANGED:
3063 hci_sync_conn_changed_evt(hdev, skb);
3064 break;
3065
Marcel Holtmann04837f62006-07-03 10:02:33 +02003066 case HCI_EV_SNIFF_SUBRATE:
3067 hci_sniff_subrate_evt(hdev, skb);
3068 break;
3069
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003070 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3071 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003072 break;
3073
Marcel Holtmann04936842008-07-14 20:13:48 +02003074 case HCI_EV_IO_CAPA_REQUEST:
3075 hci_io_capa_request_evt(hdev, skb);
3076 break;
3077
Johan Hedberg03b555e2011-01-04 15:40:05 +02003078 case HCI_EV_IO_CAPA_REPLY:
3079 hci_io_capa_reply_evt(hdev, skb);
3080 break;
3081
Johan Hedberga5c29682011-02-19 12:05:57 -03003082 case HCI_EV_USER_CONFIRM_REQUEST:
3083 hci_user_confirm_request_evt(hdev, skb);
3084 break;
3085
Marcel Holtmann04936842008-07-14 20:13:48 +02003086 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3087 hci_simple_pair_complete_evt(hdev, skb);
3088 break;
3089
Marcel Holtmann41a96212008-07-14 20:13:48 +02003090 case HCI_EV_REMOTE_HOST_FEATURES:
3091 hci_remote_host_features_evt(hdev, skb);
3092 break;
3093
Ville Tervofcd89c02011-02-10 22:38:47 -03003094 case HCI_EV_LE_META:
3095 hci_le_meta_evt(hdev, skb);
3096 break;
3097
Szymon Janc2763eda2011-03-22 13:12:22 +01003098 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3099 hci_remote_oob_data_request_evt(hdev, skb);
3100 break;
3101
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003102 default:
3103 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003104 break;
3105 }
3106
3107 kfree_skb(skb);
3108 hdev->stat.evt_rx++;
3109}
3110
3111/* Generate internal stack event */
3112void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3113{
3114 struct hci_event_hdr *hdr;
3115 struct hci_ev_stack_internal *ev;
3116 struct sk_buff *skb;
3117
3118 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3119 if (!skb)
3120 return;
3121
3122 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3123 hdr->evt = HCI_EV_STACK_INTERNAL;
3124 hdr->plen = sizeof(*ev) + dlen;
3125
3126 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3127 ev->type = type;
3128 memcpy(ev->data, data, dlen);
3129
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003130 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003131 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003132
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003133 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003134 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003135 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003136 kfree_skb(skb);
3137}
Andre Guedese6100a22011-06-30 19:20:54 -03003138
Gustavo F. Padovan669bb392011-10-11 15:57:01 -03003139module_param(enable_le, bool, 0644);
Andre Guedese6100a22011-06-30 19:20:54 -03003140MODULE_PARM_DESC(enable_le, "Enable LE support");