blob: 41967fec12b7e46ff6752b4795d09ae8319d4fb8 [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{
277 __u8 status = *((__u8 *) skb->data);
278 void *sent;
279
280 BT_DBG("%s status 0x%x", hdev->name, status);
281
282 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
283 if (!sent)
284 return;
285
286 if (!status) {
287 __u8 param = *((__u8 *) sent);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200288 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200289
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200290 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
291 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200292
Johan Hedberg73f22f62010-12-29 16:00:25 +0200293 if (param & SCAN_INQUIRY) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200294 set_bit(HCI_ISCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200295 if (!old_iscan)
296 mgmt_discoverable(hdev->id, 1);
297 } else if (old_iscan)
Johan Hedberg73f22f62010-12-29 16:00:25 +0200298 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200299
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200300 if (param & SCAN_PAGE) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200301 set_bit(HCI_PSCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200302 if (!old_pscan)
303 mgmt_connectable(hdev->id, 1);
304 } else if (old_pscan)
305 mgmt_connectable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200306 }
307
Johan Hedberg23bb5762010-12-21 23:01:27 +0200308 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200309}
310
311static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
312{
313 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
314
315 BT_DBG("%s status 0x%x", hdev->name, rp->status);
316
317 if (rp->status)
318 return;
319
320 memcpy(hdev->dev_class, rp->dev_class, 3);
321
322 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
323 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
324}
325
326static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
327{
328 __u8 status = *((__u8 *) skb->data);
329 void *sent;
330
331 BT_DBG("%s status 0x%x", hdev->name, status);
332
Marcel Holtmannf383f272008-07-14 20:13:47 +0200333 if (status)
334 return;
335
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200336 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
337 if (!sent)
338 return;
339
Marcel Holtmannf383f272008-07-14 20:13:47 +0200340 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200341}
342
343static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
344{
345 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200347
348 BT_DBG("%s status 0x%x", hdev->name, rp->status);
349
350 if (rp->status)
351 return;
352
353 setting = __le16_to_cpu(rp->voice_setting);
354
Marcel Holtmannf383f272008-07-14 20:13:47 +0200355 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200356 return;
357
358 hdev->voice_setting = setting;
359
360 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
361
362 if (hdev->notify) {
363 tasklet_disable(&hdev->tx_task);
364 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
365 tasklet_enable(&hdev->tx_task);
366 }
367}
368
369static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
370{
371 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200372 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 void *sent;
374
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200375 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376
Marcel Holtmannf383f272008-07-14 20:13:47 +0200377 if (status)
378 return;
379
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200380 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
381 if (!sent)
382 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383
Marcel Holtmannf383f272008-07-14 20:13:47 +0200384 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
Marcel Holtmannf383f272008-07-14 20:13:47 +0200386 if (hdev->voice_setting == setting)
387 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Marcel Holtmannf383f272008-07-14 20:13:47 +0200389 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390
Marcel Holtmannf383f272008-07-14 20:13:47 +0200391 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
392
393 if (hdev->notify) {
394 tasklet_disable(&hdev->tx_task);
395 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
396 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397 }
398}
399
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200400static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200402 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200404 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405
Johan Hedberg23bb5762010-12-21 23:01:27 +0200406 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407}
408
Marcel Holtmann333140b2008-07-14 20:13:48 +0200409static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
410{
411 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
412
413 BT_DBG("%s status 0x%x", hdev->name, rp->status);
414
415 if (rp->status)
416 return;
417
418 hdev->ssp_mode = rp->mode;
419}
420
421static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
422{
423 __u8 status = *((__u8 *) skb->data);
424 void *sent;
425
426 BT_DBG("%s status 0x%x", hdev->name, status);
427
428 if (status)
429 return;
430
431 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
432 if (!sent)
433 return;
434
435 hdev->ssp_mode = *((__u8 *) sent);
436}
437
Johan Hedbergd5859e22011-01-25 01:19:58 +0200438static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
439{
440 if (hdev->features[6] & LMP_EXT_INQ)
441 return 2;
442
443 if (hdev->features[3] & LMP_RSSI_INQ)
444 return 1;
445
446 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
447 hdev->lmp_subver == 0x0757)
448 return 1;
449
450 if (hdev->manufacturer == 15) {
451 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
452 return 1;
453 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
454 return 1;
455 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
456 return 1;
457 }
458
459 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
460 hdev->lmp_subver == 0x1805)
461 return 1;
462
463 return 0;
464}
465
466static void hci_setup_inquiry_mode(struct hci_dev *hdev)
467{
468 u8 mode;
469
470 mode = hci_get_inquiry_mode(hdev);
471
472 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
473}
474
475static void hci_setup_event_mask(struct hci_dev *hdev)
476{
477 /* The second byte is 0xff instead of 0x9f (two reserved bits
478 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
479 * command otherwise */
480 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
481
Ville Tervo6de6c182011-05-27 11:16:21 +0300482 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
483 * any event mask for pre 1.2 devices */
484 if (hdev->lmp_ver <= 1)
485 return;
486
487 events[4] |= 0x01; /* Flow Specification Complete */
488 events[4] |= 0x02; /* Inquiry Result with RSSI */
489 events[4] |= 0x04; /* Read Remote Extended Features Complete */
490 events[5] |= 0x08; /* Synchronous Connection Complete */
491 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200492
493 if (hdev->features[3] & LMP_RSSI_INQ)
494 events[4] |= 0x04; /* Inquiry Result with RSSI */
495
496 if (hdev->features[5] & LMP_SNIFF_SUBR)
497 events[5] |= 0x20; /* Sniff Subrating */
498
499 if (hdev->features[5] & LMP_PAUSE_ENC)
500 events[5] |= 0x80; /* Encryption Key Refresh Complete */
501
502 if (hdev->features[6] & LMP_EXT_INQ)
503 events[5] |= 0x40; /* Extended Inquiry Result */
504
505 if (hdev->features[6] & LMP_NO_FLUSH)
506 events[7] |= 0x01; /* Enhanced Flush Complete */
507
508 if (hdev->features[7] & LMP_LSTO)
509 events[6] |= 0x80; /* Link Supervision Timeout Changed */
510
511 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
512 events[6] |= 0x01; /* IO Capability Request */
513 events[6] |= 0x02; /* IO Capability Response */
514 events[6] |= 0x04; /* User Confirmation Request */
515 events[6] |= 0x08; /* User Passkey Request */
516 events[6] |= 0x10; /* Remote OOB Data Request */
517 events[6] |= 0x20; /* Simple Pairing Complete */
518 events[7] |= 0x04; /* User Passkey Notification */
519 events[7] |= 0x08; /* Keypress Notification */
520 events[7] |= 0x10; /* Remote Host Supported
521 * Features Notification */
522 }
523
524 if (hdev->features[4] & LMP_LE)
525 events[7] |= 0x20; /* LE Meta-Event */
526
527 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
528}
529
Andre Guedese6100a22011-06-30 19:20:54 -0300530static void hci_set_le_support(struct hci_dev *hdev)
531{
532 struct hci_cp_write_le_host_supported cp;
533
534 memset(&cp, 0, sizeof(cp));
535
536 if (enable_le) {
537 cp.le = 1;
538 cp.simul = !!(hdev->features[6] & LMP_SIMUL_LE_BR);
539 }
540
541 hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(cp), &cp);
542}
543
Johan Hedbergd5859e22011-01-25 01:19:58 +0200544static void hci_setup(struct hci_dev *hdev)
545{
546 hci_setup_event_mask(hdev);
547
548 if (hdev->lmp_ver > 1)
549 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
550
551 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
552 u8 mode = 0x01;
553 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
554 }
555
556 if (hdev->features[3] & LMP_RSSI_INQ)
557 hci_setup_inquiry_mode(hdev);
558
559 if (hdev->features[7] & LMP_INQ_TX_PWR)
560 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
Andre Guedes971e3a42011-06-30 19:20:52 -0300561
562 if (hdev->features[7] & LMP_EXTFEATURES) {
563 struct hci_cp_read_local_ext_features cp;
564
565 cp.page = 0x01;
566 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES,
567 sizeof(cp), &cp);
568 }
Andre Guedese6100a22011-06-30 19:20:54 -0300569
570 if (hdev->features[4] & LMP_LE)
571 hci_set_le_support(hdev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200572}
573
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200574static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
575{
576 struct hci_rp_read_local_version *rp = (void *) skb->data;
577
578 BT_DBG("%s status 0x%x", hdev->name, rp->status);
579
580 if (rp->status)
581 return;
582
583 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200584 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200585 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200586 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200587 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200588
589 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
590 hdev->manufacturer,
591 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200592
593 if (test_bit(HCI_INIT, &hdev->flags))
594 hci_setup(hdev);
595}
596
597static void hci_setup_link_policy(struct hci_dev *hdev)
598{
599 u16 link_policy = 0;
600
601 if (hdev->features[0] & LMP_RSWITCH)
602 link_policy |= HCI_LP_RSWITCH;
603 if (hdev->features[0] & LMP_HOLD)
604 link_policy |= HCI_LP_HOLD;
605 if (hdev->features[0] & LMP_SNIFF)
606 link_policy |= HCI_LP_SNIFF;
607 if (hdev->features[1] & LMP_PARK)
608 link_policy |= HCI_LP_PARK;
609
610 link_policy = cpu_to_le16(link_policy);
611 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
612 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200613}
614
615static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
616{
617 struct hci_rp_read_local_commands *rp = (void *) skb->data;
618
619 BT_DBG("%s status 0x%x", hdev->name, rp->status);
620
621 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200622 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200623
624 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200625
626 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
627 hci_setup_link_policy(hdev);
628
629done:
630 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200631}
632
633static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
634{
635 struct hci_rp_read_local_features *rp = (void *) skb->data;
636
637 BT_DBG("%s status 0x%x", hdev->name, rp->status);
638
639 if (rp->status)
640 return;
641
642 memcpy(hdev->features, rp->features, 8);
643
644 /* Adjust default settings according to features
645 * supported by device. */
646
647 if (hdev->features[0] & LMP_3SLOT)
648 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
649
650 if (hdev->features[0] & LMP_5SLOT)
651 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
652
653 if (hdev->features[1] & LMP_HV2) {
654 hdev->pkt_type |= (HCI_HV2);
655 hdev->esco_type |= (ESCO_HV2);
656 }
657
658 if (hdev->features[1] & LMP_HV3) {
659 hdev->pkt_type |= (HCI_HV3);
660 hdev->esco_type |= (ESCO_HV3);
661 }
662
663 if (hdev->features[3] & LMP_ESCO)
664 hdev->esco_type |= (ESCO_EV3);
665
666 if (hdev->features[4] & LMP_EV4)
667 hdev->esco_type |= (ESCO_EV4);
668
669 if (hdev->features[4] & LMP_EV5)
670 hdev->esco_type |= (ESCO_EV5);
671
Marcel Holtmannefc76882009-02-06 09:13:37 +0100672 if (hdev->features[5] & LMP_EDR_ESCO_2M)
673 hdev->esco_type |= (ESCO_2EV3);
674
675 if (hdev->features[5] & LMP_EDR_ESCO_3M)
676 hdev->esco_type |= (ESCO_3EV3);
677
678 if (hdev->features[5] & LMP_EDR_3S_ESCO)
679 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
680
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200681 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
682 hdev->features[0], hdev->features[1],
683 hdev->features[2], hdev->features[3],
684 hdev->features[4], hdev->features[5],
685 hdev->features[6], hdev->features[7]);
686}
687
Andre Guedes971e3a42011-06-30 19:20:52 -0300688static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
689 struct sk_buff *skb)
690{
691 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
692
693 BT_DBG("%s status 0x%x", hdev->name, rp->status);
694
695 if (rp->status)
696 return;
697
698 memcpy(hdev->extfeatures, rp->features, 8);
699
700 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
701}
702
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200703static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
704{
705 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
706
707 BT_DBG("%s status 0x%x", hdev->name, rp->status);
708
709 if (rp->status)
710 return;
711
712 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
713 hdev->sco_mtu = rp->sco_mtu;
714 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
715 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
716
717 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
718 hdev->sco_mtu = 64;
719 hdev->sco_pkts = 8;
720 }
721
722 hdev->acl_cnt = hdev->acl_pkts;
723 hdev->sco_cnt = hdev->sco_pkts;
724
725 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
726 hdev->acl_mtu, hdev->acl_pkts,
727 hdev->sco_mtu, hdev->sco_pkts);
728}
729
730static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
731{
732 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
733
734 BT_DBG("%s status 0x%x", hdev->name, rp->status);
735
736 if (!rp->status)
737 bacpy(&hdev->bdaddr, &rp->bdaddr);
738
Johan Hedberg23bb5762010-12-21 23:01:27 +0200739 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
740}
741
742static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
743{
744 __u8 status = *((__u8 *) skb->data);
745
746 BT_DBG("%s status 0x%x", hdev->name, status);
747
748 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200749}
750
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300751static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
752 struct sk_buff *skb)
753{
754 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
755
756 BT_DBG("%s status 0x%x", hdev->name, rp->status);
757
758 if (rp->status)
759 return;
760
761 hdev->amp_status = rp->amp_status;
762 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
763 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
764 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
765 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
766 hdev->amp_type = rp->amp_type;
767 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
768 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
769 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
770 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
771
772 hci_req_complete(hdev, HCI_OP_READ_LOCAL_AMP_INFO, rp->status);
773}
774
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200775static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
776 struct sk_buff *skb)
777{
778 __u8 status = *((__u8 *) skb->data);
779
780 BT_DBG("%s status 0x%x", hdev->name, status);
781
782 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
783}
784
Johan Hedbergd5859e22011-01-25 01:19:58 +0200785static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
786{
787 __u8 status = *((__u8 *) skb->data);
788
789 BT_DBG("%s status 0x%x", hdev->name, status);
790
791 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
792}
793
794static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
795 struct sk_buff *skb)
796{
797 __u8 status = *((__u8 *) skb->data);
798
799 BT_DBG("%s status 0x%x", hdev->name, status);
800
801 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
802}
803
804static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
805 struct sk_buff *skb)
806{
807 __u8 status = *((__u8 *) skb->data);
808
809 BT_DBG("%s status 0x%x", hdev->name, status);
810
811 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
812}
813
814static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
815{
816 __u8 status = *((__u8 *) skb->data);
817
818 BT_DBG("%s status 0x%x", hdev->name, status);
819
820 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
821}
822
Johan Hedberg980e1a52011-01-22 06:10:07 +0200823static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
824{
825 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
826 struct hci_cp_pin_code_reply *cp;
827 struct hci_conn *conn;
828
829 BT_DBG("%s status 0x%x", hdev->name, rp->status);
830
831 if (test_bit(HCI_MGMT, &hdev->flags))
832 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
833
834 if (rp->status != 0)
835 return;
836
837 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
838 if (!cp)
839 return;
840
841 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
842 if (conn)
843 conn->pin_length = cp->pin_len;
844}
845
846static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
847{
848 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
849
850 BT_DBG("%s status 0x%x", hdev->name, rp->status);
851
852 if (test_bit(HCI_MGMT, &hdev->flags))
853 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
854 rp->status);
855}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300856static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
857 struct sk_buff *skb)
858{
859 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
860
861 BT_DBG("%s status 0x%x", hdev->name, rp->status);
862
863 if (rp->status)
864 return;
865
866 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
867 hdev->le_pkts = rp->le_max_pkt;
868
869 hdev->le_cnt = hdev->le_pkts;
870
871 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
872
873 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
874}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200875
Johan Hedberga5c29682011-02-19 12:05:57 -0300876static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
877{
878 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
879
880 BT_DBG("%s status 0x%x", hdev->name, rp->status);
881
882 if (test_bit(HCI_MGMT, &hdev->flags))
883 mgmt_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
884 rp->status);
885}
886
887static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
888 struct sk_buff *skb)
889{
890 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
891
892 BT_DBG("%s status 0x%x", hdev->name, rp->status);
893
894 if (test_bit(HCI_MGMT, &hdev->flags))
895 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
896 rp->status);
897}
898
Szymon Jancc35938b2011-03-22 13:12:21 +0100899static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
900 struct sk_buff *skb)
901{
902 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
903
904 BT_DBG("%s status 0x%x", hdev->name, rp->status);
905
906 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
907 rp->randomizer, rp->status);
908}
909
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300910static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
911 struct sk_buff *skb)
912{
913 struct hci_cp_le_set_scan_enable *cp;
914 __u8 status = *((__u8 *) skb->data);
915
916 BT_DBG("%s status 0x%x", hdev->name, status);
917
918 if (status)
919 return;
920
921 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
922 if (!cp)
923 return;
924
Andre Guedes35815082011-05-26 16:23:53 -0300925 if (cp->enable == 0x01) {
926 del_timer(&hdev->adv_timer);
Andre Guedesa8f13c82011-09-09 18:56:24 -0300927
928 hci_dev_lock(hdev);
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300929 hci_adv_entries_clear(hdev);
Andre Guedesa8f13c82011-09-09 18:56:24 -0300930 hci_dev_unlock(hdev);
Andre Guedes35815082011-05-26 16:23:53 -0300931 } else if (cp->enable == 0x00) {
932 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
933 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300934}
935
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300936static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
937{
938 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
939
940 BT_DBG("%s status 0x%x", hdev->name, rp->status);
941
942 if (rp->status)
943 return;
944
945 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
946}
947
948static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
949{
950 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
951
952 BT_DBG("%s status 0x%x", hdev->name, rp->status);
953
954 if (rp->status)
955 return;
956
957 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
958}
959
Andre Guedesf9b49302011-06-30 19:20:53 -0300960static inline void hci_cc_write_le_host_supported(struct hci_dev *hdev,
961 struct sk_buff *skb)
962{
963 struct hci_cp_read_local_ext_features cp;
964 __u8 status = *((__u8 *) skb->data);
965
966 BT_DBG("%s status 0x%x", hdev->name, status);
967
968 if (status)
969 return;
970
971 cp.page = 0x01;
972 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp), &cp);
973}
974
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200975static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
976{
977 BT_DBG("%s status 0x%x", hdev->name, status);
978
979 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200980 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200981 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -0400982 return;
983 }
984
Oliver Neukum2d20a262011-08-30 15:52:18 +0200985 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags) &&
986 test_bit(HCI_MGMT, &hdev->flags))
Johan Hedberg314b2382011-04-27 10:29:57 -0400987 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200988}
989
Linus Torvalds1da177e2005-04-16 15:20:36 -0700990static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
991{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200992 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200995 BT_DBG("%s status 0x%x", hdev->name, status);
996
997 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998 if (!cp)
999 return;
1000
1001 hci_dev_lock(hdev);
1002
1003 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1004
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001005 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006
1007 if (status) {
1008 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001009 if (status != 0x0c || conn->attempt > 2) {
1010 conn->state = BT_CLOSED;
1011 hci_proto_connect_cfm(conn, status);
1012 hci_conn_del(conn);
1013 } else
1014 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001015 }
1016 } else {
1017 if (!conn) {
1018 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1019 if (conn) {
1020 conn->out = 1;
1021 conn->link_mode |= HCI_LM_MASTER;
1022 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001023 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024 }
1025 }
1026
1027 hci_dev_unlock(hdev);
1028}
1029
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001030static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001031{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001032 struct hci_cp_add_sco *cp;
1033 struct hci_conn *acl, *sco;
1034 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001035
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001036 BT_DBG("%s status 0x%x", hdev->name, status);
1037
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001038 if (!status)
1039 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001040
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001041 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1042 if (!cp)
1043 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001045 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001046
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001047 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001048
1049 hci_dev_lock(hdev);
1050
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001051 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001052 if (acl) {
1053 sco = acl->link;
1054 if (sco) {
1055 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001056
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001057 hci_proto_connect_cfm(sco, status);
1058 hci_conn_del(sco);
1059 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001060 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001061
1062 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001063}
1064
Marcel Holtmannf8558552008-07-14 20:13:49 +02001065static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1066{
1067 struct hci_cp_auth_requested *cp;
1068 struct hci_conn *conn;
1069
1070 BT_DBG("%s status 0x%x", hdev->name, status);
1071
1072 if (!status)
1073 return;
1074
1075 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1076 if (!cp)
1077 return;
1078
1079 hci_dev_lock(hdev);
1080
1081 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1082 if (conn) {
1083 if (conn->state == BT_CONFIG) {
1084 hci_proto_connect_cfm(conn, status);
1085 hci_conn_put(conn);
1086 }
1087 }
1088
1089 hci_dev_unlock(hdev);
1090}
1091
1092static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1093{
1094 struct hci_cp_set_conn_encrypt *cp;
1095 struct hci_conn *conn;
1096
1097 BT_DBG("%s status 0x%x", hdev->name, status);
1098
1099 if (!status)
1100 return;
1101
1102 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1103 if (!cp)
1104 return;
1105
1106 hci_dev_lock(hdev);
1107
1108 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1109 if (conn) {
1110 if (conn->state == BT_CONFIG) {
1111 hci_proto_connect_cfm(conn, status);
1112 hci_conn_put(conn);
1113 }
1114 }
1115
1116 hci_dev_unlock(hdev);
1117}
1118
Johan Hedberg127178d2010-11-18 22:22:29 +02001119static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001120 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001121{
Johan Hedberg392599b2010-11-18 22:22:28 +02001122 if (conn->state != BT_CONFIG || !conn->out)
1123 return 0;
1124
Johan Hedberg765c2a92011-01-19 12:06:52 +05301125 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001126 return 0;
1127
1128 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001129 * devices with sec_level HIGH or if MITM protection is requested */
Johan Hedberg392599b2010-11-18 22:22:28 +02001130 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001131 conn->pending_sec_level != BT_SECURITY_HIGH &&
1132 !(conn->auth_type & 0x01))
Johan Hedberg392599b2010-11-18 22:22:28 +02001133 return 0;
1134
Johan Hedberg392599b2010-11-18 22:22:28 +02001135 return 1;
1136}
1137
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001138static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1139{
Johan Hedberg127178d2010-11-18 22:22:29 +02001140 struct hci_cp_remote_name_req *cp;
1141 struct hci_conn *conn;
1142
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001143 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001144
1145 /* If successful wait for the name req complete event before
1146 * checking for the need to do authentication */
1147 if (!status)
1148 return;
1149
1150 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1151 if (!cp)
1152 return;
1153
1154 hci_dev_lock(hdev);
1155
1156 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001157 if (!conn)
1158 goto unlock;
1159
1160 if (!hci_outgoing_auth_needed(hdev, conn))
1161 goto unlock;
1162
1163 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001164 struct hci_cp_auth_requested cp;
1165 cp.handle = __cpu_to_le16(conn->handle);
1166 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1167 }
1168
Johan Hedberg79c6c702011-04-28 11:28:55 -07001169unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001170 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001171}
1172
Marcel Holtmann769be972008-07-14 20:13:49 +02001173static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1174{
1175 struct hci_cp_read_remote_features *cp;
1176 struct hci_conn *conn;
1177
1178 BT_DBG("%s status 0x%x", hdev->name, status);
1179
1180 if (!status)
1181 return;
1182
1183 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1184 if (!cp)
1185 return;
1186
1187 hci_dev_lock(hdev);
1188
1189 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1190 if (conn) {
1191 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001192 hci_proto_connect_cfm(conn, status);
1193 hci_conn_put(conn);
1194 }
1195 }
1196
1197 hci_dev_unlock(hdev);
1198}
1199
1200static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1201{
1202 struct hci_cp_read_remote_ext_features *cp;
1203 struct hci_conn *conn;
1204
1205 BT_DBG("%s status 0x%x", hdev->name, status);
1206
1207 if (!status)
1208 return;
1209
1210 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1211 if (!cp)
1212 return;
1213
1214 hci_dev_lock(hdev);
1215
1216 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1217 if (conn) {
1218 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001219 hci_proto_connect_cfm(conn, status);
1220 hci_conn_put(conn);
1221 }
1222 }
1223
1224 hci_dev_unlock(hdev);
1225}
1226
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001227static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1228{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001229 struct hci_cp_setup_sync_conn *cp;
1230 struct hci_conn *acl, *sco;
1231 __u16 handle;
1232
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001233 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001234
1235 if (!status)
1236 return;
1237
1238 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1239 if (!cp)
1240 return;
1241
1242 handle = __le16_to_cpu(cp->handle);
1243
1244 BT_DBG("%s handle %d", hdev->name, handle);
1245
1246 hci_dev_lock(hdev);
1247
1248 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001249 if (acl) {
1250 sco = acl->link;
1251 if (sco) {
1252 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001253
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001254 hci_proto_connect_cfm(sco, status);
1255 hci_conn_del(sco);
1256 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001257 }
1258
1259 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001260}
1261
1262static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1263{
1264 struct hci_cp_sniff_mode *cp;
1265 struct hci_conn *conn;
1266
1267 BT_DBG("%s status 0x%x", hdev->name, status);
1268
1269 if (!status)
1270 return;
1271
1272 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1273 if (!cp)
1274 return;
1275
1276 hci_dev_lock(hdev);
1277
1278 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001279 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001280 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1281
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001282 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1283 hci_sco_setup(conn, status);
1284 }
1285
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001286 hci_dev_unlock(hdev);
1287}
1288
1289static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1290{
1291 struct hci_cp_exit_sniff_mode *cp;
1292 struct hci_conn *conn;
1293
1294 BT_DBG("%s status 0x%x", hdev->name, status);
1295
1296 if (!status)
1297 return;
1298
1299 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1300 if (!cp)
1301 return;
1302
1303 hci_dev_lock(hdev);
1304
1305 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001306 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001307 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1308
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001309 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1310 hci_sco_setup(conn, status);
1311 }
1312
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001313 hci_dev_unlock(hdev);
1314}
1315
Ville Tervofcd89c02011-02-10 22:38:47 -03001316static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1317{
1318 struct hci_cp_le_create_conn *cp;
1319 struct hci_conn *conn;
1320
1321 BT_DBG("%s status 0x%x", hdev->name, status);
1322
1323 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1324 if (!cp)
1325 return;
1326
1327 hci_dev_lock(hdev);
1328
1329 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1330
1331 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1332 conn);
1333
1334 if (status) {
1335 if (conn && conn->state == BT_CONNECT) {
1336 conn->state = BT_CLOSED;
1337 hci_proto_connect_cfm(conn, status);
1338 hci_conn_del(conn);
1339 }
1340 } else {
1341 if (!conn) {
1342 conn = hci_conn_add(hdev, LE_LINK, &cp->peer_addr);
Andre Guedes29b79882011-05-31 14:20:54 -03001343 if (conn) {
1344 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001345 conn->out = 1;
Andre Guedes29b79882011-05-31 14:20:54 -03001346 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001347 BT_ERR("No memory for new connection");
Andre Guedes29b79882011-05-31 14:20:54 -03001348 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001349 }
1350 }
1351
1352 hci_dev_unlock(hdev);
1353}
1354
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001355static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1356{
1357 BT_DBG("%s status 0x%x", hdev->name, status);
1358}
1359
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001360static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1361{
1362 __u8 status = *((__u8 *) skb->data);
1363
1364 BT_DBG("%s status %d", hdev->name, status);
1365
Oliver Neukum2d20a262011-08-30 15:52:18 +02001366 if (test_and_clear_bit(HCI_INQUIRY, &hdev->flags) &&
1367 test_bit(HCI_MGMT, &hdev->flags))
Johan Hedberg314b2382011-04-27 10:29:57 -04001368 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001369
Johan Hedberg23bb5762010-12-21 23:01:27 +02001370 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001371
1372 hci_conn_check_pending(hdev);
1373}
1374
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1376{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001377 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001378 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001379 int num_rsp = *((__u8 *) skb->data);
1380
1381 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1382
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001383 if (!num_rsp)
1384 return;
1385
Linus Torvalds1da177e2005-04-16 15:20:36 -07001386 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001387
Johan Hedberg314b2382011-04-27 10:29:57 -04001388 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
1389
1390 if (test_bit(HCI_MGMT, &hdev->flags))
1391 mgmt_discovering(hdev->id, 1);
1392 }
1393
Johan Hedberge17acd42011-03-30 23:57:16 +03001394 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395 bacpy(&data.bdaddr, &info->bdaddr);
1396 data.pscan_rep_mode = info->pscan_rep_mode;
1397 data.pscan_period_mode = info->pscan_period_mode;
1398 data.pscan_mode = info->pscan_mode;
1399 memcpy(data.dev_class, info->dev_class, 3);
1400 data.clock_offset = info->clock_offset;
1401 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001402 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001403 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03001404 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class, 0,
1405 NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001407
Linus Torvalds1da177e2005-04-16 15:20:36 -07001408 hci_dev_unlock(hdev);
1409}
1410
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001411static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001412{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001413 struct hci_ev_conn_complete *ev = (void *) skb->data;
1414 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001415
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001416 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001417
Linus Torvalds1da177e2005-04-16 15:20:36 -07001418 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001419
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001420 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001421 if (!conn) {
1422 if (ev->link_type != SCO_LINK)
1423 goto unlock;
1424
1425 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1426 if (!conn)
1427 goto unlock;
1428
1429 conn->type = SCO_LINK;
1430 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001431
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001432 if (!ev->status) {
1433 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001434
1435 if (conn->type == ACL_LINK) {
1436 conn->state = BT_CONFIG;
1437 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001438 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Vinicius Costa Gomescfafccf2011-08-19 21:06:56 -03001439 mgmt_connected(hdev->id, &ev->bdaddr, conn->type);
Marcel Holtmann769be972008-07-14 20:13:49 +02001440 } else
1441 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001442
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001443 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001444 hci_conn_add_sysfs(conn);
1445
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001446 if (test_bit(HCI_AUTH, &hdev->flags))
1447 conn->link_mode |= HCI_LM_AUTH;
1448
1449 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1450 conn->link_mode |= HCI_LM_ENCRYPT;
1451
1452 /* Get remote features */
1453 if (conn->type == ACL_LINK) {
1454 struct hci_cp_read_remote_features cp;
1455 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001456 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1457 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001458 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001459
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001460 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001461 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001462 struct hci_cp_change_conn_ptype cp;
1463 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001464 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1465 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1466 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001467 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001468 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001469 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001470 if (conn->type == ACL_LINK)
1471 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1472 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001473
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001474 if (conn->type == ACL_LINK)
1475 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001476
Marcel Holtmann769be972008-07-14 20:13:49 +02001477 if (ev->status) {
1478 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001479 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001480 } else if (ev->link_type != ACL_LINK)
1481 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001482
1483unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001484 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001485
1486 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001487}
1488
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1490{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001491 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492 int mask = hdev->link_mode;
1493
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001494 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1495 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001496
1497 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1498
Szymon Janc138d22e2011-02-17 16:44:23 +01001499 if ((mask & HCI_LM_ACCEPT) &&
1500 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001501 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001502 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001503 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504
1505 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001506
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001507 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1508 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001509 memcpy(ie->data.dev_class, ev->dev_class, 3);
1510
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1512 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001513 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1514 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001515 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001516 hci_dev_unlock(hdev);
1517 return;
1518 }
1519 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001520
Linus Torvalds1da177e2005-04-16 15:20:36 -07001521 memcpy(conn->dev_class, ev->dev_class, 3);
1522 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001523
Linus Torvalds1da177e2005-04-16 15:20:36 -07001524 hci_dev_unlock(hdev);
1525
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001526 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1527 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001529 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001531 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1532 cp.role = 0x00; /* Become master */
1533 else
1534 cp.role = 0x01; /* Remain slave */
1535
1536 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1537 sizeof(cp), &cp);
1538 } else {
1539 struct hci_cp_accept_sync_conn_req cp;
1540
1541 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001542 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001543
1544 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1545 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1546 cp.max_latency = cpu_to_le16(0xffff);
1547 cp.content_format = cpu_to_le16(hdev->voice_setting);
1548 cp.retrans_effort = 0xff;
1549
1550 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1551 sizeof(cp), &cp);
1552 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001553 } else {
1554 /* Connection rejected */
1555 struct hci_cp_reject_conn_req cp;
1556
1557 bacpy(&cp.bdaddr, &ev->bdaddr);
1558 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001559 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001560 }
1561}
1562
Linus Torvalds1da177e2005-04-16 15:20:36 -07001563static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1564{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001565 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001566 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001567
1568 BT_DBG("%s status %d", hdev->name, ev->status);
1569
Johan Hedberg8962ee72011-01-20 12:40:27 +02001570 if (ev->status) {
1571 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001572 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001573 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001574
1575 hci_dev_lock(hdev);
1576
Marcel Holtmann04837f62006-07-03 10:02:33 +02001577 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001578 if (!conn)
1579 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001580
Johan Hedbergf7520542011-01-20 12:34:39 +02001581 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001582
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001583 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedbergf7520542011-01-20 12:34:39 +02001584 mgmt_disconnected(hdev->id, &conn->dst);
1585
1586 hci_proto_disconn_cfm(conn, ev->reason);
1587 hci_conn_del(conn);
1588
1589unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 hci_dev_unlock(hdev);
1591}
1592
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001593static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1594{
1595 struct hci_ev_auth_complete *ev = (void *) skb->data;
1596 struct hci_conn *conn;
1597
1598 BT_DBG("%s status %d", hdev->name, ev->status);
1599
1600 hci_dev_lock(hdev);
1601
1602 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001603 if (!conn)
1604 goto unlock;
1605
1606 if (!ev->status) {
1607 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1608 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1609 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001610 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001611 conn->link_mode |= HCI_LM_AUTH;
1612 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001613 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001614 } else {
1615 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1616 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001617
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001618 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1619 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001620
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001621 if (conn->state == BT_CONFIG) {
1622 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1623 struct hci_cp_set_conn_encrypt cp;
1624 cp.handle = ev->handle;
1625 cp.encrypt = 0x01;
1626 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1627 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001628 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001629 conn->state = BT_CONNECTED;
1630 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001631 hci_conn_put(conn);
1632 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001633 } else {
1634 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001635
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001636 hci_conn_hold(conn);
1637 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1638 hci_conn_put(conn);
1639 }
1640
1641 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1642 if (!ev->status) {
1643 struct hci_cp_set_conn_encrypt cp;
1644 cp.handle = ev->handle;
1645 cp.encrypt = 0x01;
1646 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1647 &cp);
1648 } else {
1649 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1650 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001651 }
1652 }
1653
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001654unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001655 hci_dev_unlock(hdev);
1656}
1657
1658static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1659{
Johan Hedberg127178d2010-11-18 22:22:29 +02001660 struct hci_ev_remote_name *ev = (void *) skb->data;
1661 struct hci_conn *conn;
1662
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001663 BT_DBG("%s", hdev->name);
1664
1665 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001666
1667 hci_dev_lock(hdev);
1668
Johan Hedberga88a9652011-03-30 13:18:12 +03001669 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1670 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1671
Johan Hedberg127178d2010-11-18 22:22:29 +02001672 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001673 if (!conn)
1674 goto unlock;
1675
1676 if (!hci_outgoing_auth_needed(hdev, conn))
1677 goto unlock;
1678
1679 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001680 struct hci_cp_auth_requested cp;
1681 cp.handle = __cpu_to_le16(conn->handle);
1682 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1683 }
1684
Johan Hedberg79c6c702011-04-28 11:28:55 -07001685unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001686 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001687}
1688
1689static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1690{
1691 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1692 struct hci_conn *conn;
1693
1694 BT_DBG("%s status %d", hdev->name, ev->status);
1695
1696 hci_dev_lock(hdev);
1697
1698 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1699 if (conn) {
1700 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001701 if (ev->encrypt) {
1702 /* Encryption implies authentication */
1703 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001704 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03001705 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001706 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001707 conn->link_mode &= ~HCI_LM_ENCRYPT;
1708 }
1709
1710 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1711
Marcel Holtmannf8558552008-07-14 20:13:49 +02001712 if (conn->state == BT_CONFIG) {
1713 if (!ev->status)
1714 conn->state = BT_CONNECTED;
1715
1716 hci_proto_connect_cfm(conn, ev->status);
1717 hci_conn_put(conn);
1718 } else
1719 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001720 }
1721
1722 hci_dev_unlock(hdev);
1723}
1724
1725static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1726{
1727 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1728 struct hci_conn *conn;
1729
1730 BT_DBG("%s status %d", hdev->name, ev->status);
1731
1732 hci_dev_lock(hdev);
1733
1734 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1735 if (conn) {
1736 if (!ev->status)
1737 conn->link_mode |= HCI_LM_SECURE;
1738
1739 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1740
1741 hci_key_change_cfm(conn, ev->status);
1742 }
1743
1744 hci_dev_unlock(hdev);
1745}
1746
1747static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1748{
1749 struct hci_ev_remote_features *ev = (void *) skb->data;
1750 struct hci_conn *conn;
1751
1752 BT_DBG("%s status %d", hdev->name, ev->status);
1753
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001754 hci_dev_lock(hdev);
1755
1756 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001757 if (!conn)
1758 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001759
Johan Hedbergccd556f2010-11-10 17:11:51 +02001760 if (!ev->status)
1761 memcpy(conn->features, ev->features, 8);
1762
1763 if (conn->state != BT_CONFIG)
1764 goto unlock;
1765
1766 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1767 struct hci_cp_read_remote_ext_features cp;
1768 cp.handle = ev->handle;
1769 cp.page = 0x01;
1770 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001771 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001772 goto unlock;
1773 }
1774
Johan Hedberg127178d2010-11-18 22:22:29 +02001775 if (!ev->status) {
1776 struct hci_cp_remote_name_req cp;
1777 memset(&cp, 0, sizeof(cp));
1778 bacpy(&cp.bdaddr, &conn->dst);
1779 cp.pscan_rep_mode = 0x02;
1780 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1781 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001782
Johan Hedberg127178d2010-11-18 22:22:29 +02001783 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001784 conn->state = BT_CONNECTED;
1785 hci_proto_connect_cfm(conn, ev->status);
1786 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001787 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001788
Johan Hedbergccd556f2010-11-10 17:11:51 +02001789unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001790 hci_dev_unlock(hdev);
1791}
1792
1793static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1794{
1795 BT_DBG("%s", hdev->name);
1796}
1797
1798static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1799{
1800 BT_DBG("%s", hdev->name);
1801}
1802
1803static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1804{
1805 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1806 __u16 opcode;
1807
1808 skb_pull(skb, sizeof(*ev));
1809
1810 opcode = __le16_to_cpu(ev->opcode);
1811
1812 switch (opcode) {
1813 case HCI_OP_INQUIRY_CANCEL:
1814 hci_cc_inquiry_cancel(hdev, skb);
1815 break;
1816
1817 case HCI_OP_EXIT_PERIODIC_INQ:
1818 hci_cc_exit_periodic_inq(hdev, skb);
1819 break;
1820
1821 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1822 hci_cc_remote_name_req_cancel(hdev, skb);
1823 break;
1824
1825 case HCI_OP_ROLE_DISCOVERY:
1826 hci_cc_role_discovery(hdev, skb);
1827 break;
1828
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001829 case HCI_OP_READ_LINK_POLICY:
1830 hci_cc_read_link_policy(hdev, skb);
1831 break;
1832
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001833 case HCI_OP_WRITE_LINK_POLICY:
1834 hci_cc_write_link_policy(hdev, skb);
1835 break;
1836
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001837 case HCI_OP_READ_DEF_LINK_POLICY:
1838 hci_cc_read_def_link_policy(hdev, skb);
1839 break;
1840
1841 case HCI_OP_WRITE_DEF_LINK_POLICY:
1842 hci_cc_write_def_link_policy(hdev, skb);
1843 break;
1844
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001845 case HCI_OP_RESET:
1846 hci_cc_reset(hdev, skb);
1847 break;
1848
1849 case HCI_OP_WRITE_LOCAL_NAME:
1850 hci_cc_write_local_name(hdev, skb);
1851 break;
1852
1853 case HCI_OP_READ_LOCAL_NAME:
1854 hci_cc_read_local_name(hdev, skb);
1855 break;
1856
1857 case HCI_OP_WRITE_AUTH_ENABLE:
1858 hci_cc_write_auth_enable(hdev, skb);
1859 break;
1860
1861 case HCI_OP_WRITE_ENCRYPT_MODE:
1862 hci_cc_write_encrypt_mode(hdev, skb);
1863 break;
1864
1865 case HCI_OP_WRITE_SCAN_ENABLE:
1866 hci_cc_write_scan_enable(hdev, skb);
1867 break;
1868
1869 case HCI_OP_READ_CLASS_OF_DEV:
1870 hci_cc_read_class_of_dev(hdev, skb);
1871 break;
1872
1873 case HCI_OP_WRITE_CLASS_OF_DEV:
1874 hci_cc_write_class_of_dev(hdev, skb);
1875 break;
1876
1877 case HCI_OP_READ_VOICE_SETTING:
1878 hci_cc_read_voice_setting(hdev, skb);
1879 break;
1880
1881 case HCI_OP_WRITE_VOICE_SETTING:
1882 hci_cc_write_voice_setting(hdev, skb);
1883 break;
1884
1885 case HCI_OP_HOST_BUFFER_SIZE:
1886 hci_cc_host_buffer_size(hdev, skb);
1887 break;
1888
Marcel Holtmann333140b2008-07-14 20:13:48 +02001889 case HCI_OP_READ_SSP_MODE:
1890 hci_cc_read_ssp_mode(hdev, skb);
1891 break;
1892
1893 case HCI_OP_WRITE_SSP_MODE:
1894 hci_cc_write_ssp_mode(hdev, skb);
1895 break;
1896
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001897 case HCI_OP_READ_LOCAL_VERSION:
1898 hci_cc_read_local_version(hdev, skb);
1899 break;
1900
1901 case HCI_OP_READ_LOCAL_COMMANDS:
1902 hci_cc_read_local_commands(hdev, skb);
1903 break;
1904
1905 case HCI_OP_READ_LOCAL_FEATURES:
1906 hci_cc_read_local_features(hdev, skb);
1907 break;
1908
Andre Guedes971e3a42011-06-30 19:20:52 -03001909 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1910 hci_cc_read_local_ext_features(hdev, skb);
1911 break;
1912
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001913 case HCI_OP_READ_BUFFER_SIZE:
1914 hci_cc_read_buffer_size(hdev, skb);
1915 break;
1916
1917 case HCI_OP_READ_BD_ADDR:
1918 hci_cc_read_bd_addr(hdev, skb);
1919 break;
1920
Johan Hedberg23bb5762010-12-21 23:01:27 +02001921 case HCI_OP_WRITE_CA_TIMEOUT:
1922 hci_cc_write_ca_timeout(hdev, skb);
1923 break;
1924
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03001925 case HCI_OP_READ_LOCAL_AMP_INFO:
1926 hci_cc_read_local_amp_info(hdev, skb);
1927 break;
1928
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001929 case HCI_OP_DELETE_STORED_LINK_KEY:
1930 hci_cc_delete_stored_link_key(hdev, skb);
1931 break;
1932
Johan Hedbergd5859e22011-01-25 01:19:58 +02001933 case HCI_OP_SET_EVENT_MASK:
1934 hci_cc_set_event_mask(hdev, skb);
1935 break;
1936
1937 case HCI_OP_WRITE_INQUIRY_MODE:
1938 hci_cc_write_inquiry_mode(hdev, skb);
1939 break;
1940
1941 case HCI_OP_READ_INQ_RSP_TX_POWER:
1942 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1943 break;
1944
1945 case HCI_OP_SET_EVENT_FLT:
1946 hci_cc_set_event_flt(hdev, skb);
1947 break;
1948
Johan Hedberg980e1a52011-01-22 06:10:07 +02001949 case HCI_OP_PIN_CODE_REPLY:
1950 hci_cc_pin_code_reply(hdev, skb);
1951 break;
1952
1953 case HCI_OP_PIN_CODE_NEG_REPLY:
1954 hci_cc_pin_code_neg_reply(hdev, skb);
1955 break;
1956
Szymon Jancc35938b2011-03-22 13:12:21 +01001957 case HCI_OP_READ_LOCAL_OOB_DATA:
1958 hci_cc_read_local_oob_data_reply(hdev, skb);
1959 break;
1960
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001961 case HCI_OP_LE_READ_BUFFER_SIZE:
1962 hci_cc_le_read_buffer_size(hdev, skb);
1963 break;
1964
Johan Hedberga5c29682011-02-19 12:05:57 -03001965 case HCI_OP_USER_CONFIRM_REPLY:
1966 hci_cc_user_confirm_reply(hdev, skb);
1967 break;
1968
1969 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1970 hci_cc_user_confirm_neg_reply(hdev, skb);
1971 break;
1972
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001973 case HCI_OP_LE_SET_SCAN_ENABLE:
1974 hci_cc_le_set_scan_enable(hdev, skb);
1975 break;
1976
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001977 case HCI_OP_LE_LTK_REPLY:
1978 hci_cc_le_ltk_reply(hdev, skb);
1979 break;
1980
1981 case HCI_OP_LE_LTK_NEG_REPLY:
1982 hci_cc_le_ltk_neg_reply(hdev, skb);
1983 break;
1984
Andre Guedesf9b49302011-06-30 19:20:53 -03001985 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
1986 hci_cc_write_le_host_supported(hdev, skb);
1987 break;
1988
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001989 default:
1990 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1991 break;
1992 }
1993
Ville Tervo6bd32322011-02-16 16:32:41 +02001994 if (ev->opcode != HCI_OP_NOP)
1995 del_timer(&hdev->cmd_timer);
1996
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001997 if (ev->ncmd) {
1998 atomic_set(&hdev->cmd_cnt, 1);
1999 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002000 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002001 }
2002}
2003
2004static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
2005{
2006 struct hci_ev_cmd_status *ev = (void *) skb->data;
2007 __u16 opcode;
2008
2009 skb_pull(skb, sizeof(*ev));
2010
2011 opcode = __le16_to_cpu(ev->opcode);
2012
2013 switch (opcode) {
2014 case HCI_OP_INQUIRY:
2015 hci_cs_inquiry(hdev, ev->status);
2016 break;
2017
2018 case HCI_OP_CREATE_CONN:
2019 hci_cs_create_conn(hdev, ev->status);
2020 break;
2021
2022 case HCI_OP_ADD_SCO:
2023 hci_cs_add_sco(hdev, ev->status);
2024 break;
2025
Marcel Holtmannf8558552008-07-14 20:13:49 +02002026 case HCI_OP_AUTH_REQUESTED:
2027 hci_cs_auth_requested(hdev, ev->status);
2028 break;
2029
2030 case HCI_OP_SET_CONN_ENCRYPT:
2031 hci_cs_set_conn_encrypt(hdev, ev->status);
2032 break;
2033
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002034 case HCI_OP_REMOTE_NAME_REQ:
2035 hci_cs_remote_name_req(hdev, ev->status);
2036 break;
2037
Marcel Holtmann769be972008-07-14 20:13:49 +02002038 case HCI_OP_READ_REMOTE_FEATURES:
2039 hci_cs_read_remote_features(hdev, ev->status);
2040 break;
2041
2042 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2043 hci_cs_read_remote_ext_features(hdev, ev->status);
2044 break;
2045
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002046 case HCI_OP_SETUP_SYNC_CONN:
2047 hci_cs_setup_sync_conn(hdev, ev->status);
2048 break;
2049
2050 case HCI_OP_SNIFF_MODE:
2051 hci_cs_sniff_mode(hdev, ev->status);
2052 break;
2053
2054 case HCI_OP_EXIT_SNIFF_MODE:
2055 hci_cs_exit_sniff_mode(hdev, ev->status);
2056 break;
2057
Johan Hedberg8962ee72011-01-20 12:40:27 +02002058 case HCI_OP_DISCONNECT:
2059 if (ev->status != 0)
2060 mgmt_disconnect_failed(hdev->id);
2061 break;
2062
Ville Tervofcd89c02011-02-10 22:38:47 -03002063 case HCI_OP_LE_CREATE_CONN:
2064 hci_cs_le_create_conn(hdev, ev->status);
2065 break;
2066
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002067 case HCI_OP_LE_START_ENC:
2068 hci_cs_le_start_enc(hdev, ev->status);
2069 break;
2070
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002071 default:
2072 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2073 break;
2074 }
2075
Ville Tervo6bd32322011-02-16 16:32:41 +02002076 if (ev->opcode != HCI_OP_NOP)
2077 del_timer(&hdev->cmd_timer);
2078
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002079 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002080 atomic_set(&hdev->cmd_cnt, 1);
2081 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002082 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002083 }
2084}
2085
2086static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2087{
2088 struct hci_ev_role_change *ev = (void *) skb->data;
2089 struct hci_conn *conn;
2090
2091 BT_DBG("%s status %d", hdev->name, ev->status);
2092
2093 hci_dev_lock(hdev);
2094
2095 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2096 if (conn) {
2097 if (!ev->status) {
2098 if (ev->role)
2099 conn->link_mode &= ~HCI_LM_MASTER;
2100 else
2101 conn->link_mode |= HCI_LM_MASTER;
2102 }
2103
2104 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2105
2106 hci_role_switch_cfm(conn, ev->status, ev->role);
2107 }
2108
2109 hci_dev_unlock(hdev);
2110}
2111
Linus Torvalds1da177e2005-04-16 15:20:36 -07002112static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2113{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002114 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002115 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116 int i;
2117
2118 skb_pull(skb, sizeof(*ev));
2119
2120 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2121
2122 if (skb->len < ev->num_hndl * 4) {
2123 BT_DBG("%s bad parameters", hdev->name);
2124 return;
2125 }
2126
2127 tasklet_disable(&hdev->tx_task);
2128
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002129 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002130 struct hci_conn *conn;
2131 __u16 handle, count;
2132
Harvey Harrison83985312008-05-02 16:25:46 -07002133 handle = get_unaligned_le16(ptr++);
2134 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002135
2136 conn = hci_conn_hash_lookup_handle(hdev, handle);
2137 if (conn) {
2138 conn->sent -= count;
2139
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002140 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002141 hdev->acl_cnt += count;
2142 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002143 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002144 } else if (conn->type == LE_LINK) {
2145 if (hdev->le_pkts) {
2146 hdev->le_cnt += count;
2147 if (hdev->le_cnt > hdev->le_pkts)
2148 hdev->le_cnt = hdev->le_pkts;
2149 } else {
2150 hdev->acl_cnt += count;
2151 if (hdev->acl_cnt > hdev->acl_pkts)
2152 hdev->acl_cnt = hdev->acl_pkts;
2153 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002154 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002155 hdev->sco_cnt += count;
2156 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002157 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002158 }
2159 }
2160 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002161
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002162 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002163
2164 tasklet_enable(&hdev->tx_task);
2165}
2166
Marcel Holtmann04837f62006-07-03 10:02:33 +02002167static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002168{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002169 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002170 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002171
2172 BT_DBG("%s status %d", hdev->name, ev->status);
2173
2174 hci_dev_lock(hdev);
2175
Marcel Holtmann04837f62006-07-03 10:02:33 +02002176 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2177 if (conn) {
2178 conn->mode = ev->mode;
2179 conn->interval = __le16_to_cpu(ev->interval);
2180
2181 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2182 if (conn->mode == HCI_CM_ACTIVE)
2183 conn->power_save = 1;
2184 else
2185 conn->power_save = 0;
2186 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002187
2188 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2189 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002190 }
2191
2192 hci_dev_unlock(hdev);
2193}
2194
Linus Torvalds1da177e2005-04-16 15:20:36 -07002195static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2196{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002197 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2198 struct hci_conn *conn;
2199
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002200 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002201
2202 hci_dev_lock(hdev);
2203
2204 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002205 if (!conn)
2206 goto unlock;
2207
2208 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002209 hci_conn_hold(conn);
2210 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2211 hci_conn_put(conn);
2212 }
2213
Johan Hedberg03b555e2011-01-04 15:40:05 +02002214 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2215 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2216 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002217 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002218 u8 secure;
2219
2220 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2221 secure = 1;
2222 else
2223 secure = 0;
2224
2225 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2226 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002227
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002228unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002229 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002230}
2231
Linus Torvalds1da177e2005-04-16 15:20:36 -07002232static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2233{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002234 struct hci_ev_link_key_req *ev = (void *) skb->data;
2235 struct hci_cp_link_key_reply cp;
2236 struct hci_conn *conn;
2237 struct link_key *key;
2238
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002239 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002240
2241 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2242 return;
2243
2244 hci_dev_lock(hdev);
2245
2246 key = hci_find_link_key(hdev, &ev->bdaddr);
2247 if (!key) {
2248 BT_DBG("%s link key not found for %s", hdev->name,
2249 batostr(&ev->bdaddr));
2250 goto not_found;
2251 }
2252
2253 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2254 batostr(&ev->bdaddr));
2255
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002256 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2257 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002258 BT_DBG("%s ignoring debug key", hdev->name);
2259 goto not_found;
2260 }
2261
2262 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002263 if (conn) {
2264 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2265 conn->auth_type != 0xff &&
2266 (conn->auth_type & 0x01)) {
2267 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2268 goto not_found;
2269 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002270
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002271 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2272 conn->pending_sec_level == BT_SECURITY_HIGH) {
2273 BT_DBG("%s ignoring key unauthenticated for high \
2274 security", hdev->name);
2275 goto not_found;
2276 }
2277
2278 conn->key_type = key->type;
2279 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002280 }
2281
2282 bacpy(&cp.bdaddr, &ev->bdaddr);
2283 memcpy(cp.link_key, key->val, 16);
2284
2285 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2286
2287 hci_dev_unlock(hdev);
2288
2289 return;
2290
2291not_found:
2292 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2293 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002294}
2295
Linus Torvalds1da177e2005-04-16 15:20:36 -07002296static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2297{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002298 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2299 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002300 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002301
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002302 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002303
2304 hci_dev_lock(hdev);
2305
2306 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2307 if (conn) {
2308 hci_conn_hold(conn);
2309 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002310 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002311
2312 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2313 conn->key_type = ev->key_type;
2314
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002315 hci_conn_put(conn);
2316 }
2317
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002318 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002319 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002320 ev->key_type, pin_len);
2321
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002322 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002323}
2324
Marcel Holtmann04837f62006-07-03 10:02:33 +02002325static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2326{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002327 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002328 struct hci_conn *conn;
2329
2330 BT_DBG("%s status %d", hdev->name, ev->status);
2331
2332 hci_dev_lock(hdev);
2333
2334 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002335 if (conn && !ev->status) {
2336 struct inquiry_entry *ie;
2337
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002338 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2339 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002340 ie->data.clock_offset = ev->clock_offset;
2341 ie->timestamp = jiffies;
2342 }
2343 }
2344
2345 hci_dev_unlock(hdev);
2346}
2347
Marcel Holtmanna8746412008-07-14 20:13:46 +02002348static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2349{
2350 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2351 struct hci_conn *conn;
2352
2353 BT_DBG("%s status %d", hdev->name, ev->status);
2354
2355 hci_dev_lock(hdev);
2356
2357 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2358 if (conn && !ev->status)
2359 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2360
2361 hci_dev_unlock(hdev);
2362}
2363
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002364static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2365{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002366 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002367 struct inquiry_entry *ie;
2368
2369 BT_DBG("%s", hdev->name);
2370
2371 hci_dev_lock(hdev);
2372
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002373 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2374 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002375 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2376 ie->timestamp = jiffies;
2377 }
2378
2379 hci_dev_unlock(hdev);
2380}
2381
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002382static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2383{
2384 struct inquiry_data data;
2385 int num_rsp = *((__u8 *) skb->data);
2386
2387 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2388
2389 if (!num_rsp)
2390 return;
2391
2392 hci_dev_lock(hdev);
2393
Johan Hedberg314b2382011-04-27 10:29:57 -04002394 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2395
2396 if (test_bit(HCI_MGMT, &hdev->flags))
2397 mgmt_discovering(hdev->id, 1);
2398 }
2399
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002400 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002401 struct inquiry_info_with_rssi_and_pscan_mode *info;
2402 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002403
Johan Hedberge17acd42011-03-30 23:57:16 +03002404 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002405 bacpy(&data.bdaddr, &info->bdaddr);
2406 data.pscan_rep_mode = info->pscan_rep_mode;
2407 data.pscan_period_mode = info->pscan_period_mode;
2408 data.pscan_mode = info->pscan_mode;
2409 memcpy(data.dev_class, info->dev_class, 3);
2410 data.clock_offset = info->clock_offset;
2411 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002412 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002413 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002414 mgmt_device_found(hdev->id, &info->bdaddr,
2415 info->dev_class, info->rssi,
2416 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002417 }
2418 } else {
2419 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2420
Johan Hedberge17acd42011-03-30 23:57:16 +03002421 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002422 bacpy(&data.bdaddr, &info->bdaddr);
2423 data.pscan_rep_mode = info->pscan_rep_mode;
2424 data.pscan_period_mode = info->pscan_period_mode;
2425 data.pscan_mode = 0x00;
2426 memcpy(data.dev_class, info->dev_class, 3);
2427 data.clock_offset = info->clock_offset;
2428 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002429 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002430 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002431 mgmt_device_found(hdev->id, &info->bdaddr,
2432 info->dev_class, info->rssi,
2433 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002434 }
2435 }
2436
2437 hci_dev_unlock(hdev);
2438}
2439
2440static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2441{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002442 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2443 struct hci_conn *conn;
2444
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002445 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002446
Marcel Holtmann41a96212008-07-14 20:13:48 +02002447 hci_dev_lock(hdev);
2448
2449 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002450 if (!conn)
2451 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002452
Johan Hedbergccd556f2010-11-10 17:11:51 +02002453 if (!ev->status && ev->page == 0x01) {
2454 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002455
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002456 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2457 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002458 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002459
Johan Hedbergccd556f2010-11-10 17:11:51 +02002460 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002461 }
2462
Johan Hedbergccd556f2010-11-10 17:11:51 +02002463 if (conn->state != BT_CONFIG)
2464 goto unlock;
2465
Johan Hedberg127178d2010-11-18 22:22:29 +02002466 if (!ev->status) {
2467 struct hci_cp_remote_name_req cp;
2468 memset(&cp, 0, sizeof(cp));
2469 bacpy(&cp.bdaddr, &conn->dst);
2470 cp.pscan_rep_mode = 0x02;
2471 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2472 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002473
Johan Hedberg127178d2010-11-18 22:22:29 +02002474 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002475 conn->state = BT_CONNECTED;
2476 hci_proto_connect_cfm(conn, ev->status);
2477 hci_conn_put(conn);
2478 }
2479
2480unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002481 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002482}
2483
2484static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2485{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002486 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2487 struct hci_conn *conn;
2488
2489 BT_DBG("%s status %d", hdev->name, ev->status);
2490
2491 hci_dev_lock(hdev);
2492
2493 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002494 if (!conn) {
2495 if (ev->link_type == ESCO_LINK)
2496 goto unlock;
2497
2498 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2499 if (!conn)
2500 goto unlock;
2501
2502 conn->type = SCO_LINK;
2503 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002504
Marcel Holtmann732547f2009-04-19 19:14:14 +02002505 switch (ev->status) {
2506 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002507 conn->handle = __le16_to_cpu(ev->handle);
2508 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002509
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002510 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002511 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002512 break;
2513
Stephen Coe705e5712010-02-16 11:29:44 -05002514 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002515 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002516 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002517 case 0x1f: /* Unspecified error */
2518 if (conn->out && conn->attempt < 2) {
2519 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2520 (hdev->esco_type & EDR_ESCO_MASK);
2521 hci_setup_sync(conn, conn->link->handle);
2522 goto unlock;
2523 }
2524 /* fall through */
2525
2526 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002527 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002528 break;
2529 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002530
2531 hci_proto_connect_cfm(conn, ev->status);
2532 if (ev->status)
2533 hci_conn_del(conn);
2534
2535unlock:
2536 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002537}
2538
2539static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2540{
2541 BT_DBG("%s", hdev->name);
2542}
2543
Marcel Holtmann04837f62006-07-03 10:02:33 +02002544static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2545{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002546 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002547
2548 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002549}
2550
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002551static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2552{
2553 struct inquiry_data data;
2554 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2555 int num_rsp = *((__u8 *) skb->data);
2556
2557 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2558
2559 if (!num_rsp)
2560 return;
2561
Johan Hedberg314b2382011-04-27 10:29:57 -04002562 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2563
2564 if (test_bit(HCI_MGMT, &hdev->flags))
2565 mgmt_discovering(hdev->id, 1);
2566 }
2567
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002568 hci_dev_lock(hdev);
2569
Johan Hedberge17acd42011-03-30 23:57:16 +03002570 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002571 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002572 data.pscan_rep_mode = info->pscan_rep_mode;
2573 data.pscan_period_mode = info->pscan_period_mode;
2574 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002575 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002576 data.clock_offset = info->clock_offset;
2577 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002578 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002579 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002580 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class,
2581 info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002582 }
2583
2584 hci_dev_unlock(hdev);
2585}
2586
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002587static inline u8 hci_get_auth_req(struct hci_conn *conn)
2588{
2589 /* If remote requests dedicated bonding follow that lead */
2590 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2591 /* If both remote and local IO capabilities allow MITM
2592 * protection then require it, otherwise don't */
2593 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2594 return 0x02;
2595 else
2596 return 0x03;
2597 }
2598
2599 /* If remote requests no-bonding follow that lead */
2600 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002601 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002602
2603 return conn->auth_type;
2604}
2605
Marcel Holtmann04936842008-07-14 20:13:48 +02002606static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2607{
2608 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2609 struct hci_conn *conn;
2610
2611 BT_DBG("%s", hdev->name);
2612
2613 hci_dev_lock(hdev);
2614
2615 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002616 if (!conn)
2617 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002618
Johan Hedberg03b555e2011-01-04 15:40:05 +02002619 hci_conn_hold(conn);
2620
2621 if (!test_bit(HCI_MGMT, &hdev->flags))
2622 goto unlock;
2623
2624 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2625 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002626 struct hci_cp_io_capability_reply cp;
2627
2628 bacpy(&cp.bdaddr, &ev->bdaddr);
2629 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002630 conn->auth_type = hci_get_auth_req(conn);
2631 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002632
Szymon Jancce85ee12011-03-22 13:12:23 +01002633 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2634 hci_find_remote_oob_data(hdev, &conn->dst))
2635 cp.oob_data = 0x01;
2636 else
2637 cp.oob_data = 0x00;
2638
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002639 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2640 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002641 } else {
2642 struct hci_cp_io_capability_neg_reply cp;
2643
2644 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedbergbe771592011-04-28 11:28:57 -07002645 cp.reason = 0x18; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02002646
2647 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2648 sizeof(cp), &cp);
2649 }
2650
2651unlock:
2652 hci_dev_unlock(hdev);
2653}
2654
2655static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2656{
2657 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2658 struct hci_conn *conn;
2659
2660 BT_DBG("%s", hdev->name);
2661
2662 hci_dev_lock(hdev);
2663
2664 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2665 if (!conn)
2666 goto unlock;
2667
Johan Hedberg03b555e2011-01-04 15:40:05 +02002668 conn->remote_cap = ev->capability;
2669 conn->remote_oob = ev->oob_data;
2670 conn->remote_auth = ev->authentication;
2671
2672unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002673 hci_dev_unlock(hdev);
2674}
2675
Johan Hedberga5c29682011-02-19 12:05:57 -03002676static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2677 struct sk_buff *skb)
2678{
2679 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002680 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002681 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002682
2683 BT_DBG("%s", hdev->name);
2684
2685 hci_dev_lock(hdev);
2686
Johan Hedberg7a828902011-04-28 11:28:53 -07002687 if (!test_bit(HCI_MGMT, &hdev->flags))
2688 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002689
Johan Hedberg7a828902011-04-28 11:28:53 -07002690 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2691 if (!conn)
2692 goto unlock;
2693
2694 loc_mitm = (conn->auth_type & 0x01);
2695 rem_mitm = (conn->remote_auth & 0x01);
2696
2697 /* If we require MITM but the remote device can't provide that
2698 * (it has NoInputNoOutput) then reject the confirmation
2699 * request. The only exception is when we're dedicated bonding
2700 * initiators (connect_cfm_cb set) since then we always have the MITM
2701 * bit set. */
2702 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2703 BT_DBG("Rejecting request: remote device can't provide MITM");
2704 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2705 sizeof(ev->bdaddr), &ev->bdaddr);
2706 goto unlock;
2707 }
2708
2709 /* If no side requires MITM protection; auto-accept */
2710 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2711 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002712
2713 /* If we're not the initiators request authorization to
2714 * proceed from user space (mgmt_user_confirm with
2715 * confirm_hint set to 1). */
2716 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2717 BT_DBG("Confirming auto-accept as acceptor");
2718 confirm_hint = 1;
2719 goto confirm;
2720 }
2721
Johan Hedberg9f616562011-04-28 11:28:54 -07002722 BT_DBG("Auto-accept of user confirmation with %ums delay",
2723 hdev->auto_accept_delay);
2724
2725 if (hdev->auto_accept_delay > 0) {
2726 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2727 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2728 goto unlock;
2729 }
2730
Johan Hedberg7a828902011-04-28 11:28:53 -07002731 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2732 sizeof(ev->bdaddr), &ev->bdaddr);
2733 goto unlock;
2734 }
2735
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002736confirm:
2737 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2738 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002739
2740unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002741 hci_dev_unlock(hdev);
2742}
2743
Marcel Holtmann04936842008-07-14 20:13:48 +02002744static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2745{
2746 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2747 struct hci_conn *conn;
2748
2749 BT_DBG("%s", hdev->name);
2750
2751 hci_dev_lock(hdev);
2752
2753 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002754 if (!conn)
2755 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002756
Johan Hedberg2a611692011-02-19 12:06:00 -03002757 /* To avoid duplicate auth_failed events to user space we check
2758 * the HCI_CONN_AUTH_PEND flag which will be set if we
2759 * initiated the authentication. A traditional auth_complete
2760 * event gets always produced as initiator and is also mapped to
2761 * the mgmt_auth_failed event */
2762 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2763 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2764
2765 hci_conn_put(conn);
2766
2767unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002768 hci_dev_unlock(hdev);
2769}
2770
Marcel Holtmann41a96212008-07-14 20:13:48 +02002771static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2772{
2773 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2774 struct inquiry_entry *ie;
2775
2776 BT_DBG("%s", hdev->name);
2777
2778 hci_dev_lock(hdev);
2779
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002780 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2781 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002782 ie->data.ssp_mode = (ev->features[0] & 0x01);
2783
2784 hci_dev_unlock(hdev);
2785}
2786
Szymon Janc2763eda2011-03-22 13:12:22 +01002787static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2788 struct sk_buff *skb)
2789{
2790 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2791 struct oob_data *data;
2792
2793 BT_DBG("%s", hdev->name);
2794
2795 hci_dev_lock(hdev);
2796
Szymon Jance1ba1f12011-04-06 13:01:59 +02002797 if (!test_bit(HCI_MGMT, &hdev->flags))
2798 goto unlock;
2799
Szymon Janc2763eda2011-03-22 13:12:22 +01002800 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2801 if (data) {
2802 struct hci_cp_remote_oob_data_reply cp;
2803
2804 bacpy(&cp.bdaddr, &ev->bdaddr);
2805 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2806 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2807
2808 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2809 &cp);
2810 } else {
2811 struct hci_cp_remote_oob_data_neg_reply cp;
2812
2813 bacpy(&cp.bdaddr, &ev->bdaddr);
2814 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2815 &cp);
2816 }
2817
Szymon Jance1ba1f12011-04-06 13:01:59 +02002818unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002819 hci_dev_unlock(hdev);
2820}
2821
Ville Tervofcd89c02011-02-10 22:38:47 -03002822static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2823{
2824 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2825 struct hci_conn *conn;
2826
2827 BT_DBG("%s status %d", hdev->name, ev->status);
2828
2829 hci_dev_lock(hdev);
2830
2831 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002832 if (!conn) {
2833 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
2834 if (!conn) {
2835 BT_ERR("No memory for new connection");
2836 hci_dev_unlock(hdev);
2837 return;
2838 }
Andre Guedes29b79882011-05-31 14:20:54 -03002839
2840 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002841 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002842
2843 if (ev->status) {
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002844 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002845 hci_proto_connect_cfm(conn, ev->status);
2846 conn->state = BT_CLOSED;
2847 hci_conn_del(conn);
2848 goto unlock;
2849 }
2850
Vinicius Costa Gomescfafccf2011-08-19 21:06:56 -03002851 mgmt_connected(hdev->id, &ev->bdaddr, conn->type);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002852
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03002853 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002854 conn->handle = __le16_to_cpu(ev->handle);
2855 conn->state = BT_CONNECTED;
2856
2857 hci_conn_hold_device(conn);
2858 hci_conn_add_sysfs(conn);
2859
2860 hci_proto_connect_cfm(conn, ev->status);
2861
2862unlock:
2863 hci_dev_unlock(hdev);
2864}
2865
Andre Guedes9aa04c92011-05-26 16:23:51 -03002866static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2867 struct sk_buff *skb)
2868{
Andre Guedese95beb42011-09-26 20:48:35 -03002869 u8 num_reports = skb->data[0];
2870 void *ptr = &skb->data[1];
Andre Guedes9aa04c92011-05-26 16:23:51 -03002871
2872 hci_dev_lock(hdev);
2873
Andre Guedese95beb42011-09-26 20:48:35 -03002874 while (num_reports--) {
2875 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03002876
Andre Guedes9aa04c92011-05-26 16:23:51 -03002877 hci_add_adv_entry(hdev, ev);
Andre Guedese95beb42011-09-26 20:48:35 -03002878
2879 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03002880 }
2881
2882 hci_dev_unlock(hdev);
2883}
2884
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002885static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2886 struct sk_buff *skb)
2887{
2888 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2889 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002890 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002891 struct hci_conn *conn;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002892 struct link_key *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002893
2894 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2895
2896 hci_dev_lock(hdev);
2897
2898 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002899 if (conn == NULL)
2900 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002901
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002902 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
2903 if (ltk == NULL)
2904 goto not_found;
2905
2906 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002907 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomes726b4ff2011-07-08 18:31:45 -03002908 conn->pin_length = ltk->pin_len;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002909
2910 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2911
2912 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03002913
2914 return;
2915
2916not_found:
2917 neg.handle = ev->handle;
2918 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
2919 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002920}
2921
Ville Tervofcd89c02011-02-10 22:38:47 -03002922static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2923{
2924 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2925
2926 skb_pull(skb, sizeof(*le_ev));
2927
2928 switch (le_ev->subevent) {
2929 case HCI_EV_LE_CONN_COMPLETE:
2930 hci_le_conn_complete_evt(hdev, skb);
2931 break;
2932
Andre Guedes9aa04c92011-05-26 16:23:51 -03002933 case HCI_EV_LE_ADVERTISING_REPORT:
2934 hci_le_adv_report_evt(hdev, skb);
2935 break;
2936
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002937 case HCI_EV_LE_LTK_REQ:
2938 hci_le_ltk_request_evt(hdev, skb);
2939 break;
2940
Ville Tervofcd89c02011-02-10 22:38:47 -03002941 default:
2942 break;
2943 }
2944}
2945
Linus Torvalds1da177e2005-04-16 15:20:36 -07002946void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2947{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002948 struct hci_event_hdr *hdr = (void *) skb->data;
2949 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002950
2951 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2952
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002953 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002954 case HCI_EV_INQUIRY_COMPLETE:
2955 hci_inquiry_complete_evt(hdev, skb);
2956 break;
2957
2958 case HCI_EV_INQUIRY_RESULT:
2959 hci_inquiry_result_evt(hdev, skb);
2960 break;
2961
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002962 case HCI_EV_CONN_COMPLETE:
2963 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002964 break;
2965
Linus Torvalds1da177e2005-04-16 15:20:36 -07002966 case HCI_EV_CONN_REQUEST:
2967 hci_conn_request_evt(hdev, skb);
2968 break;
2969
Linus Torvalds1da177e2005-04-16 15:20:36 -07002970 case HCI_EV_DISCONN_COMPLETE:
2971 hci_disconn_complete_evt(hdev, skb);
2972 break;
2973
Linus Torvalds1da177e2005-04-16 15:20:36 -07002974 case HCI_EV_AUTH_COMPLETE:
2975 hci_auth_complete_evt(hdev, skb);
2976 break;
2977
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002978 case HCI_EV_REMOTE_NAME:
2979 hci_remote_name_evt(hdev, skb);
2980 break;
2981
Linus Torvalds1da177e2005-04-16 15:20:36 -07002982 case HCI_EV_ENCRYPT_CHANGE:
2983 hci_encrypt_change_evt(hdev, skb);
2984 break;
2985
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002986 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2987 hci_change_link_key_complete_evt(hdev, skb);
2988 break;
2989
2990 case HCI_EV_REMOTE_FEATURES:
2991 hci_remote_features_evt(hdev, skb);
2992 break;
2993
2994 case HCI_EV_REMOTE_VERSION:
2995 hci_remote_version_evt(hdev, skb);
2996 break;
2997
2998 case HCI_EV_QOS_SETUP_COMPLETE:
2999 hci_qos_setup_complete_evt(hdev, skb);
3000 break;
3001
3002 case HCI_EV_CMD_COMPLETE:
3003 hci_cmd_complete_evt(hdev, skb);
3004 break;
3005
3006 case HCI_EV_CMD_STATUS:
3007 hci_cmd_status_evt(hdev, skb);
3008 break;
3009
3010 case HCI_EV_ROLE_CHANGE:
3011 hci_role_change_evt(hdev, skb);
3012 break;
3013
3014 case HCI_EV_NUM_COMP_PKTS:
3015 hci_num_comp_pkts_evt(hdev, skb);
3016 break;
3017
3018 case HCI_EV_MODE_CHANGE:
3019 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003020 break;
3021
3022 case HCI_EV_PIN_CODE_REQ:
3023 hci_pin_code_request_evt(hdev, skb);
3024 break;
3025
3026 case HCI_EV_LINK_KEY_REQ:
3027 hci_link_key_request_evt(hdev, skb);
3028 break;
3029
3030 case HCI_EV_LINK_KEY_NOTIFY:
3031 hci_link_key_notify_evt(hdev, skb);
3032 break;
3033
3034 case HCI_EV_CLOCK_OFFSET:
3035 hci_clock_offset_evt(hdev, skb);
3036 break;
3037
Marcel Holtmanna8746412008-07-14 20:13:46 +02003038 case HCI_EV_PKT_TYPE_CHANGE:
3039 hci_pkt_type_change_evt(hdev, skb);
3040 break;
3041
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003042 case HCI_EV_PSCAN_REP_MODE:
3043 hci_pscan_rep_mode_evt(hdev, skb);
3044 break;
3045
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003046 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3047 hci_inquiry_result_with_rssi_evt(hdev, skb);
3048 break;
3049
3050 case HCI_EV_REMOTE_EXT_FEATURES:
3051 hci_remote_ext_features_evt(hdev, skb);
3052 break;
3053
3054 case HCI_EV_SYNC_CONN_COMPLETE:
3055 hci_sync_conn_complete_evt(hdev, skb);
3056 break;
3057
3058 case HCI_EV_SYNC_CONN_CHANGED:
3059 hci_sync_conn_changed_evt(hdev, skb);
3060 break;
3061
Marcel Holtmann04837f62006-07-03 10:02:33 +02003062 case HCI_EV_SNIFF_SUBRATE:
3063 hci_sniff_subrate_evt(hdev, skb);
3064 break;
3065
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003066 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3067 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003068 break;
3069
Marcel Holtmann04936842008-07-14 20:13:48 +02003070 case HCI_EV_IO_CAPA_REQUEST:
3071 hci_io_capa_request_evt(hdev, skb);
3072 break;
3073
Johan Hedberg03b555e2011-01-04 15:40:05 +02003074 case HCI_EV_IO_CAPA_REPLY:
3075 hci_io_capa_reply_evt(hdev, skb);
3076 break;
3077
Johan Hedberga5c29682011-02-19 12:05:57 -03003078 case HCI_EV_USER_CONFIRM_REQUEST:
3079 hci_user_confirm_request_evt(hdev, skb);
3080 break;
3081
Marcel Holtmann04936842008-07-14 20:13:48 +02003082 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3083 hci_simple_pair_complete_evt(hdev, skb);
3084 break;
3085
Marcel Holtmann41a96212008-07-14 20:13:48 +02003086 case HCI_EV_REMOTE_HOST_FEATURES:
3087 hci_remote_host_features_evt(hdev, skb);
3088 break;
3089
Ville Tervofcd89c02011-02-10 22:38:47 -03003090 case HCI_EV_LE_META:
3091 hci_le_meta_evt(hdev, skb);
3092 break;
3093
Szymon Janc2763eda2011-03-22 13:12:22 +01003094 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3095 hci_remote_oob_data_request_evt(hdev, skb);
3096 break;
3097
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003098 default:
3099 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003100 break;
3101 }
3102
3103 kfree_skb(skb);
3104 hdev->stat.evt_rx++;
3105}
3106
3107/* Generate internal stack event */
3108void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3109{
3110 struct hci_event_hdr *hdr;
3111 struct hci_ev_stack_internal *ev;
3112 struct sk_buff *skb;
3113
3114 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3115 if (!skb)
3116 return;
3117
3118 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3119 hdr->evt = HCI_EV_STACK_INTERNAL;
3120 hdr->plen = sizeof(*ev) + dlen;
3121
3122 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3123 ev->type = type;
3124 memcpy(ev->data, data, dlen);
3125
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003126 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003127 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003128
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003129 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003130 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003131 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003132 kfree_skb(skb);
3133}
Andre Guedese6100a22011-06-30 19:20:54 -03003134
Gustavo F. Padovan669bb392011-10-11 15:57:01 -03003135module_param(enable_le, bool, 0644);
Andre Guedese6100a22011-06-30 19:20:54 -03003136MODULE_PARM_DESC(enable_le, "Enable LE support");