blob: b7689dddee79f13da70b196248e388a7e3badbeb [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
Linus Torvalds1da177e2005-04-16 15:20:36 -070048/* Handle HCI Event packets */
49
Marcel Holtmanna9de9242007-10-20 13:33:56 +020050static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070051{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020052 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
Marcel Holtmanna9de9242007-10-20 13:33:56 +020054 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
Marcel Holtmanna9de9242007-10-20 13:33:56 +020056 if (status)
57 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070058
Johan Hedberg314b2382011-04-27 10:29:57 -040059 if (test_bit(HCI_MGMT, &hdev->flags) &&
60 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
61 mgmt_discovering(hdev->id, 0);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010062
Johan Hedberg23bb5762010-12-21 23:01:27 +020063 hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010064
Marcel Holtmanna9de9242007-10-20 13:33:56 +020065 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070066}
67
Marcel Holtmanna9de9242007-10-20 13:33:56 +020068static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070069{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020070 __u8 status = *((__u8 *) skb->data);
71
72 BT_DBG("%s status 0x%x", hdev->name, status);
73
74 if (status)
75 return;
76
Johan Hedberg314b2382011-04-27 10:29:57 -040077 if (test_bit(HCI_MGMT, &hdev->flags) &&
78 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
79 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020080
81 hci_conn_check_pending(hdev);
82}
83
84static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
85{
86 BT_DBG("%s", hdev->name);
87}
88
89static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
90{
91 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070092 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070093
Marcel Holtmanna9de9242007-10-20 13:33:56 +020094 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Marcel Holtmanna9de9242007-10-20 13:33:56 +020096 if (rp->status)
97 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Marcel Holtmanna9de9242007-10-20 13:33:56 +020099 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200101 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
102 if (conn) {
103 if (rp->role)
104 conn->link_mode &= ~HCI_LM_MASTER;
105 else
106 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200108
109 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110}
111
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200112static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
113{
114 struct hci_rp_read_link_policy *rp = (void *) skb->data;
115 struct hci_conn *conn;
116
117 BT_DBG("%s status 0x%x", hdev->name, rp->status);
118
119 if (rp->status)
120 return;
121
122 hci_dev_lock(hdev);
123
124 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
125 if (conn)
126 conn->link_policy = __le16_to_cpu(rp->policy);
127
128 hci_dev_unlock(hdev);
129}
130
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200131static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200133 struct hci_rp_write_link_policy *rp = (void *) skb->data;
134 struct hci_conn *conn;
135 void *sent;
136
137 BT_DBG("%s status 0x%x", hdev->name, rp->status);
138
139 if (rp->status)
140 return;
141
142 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
143 if (!sent)
144 return;
145
146 hci_dev_lock(hdev);
147
148 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200149 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700150 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200151
152 hci_dev_unlock(hdev);
153}
154
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200155static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
156{
157 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
158
159 BT_DBG("%s status 0x%x", hdev->name, rp->status);
160
161 if (rp->status)
162 return;
163
164 hdev->link_policy = __le16_to_cpu(rp->policy);
165}
166
167static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
168{
169 __u8 status = *((__u8 *) skb->data);
170 void *sent;
171
172 BT_DBG("%s status 0x%x", hdev->name, status);
173
174 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
175 if (!sent)
176 return;
177
178 if (!status)
179 hdev->link_policy = get_unaligned_le16(sent);
180
Johan Hedberg23bb5762010-12-21 23:01:27 +0200181 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200182}
183
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200184static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
185{
186 __u8 status = *((__u8 *) skb->data);
187
188 BT_DBG("%s status 0x%x", hdev->name, status);
189
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300190 clear_bit(HCI_RESET, &hdev->flags);
191
Johan Hedberg23bb5762010-12-21 23:01:27 +0200192 hci_req_complete(hdev, HCI_OP_RESET, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200193}
194
195static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
196{
197 __u8 status = *((__u8 *) skb->data);
198 void *sent;
199
200 BT_DBG("%s status 0x%x", hdev->name, status);
201
202 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
203 if (!sent)
204 return;
205
Johan Hedbergb312b1612011-03-16 14:29:37 +0200206 if (test_bit(HCI_MGMT, &hdev->flags))
207 mgmt_set_local_name_complete(hdev->id, sent, status);
208
209 if (status)
210 return;
211
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200212 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200213}
214
215static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
216{
217 struct hci_rp_read_local_name *rp = (void *) skb->data;
218
219 BT_DBG("%s status 0x%x", hdev->name, rp->status);
220
221 if (rp->status)
222 return;
223
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200224 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200225}
226
227static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
228{
229 __u8 status = *((__u8 *) skb->data);
230 void *sent;
231
232 BT_DBG("%s status 0x%x", hdev->name, status);
233
234 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
235 if (!sent)
236 return;
237
238 if (!status) {
239 __u8 param = *((__u8 *) sent);
240
241 if (param == AUTH_ENABLED)
242 set_bit(HCI_AUTH, &hdev->flags);
243 else
244 clear_bit(HCI_AUTH, &hdev->flags);
245 }
246
Johan Hedberg23bb5762010-12-21 23:01:27 +0200247 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200248}
249
250static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
251{
252 __u8 status = *((__u8 *) skb->data);
253 void *sent;
254
255 BT_DBG("%s status 0x%x", hdev->name, status);
256
257 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
258 if (!sent)
259 return;
260
261 if (!status) {
262 __u8 param = *((__u8 *) sent);
263
264 if (param)
265 set_bit(HCI_ENCRYPT, &hdev->flags);
266 else
267 clear_bit(HCI_ENCRYPT, &hdev->flags);
268 }
269
Johan Hedberg23bb5762010-12-21 23:01:27 +0200270 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200271}
272
273static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
274{
275 __u8 status = *((__u8 *) skb->data);
276 void *sent;
277
278 BT_DBG("%s status 0x%x", hdev->name, status);
279
280 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
281 if (!sent)
282 return;
283
284 if (!status) {
285 __u8 param = *((__u8 *) sent);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200286 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200287
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200288 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
289 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200290
Johan Hedberg73f22f62010-12-29 16:00:25 +0200291 if (param & SCAN_INQUIRY) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200292 set_bit(HCI_ISCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200293 if (!old_iscan)
294 mgmt_discoverable(hdev->id, 1);
295 } else if (old_iscan)
Johan Hedberg73f22f62010-12-29 16:00:25 +0200296 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200297
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200298 if (param & SCAN_PAGE) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200299 set_bit(HCI_PSCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200300 if (!old_pscan)
301 mgmt_connectable(hdev->id, 1);
302 } else if (old_pscan)
303 mgmt_connectable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200304 }
305
Johan Hedberg23bb5762010-12-21 23:01:27 +0200306 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200307}
308
309static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
310{
311 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
312
313 BT_DBG("%s status 0x%x", hdev->name, rp->status);
314
315 if (rp->status)
316 return;
317
318 memcpy(hdev->dev_class, rp->dev_class, 3);
319
320 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
321 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
322}
323
324static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
325{
326 __u8 status = *((__u8 *) skb->data);
327 void *sent;
328
329 BT_DBG("%s status 0x%x", hdev->name, status);
330
Marcel Holtmannf383f272008-07-14 20:13:47 +0200331 if (status)
332 return;
333
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200334 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
335 if (!sent)
336 return;
337
Marcel Holtmannf383f272008-07-14 20:13:47 +0200338 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200339}
340
341static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
342{
343 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200345
346 BT_DBG("%s status 0x%x", hdev->name, rp->status);
347
348 if (rp->status)
349 return;
350
351 setting = __le16_to_cpu(rp->voice_setting);
352
Marcel Holtmannf383f272008-07-14 20:13:47 +0200353 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200354 return;
355
356 hdev->voice_setting = setting;
357
358 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
359
360 if (hdev->notify) {
361 tasklet_disable(&hdev->tx_task);
362 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
363 tasklet_enable(&hdev->tx_task);
364 }
365}
366
367static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
368{
369 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200370 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 void *sent;
372
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200373 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374
Marcel Holtmannf383f272008-07-14 20:13:47 +0200375 if (status)
376 return;
377
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200378 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
379 if (!sent)
380 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381
Marcel Holtmannf383f272008-07-14 20:13:47 +0200382 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383
Marcel Holtmannf383f272008-07-14 20:13:47 +0200384 if (hdev->voice_setting == setting)
385 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386
Marcel Holtmannf383f272008-07-14 20:13:47 +0200387 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Marcel Holtmannf383f272008-07-14 20:13:47 +0200389 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
390
391 if (hdev->notify) {
392 tasklet_disable(&hdev->tx_task);
393 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
394 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 }
396}
397
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200398static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200400 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200402 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Johan Hedberg23bb5762010-12-21 23:01:27 +0200404 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405}
406
Marcel Holtmann333140b2008-07-14 20:13:48 +0200407static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
408{
409 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
410
411 BT_DBG("%s status 0x%x", hdev->name, rp->status);
412
413 if (rp->status)
414 return;
415
416 hdev->ssp_mode = rp->mode;
417}
418
419static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
420{
421 __u8 status = *((__u8 *) skb->data);
422 void *sent;
423
424 BT_DBG("%s status 0x%x", hdev->name, status);
425
426 if (status)
427 return;
428
429 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
430 if (!sent)
431 return;
432
433 hdev->ssp_mode = *((__u8 *) sent);
434}
435
Johan Hedbergd5859e22011-01-25 01:19:58 +0200436static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
437{
438 if (hdev->features[6] & LMP_EXT_INQ)
439 return 2;
440
441 if (hdev->features[3] & LMP_RSSI_INQ)
442 return 1;
443
444 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
445 hdev->lmp_subver == 0x0757)
446 return 1;
447
448 if (hdev->manufacturer == 15) {
449 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
450 return 1;
451 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
452 return 1;
453 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
454 return 1;
455 }
456
457 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
458 hdev->lmp_subver == 0x1805)
459 return 1;
460
461 return 0;
462}
463
464static void hci_setup_inquiry_mode(struct hci_dev *hdev)
465{
466 u8 mode;
467
468 mode = hci_get_inquiry_mode(hdev);
469
470 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
471}
472
473static void hci_setup_event_mask(struct hci_dev *hdev)
474{
475 /* The second byte is 0xff instead of 0x9f (two reserved bits
476 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
477 * command otherwise */
478 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
479
Ville Tervo7f4f0572011-05-27 11:16:21 +0300480 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
481 * any event mask for pre 1.2 devices */
482 if (hdev->lmp_ver <= 1)
483 return;
484
485 events[4] |= 0x01; /* Flow Specification Complete */
486 events[4] |= 0x02; /* Inquiry Result with RSSI */
487 events[4] |= 0x04; /* Read Remote Extended Features Complete */
488 events[5] |= 0x08; /* Synchronous Connection Complete */
489 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200490
491 if (hdev->features[3] & LMP_RSSI_INQ)
492 events[4] |= 0x04; /* Inquiry Result with RSSI */
493
494 if (hdev->features[5] & LMP_SNIFF_SUBR)
495 events[5] |= 0x20; /* Sniff Subrating */
496
497 if (hdev->features[5] & LMP_PAUSE_ENC)
498 events[5] |= 0x80; /* Encryption Key Refresh Complete */
499
500 if (hdev->features[6] & LMP_EXT_INQ)
501 events[5] |= 0x40; /* Extended Inquiry Result */
502
503 if (hdev->features[6] & LMP_NO_FLUSH)
504 events[7] |= 0x01; /* Enhanced Flush Complete */
505
506 if (hdev->features[7] & LMP_LSTO)
507 events[6] |= 0x80; /* Link Supervision Timeout Changed */
508
509 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
510 events[6] |= 0x01; /* IO Capability Request */
511 events[6] |= 0x02; /* IO Capability Response */
512 events[6] |= 0x04; /* User Confirmation Request */
513 events[6] |= 0x08; /* User Passkey Request */
514 events[6] |= 0x10; /* Remote OOB Data Request */
515 events[6] |= 0x20; /* Simple Pairing Complete */
516 events[7] |= 0x04; /* User Passkey Notification */
517 events[7] |= 0x08; /* Keypress Notification */
518 events[7] |= 0x10; /* Remote Host Supported
519 * Features Notification */
520 }
521
522 if (hdev->features[4] & LMP_LE)
523 events[7] |= 0x20; /* LE Meta-Event */
524
525 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
526}
527
528static void hci_setup(struct hci_dev *hdev)
529{
530 hci_setup_event_mask(hdev);
531
532 if (hdev->lmp_ver > 1)
533 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
534
535 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
536 u8 mode = 0x01;
537 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
538 }
539
540 if (hdev->features[3] & LMP_RSSI_INQ)
541 hci_setup_inquiry_mode(hdev);
542
543 if (hdev->features[7] & LMP_INQ_TX_PWR)
544 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
Andre Guedesd5fa5132011-06-30 19:20:52 -0300545
546 if (hdev->features[7] & LMP_EXTFEATURES) {
547 struct hci_cp_read_local_ext_features cp;
548
549 cp.page = 0x01;
550 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES,
551 sizeof(cp), &cp);
552 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200553}
554
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200555static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
556{
557 struct hci_rp_read_local_version *rp = (void *) skb->data;
558
559 BT_DBG("%s status 0x%x", hdev->name, rp->status);
560
561 if (rp->status)
562 return;
563
564 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200565 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200566 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200567 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200568 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200569
570 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
571 hdev->manufacturer,
572 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200573
574 if (test_bit(HCI_INIT, &hdev->flags))
575 hci_setup(hdev);
576}
577
578static void hci_setup_link_policy(struct hci_dev *hdev)
579{
580 u16 link_policy = 0;
581
582 if (hdev->features[0] & LMP_RSWITCH)
583 link_policy |= HCI_LP_RSWITCH;
584 if (hdev->features[0] & LMP_HOLD)
585 link_policy |= HCI_LP_HOLD;
586 if (hdev->features[0] & LMP_SNIFF)
587 link_policy |= HCI_LP_SNIFF;
588 if (hdev->features[1] & LMP_PARK)
589 link_policy |= HCI_LP_PARK;
590
591 link_policy = cpu_to_le16(link_policy);
592 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
593 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200594}
595
596static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
597{
598 struct hci_rp_read_local_commands *rp = (void *) skb->data;
599
600 BT_DBG("%s status 0x%x", hdev->name, rp->status);
601
602 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200603 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200604
605 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200606
607 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
608 hci_setup_link_policy(hdev);
609
610done:
611 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200612}
613
614static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
615{
616 struct hci_rp_read_local_features *rp = (void *) skb->data;
617
618 BT_DBG("%s status 0x%x", hdev->name, rp->status);
619
620 if (rp->status)
621 return;
622
623 memcpy(hdev->features, rp->features, 8);
624
625 /* Adjust default settings according to features
626 * supported by device. */
627
628 if (hdev->features[0] & LMP_3SLOT)
629 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
630
631 if (hdev->features[0] & LMP_5SLOT)
632 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
633
634 if (hdev->features[1] & LMP_HV2) {
635 hdev->pkt_type |= (HCI_HV2);
636 hdev->esco_type |= (ESCO_HV2);
637 }
638
639 if (hdev->features[1] & LMP_HV3) {
640 hdev->pkt_type |= (HCI_HV3);
641 hdev->esco_type |= (ESCO_HV3);
642 }
643
644 if (hdev->features[3] & LMP_ESCO)
645 hdev->esco_type |= (ESCO_EV3);
646
647 if (hdev->features[4] & LMP_EV4)
648 hdev->esco_type |= (ESCO_EV4);
649
650 if (hdev->features[4] & LMP_EV5)
651 hdev->esco_type |= (ESCO_EV5);
652
Marcel Holtmannefc76882009-02-06 09:13:37 +0100653 if (hdev->features[5] & LMP_EDR_ESCO_2M)
654 hdev->esco_type |= (ESCO_2EV3);
655
656 if (hdev->features[5] & LMP_EDR_ESCO_3M)
657 hdev->esco_type |= (ESCO_3EV3);
658
659 if (hdev->features[5] & LMP_EDR_3S_ESCO)
660 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
661
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200662 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
663 hdev->features[0], hdev->features[1],
664 hdev->features[2], hdev->features[3],
665 hdev->features[4], hdev->features[5],
666 hdev->features[6], hdev->features[7]);
667}
668
Andre Guedesd5fa5132011-06-30 19:20:52 -0300669static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
670 struct sk_buff *skb)
671{
672 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
673
674 BT_DBG("%s status 0x%x", hdev->name, rp->status);
675
676 if (rp->status)
677 return;
678
679 memcpy(hdev->extfeatures, rp->features, 8);
680
681 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
682}
683
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200684static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
685{
686 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
687
688 BT_DBG("%s status 0x%x", hdev->name, rp->status);
689
690 if (rp->status)
691 return;
692
693 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
694 hdev->sco_mtu = rp->sco_mtu;
695 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
696 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
697
698 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
699 hdev->sco_mtu = 64;
700 hdev->sco_pkts = 8;
701 }
702
703 hdev->acl_cnt = hdev->acl_pkts;
704 hdev->sco_cnt = hdev->sco_pkts;
705
706 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
707 hdev->acl_mtu, hdev->acl_pkts,
708 hdev->sco_mtu, hdev->sco_pkts);
709}
710
711static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
712{
713 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
714
715 BT_DBG("%s status 0x%x", hdev->name, rp->status);
716
717 if (!rp->status)
718 bacpy(&hdev->bdaddr, &rp->bdaddr);
719
Johan Hedberg23bb5762010-12-21 23:01:27 +0200720 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
721}
722
723static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
724{
725 __u8 status = *((__u8 *) skb->data);
726
727 BT_DBG("%s status 0x%x", hdev->name, status);
728
729 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200730}
731
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200732static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
733 struct sk_buff *skb)
734{
735 __u8 status = *((__u8 *) skb->data);
736
737 BT_DBG("%s status 0x%x", hdev->name, status);
738
739 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
740}
741
Johan Hedbergd5859e22011-01-25 01:19:58 +0200742static void hci_cc_set_event_mask(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_SET_EVENT_MASK, status);
749}
750
751static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
752 struct sk_buff *skb)
753{
754 __u8 status = *((__u8 *) skb->data);
755
756 BT_DBG("%s status 0x%x", hdev->name, status);
757
758 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
759}
760
761static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
762 struct sk_buff *skb)
763{
764 __u8 status = *((__u8 *) skb->data);
765
766 BT_DBG("%s status 0x%x", hdev->name, status);
767
768 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
769}
770
771static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
772{
773 __u8 status = *((__u8 *) skb->data);
774
775 BT_DBG("%s status 0x%x", hdev->name, status);
776
777 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
778}
779
Johan Hedberg980e1a52011-01-22 06:10:07 +0200780static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
781{
782 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
783 struct hci_cp_pin_code_reply *cp;
784 struct hci_conn *conn;
785
786 BT_DBG("%s status 0x%x", hdev->name, rp->status);
787
788 if (test_bit(HCI_MGMT, &hdev->flags))
789 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
790
791 if (rp->status != 0)
792 return;
793
794 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
795 if (!cp)
796 return;
797
798 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
799 if (conn)
800 conn->pin_length = cp->pin_len;
801}
802
803static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
804{
805 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
806
807 BT_DBG("%s status 0x%x", hdev->name, rp->status);
808
809 if (test_bit(HCI_MGMT, &hdev->flags))
810 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
811 rp->status);
812}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300813static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
814 struct sk_buff *skb)
815{
816 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
817
818 BT_DBG("%s status 0x%x", hdev->name, rp->status);
819
820 if (rp->status)
821 return;
822
823 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
824 hdev->le_pkts = rp->le_max_pkt;
825
826 hdev->le_cnt = hdev->le_pkts;
827
828 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
829
830 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
831}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200832
Johan Hedberga5c29682011-02-19 12:05:57 -0300833static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
834{
835 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
836
837 BT_DBG("%s status 0x%x", hdev->name, rp->status);
838
839 if (test_bit(HCI_MGMT, &hdev->flags))
840 mgmt_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
841 rp->status);
842}
843
844static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
845 struct sk_buff *skb)
846{
847 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
848
849 BT_DBG("%s status 0x%x", hdev->name, rp->status);
850
851 if (test_bit(HCI_MGMT, &hdev->flags))
852 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
853 rp->status);
854}
855
Szymon Jancc35938b2011-03-22 13:12:21 +0100856static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
857 struct sk_buff *skb)
858{
859 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
860
861 BT_DBG("%s status 0x%x", hdev->name, rp->status);
862
863 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
864 rp->randomizer, rp->status);
865}
866
Andre Guedes726e1332011-05-26 16:23:52 -0300867static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
868 struct sk_buff *skb)
869{
870 struct hci_cp_le_set_scan_enable *cp;
871 __u8 status = *((__u8 *) skb->data);
872
873 BT_DBG("%s status 0x%x", hdev->name, status);
874
875 if (status)
876 return;
877
878 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
879 if (!cp)
880 return;
881
882 hci_dev_lock(hdev);
883
Andre Guedes45e600f2011-05-26 16:23:53 -0300884 if (cp->enable == 0x01) {
885 del_timer(&hdev->adv_timer);
Andre Guedes726e1332011-05-26 16:23:52 -0300886 hci_adv_entries_clear(hdev);
Andre Guedes45e600f2011-05-26 16:23:53 -0300887 } else if (cp->enable == 0x00) {
888 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
889 }
Andre Guedes726e1332011-05-26 16:23:52 -0300890
891 hci_dev_unlock(hdev);
892}
893
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -0300894static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
895{
896 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
897
898 BT_DBG("%s status 0x%x", hdev->name, rp->status);
899
900 if (rp->status)
901 return;
902
903 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
904}
905
906static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
907{
908 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
909
910 BT_DBG("%s status 0x%x", hdev->name, rp->status);
911
912 if (rp->status)
913 return;
914
915 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
916}
917
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200918static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
919{
920 BT_DBG("%s status 0x%x", hdev->name, status);
921
922 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200923 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200924 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -0400925 return;
926 }
927
928 if (test_bit(HCI_MGMT, &hdev->flags) &&
929 !test_and_set_bit(HCI_INQUIRY,
930 &hdev->flags))
931 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200932}
933
Linus Torvalds1da177e2005-04-16 15:20:36 -0700934static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
935{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200936 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700938
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200939 BT_DBG("%s status 0x%x", hdev->name, status);
940
941 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700942 if (!cp)
943 return;
944
945 hci_dev_lock(hdev);
946
947 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
948
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200949 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700950
951 if (status) {
952 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200953 if (status != 0x0c || conn->attempt > 2) {
954 conn->state = BT_CLOSED;
955 hci_proto_connect_cfm(conn, status);
956 hci_conn_del(conn);
957 } else
958 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 }
960 } else {
961 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -0800962 conn = hci_conn_add(hdev, ACL_LINK, 0, &cp->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700963 if (conn) {
964 conn->out = 1;
965 conn->link_mode |= HCI_LM_MASTER;
966 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -0300967 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968 }
969 }
970
971 hci_dev_unlock(hdev);
972}
973
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200974static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700975{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200976 struct hci_cp_add_sco *cp;
977 struct hci_conn *acl, *sco;
978 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700979
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200980 BT_DBG("%s status 0x%x", hdev->name, status);
981
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200982 if (!status)
983 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200985 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
986 if (!cp)
987 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700988
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200989 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700990
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200991 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +0100992
993 hci_dev_lock(hdev);
994
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200995 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +0200996 if (acl) {
997 sco = acl->link;
998 if (sco) {
999 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001000
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001001 hci_proto_connect_cfm(sco, status);
1002 hci_conn_del(sco);
1003 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001004 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001005
1006 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001007}
1008
Marcel Holtmannf8558552008-07-14 20:13:49 +02001009static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1010{
1011 struct hci_cp_auth_requested *cp;
1012 struct hci_conn *conn;
1013
1014 BT_DBG("%s status 0x%x", hdev->name, status);
1015
1016 if (!status)
1017 return;
1018
1019 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1020 if (!cp)
1021 return;
1022
1023 hci_dev_lock(hdev);
1024
1025 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1026 if (conn) {
1027 if (conn->state == BT_CONFIG) {
1028 hci_proto_connect_cfm(conn, status);
1029 hci_conn_put(conn);
1030 }
1031 }
1032
1033 hci_dev_unlock(hdev);
1034}
1035
1036static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1037{
1038 struct hci_cp_set_conn_encrypt *cp;
1039 struct hci_conn *conn;
1040
1041 BT_DBG("%s status 0x%x", hdev->name, status);
1042
1043 if (!status)
1044 return;
1045
1046 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1047 if (!cp)
1048 return;
1049
1050 hci_dev_lock(hdev);
1051
1052 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1053 if (conn) {
1054 if (conn->state == BT_CONFIG) {
1055 hci_proto_connect_cfm(conn, status);
1056 hci_conn_put(conn);
1057 }
1058 }
1059
1060 hci_dev_unlock(hdev);
1061}
1062
Johan Hedberg127178d2010-11-18 22:22:29 +02001063static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001064 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001065{
Johan Hedberg392599b2010-11-18 22:22:28 +02001066 if (conn->state != BT_CONFIG || !conn->out)
1067 return 0;
1068
Johan Hedberg765c2a92011-01-19 12:06:52 +05301069 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001070 return 0;
1071
1072 /* Only request authentication for SSP connections or non-SSP
1073 * devices with sec_level HIGH */
1074 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Johan Hedberg765c2a92011-01-19 12:06:52 +05301075 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001076 return 0;
1077
Johan Hedberg392599b2010-11-18 22:22:28 +02001078 return 1;
1079}
1080
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001081static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1082{
Johan Hedberg127178d2010-11-18 22:22:29 +02001083 struct hci_cp_remote_name_req *cp;
1084 struct hci_conn *conn;
1085
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001086 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001087
1088 /* If successful wait for the name req complete event before
1089 * checking for the need to do authentication */
1090 if (!status)
1091 return;
1092
1093 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1094 if (!cp)
1095 return;
1096
1097 hci_dev_lock(hdev);
1098
1099 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001100 if (!conn)
1101 goto unlock;
1102
1103 if (!hci_outgoing_auth_needed(hdev, conn))
1104 goto unlock;
1105
1106 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001107 struct hci_cp_auth_requested cp;
1108 cp.handle = __cpu_to_le16(conn->handle);
1109 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1110 }
1111
Johan Hedberg79c6c702011-04-28 11:28:55 -07001112unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001113 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001114}
1115
Marcel Holtmann769be972008-07-14 20:13:49 +02001116static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1117{
1118 struct hci_cp_read_remote_features *cp;
1119 struct hci_conn *conn;
1120
1121 BT_DBG("%s status 0x%x", hdev->name, status);
1122
1123 if (!status)
1124 return;
1125
1126 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1127 if (!cp)
1128 return;
1129
1130 hci_dev_lock(hdev);
1131
1132 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1133 if (conn) {
1134 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001135 hci_proto_connect_cfm(conn, status);
1136 hci_conn_put(conn);
1137 }
1138 }
1139
1140 hci_dev_unlock(hdev);
1141}
1142
1143static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1144{
1145 struct hci_cp_read_remote_ext_features *cp;
1146 struct hci_conn *conn;
1147
1148 BT_DBG("%s status 0x%x", hdev->name, status);
1149
1150 if (!status)
1151 return;
1152
1153 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1154 if (!cp)
1155 return;
1156
1157 hci_dev_lock(hdev);
1158
1159 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1160 if (conn) {
1161 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001162 hci_proto_connect_cfm(conn, status);
1163 hci_conn_put(conn);
1164 }
1165 }
1166
1167 hci_dev_unlock(hdev);
1168}
1169
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001170static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1171{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001172 struct hci_cp_setup_sync_conn *cp;
1173 struct hci_conn *acl, *sco;
1174 __u16 handle;
1175
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001176 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001177
1178 if (!status)
1179 return;
1180
1181 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1182 if (!cp)
1183 return;
1184
1185 handle = __le16_to_cpu(cp->handle);
1186
1187 BT_DBG("%s handle %d", hdev->name, handle);
1188
1189 hci_dev_lock(hdev);
1190
1191 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001192 if (acl) {
1193 sco = acl->link;
1194 if (sco) {
1195 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001196
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001197 hci_proto_connect_cfm(sco, status);
1198 hci_conn_del(sco);
1199 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001200 }
1201
1202 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001203}
1204
1205static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1206{
1207 struct hci_cp_sniff_mode *cp;
1208 struct hci_conn *conn;
1209
1210 BT_DBG("%s status 0x%x", hdev->name, status);
1211
1212 if (!status)
1213 return;
1214
1215 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1216 if (!cp)
1217 return;
1218
1219 hci_dev_lock(hdev);
1220
1221 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001222 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001223 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1224
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001225 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1226 hci_sco_setup(conn, status);
1227 }
1228
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001229 hci_dev_unlock(hdev);
1230}
1231
1232static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1233{
1234 struct hci_cp_exit_sniff_mode *cp;
1235 struct hci_conn *conn;
1236
1237 BT_DBG("%s status 0x%x", hdev->name, status);
1238
1239 if (!status)
1240 return;
1241
1242 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1243 if (!cp)
1244 return;
1245
1246 hci_dev_lock(hdev);
1247
1248 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001249 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001250 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1251
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001252 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1253 hci_sco_setup(conn, status);
1254 }
1255
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001256 hci_dev_unlock(hdev);
1257}
1258
Ville Tervofcd89c02011-02-10 22:38:47 -03001259static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1260{
1261 struct hci_cp_le_create_conn *cp;
1262 struct hci_conn *conn;
1263
1264 BT_DBG("%s status 0x%x", hdev->name, status);
1265
1266 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1267 if (!cp)
1268 return;
1269
1270 hci_dev_lock(hdev);
1271
1272 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1273
1274 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1275 conn);
1276
1277 if (status) {
1278 if (conn && conn->state == BT_CONNECT) {
1279 conn->state = BT_CLOSED;
1280 hci_proto_connect_cfm(conn, status);
1281 hci_conn_del(conn);
1282 }
1283 } else {
1284 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001285 conn = hci_conn_add(hdev, LE_LINK, 0, &cp->peer_addr);
Andre Guedes149c0972011-05-31 14:20:54 -03001286 if (conn) {
1287 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001288 conn->out = 1;
Andre Guedes149c0972011-05-31 14:20:54 -03001289 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001290 BT_ERR("No memory for new connection");
Andre Guedes149c0972011-05-31 14:20:54 -03001291 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001292 }
1293 }
1294
1295 hci_dev_unlock(hdev);
1296}
1297
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001298static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1299{
1300 BT_DBG("%s status 0x%x", hdev->name, status);
1301}
1302
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001303static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1304{
1305 __u8 status = *((__u8 *) skb->data);
1306
1307 BT_DBG("%s status %d", hdev->name, status);
1308
Johan Hedberg314b2382011-04-27 10:29:57 -04001309 if (test_bit(HCI_MGMT, &hdev->flags) &&
1310 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1311 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001312
Johan Hedberg23bb5762010-12-21 23:01:27 +02001313 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001314
1315 hci_conn_check_pending(hdev);
1316}
1317
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1319{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001320 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001321 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322 int num_rsp = *((__u8 *) skb->data);
1323
1324 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1325
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001326 if (!num_rsp)
1327 return;
1328
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001330
Johan Hedberg314b2382011-04-27 10:29:57 -04001331 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
1332
1333 if (test_bit(HCI_MGMT, &hdev->flags))
1334 mgmt_discovering(hdev->id, 1);
1335 }
1336
Johan Hedberge17acd42011-03-30 23:57:16 +03001337 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 bacpy(&data.bdaddr, &info->bdaddr);
1339 data.pscan_rep_mode = info->pscan_rep_mode;
1340 data.pscan_period_mode = info->pscan_period_mode;
1341 data.pscan_mode = info->pscan_mode;
1342 memcpy(data.dev_class, info->dev_class, 3);
1343 data.clock_offset = info->clock_offset;
1344 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001345 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03001347 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class, 0,
1348 NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001350
Linus Torvalds1da177e2005-04-16 15:20:36 -07001351 hci_dev_unlock(hdev);
1352}
1353
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001354static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001356 struct hci_ev_conn_complete *ev = (void *) skb->data;
1357 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001359 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001360
Linus Torvalds1da177e2005-04-16 15:20:36 -07001361 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001362
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001363 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001364 if (!conn) {
1365 if (ev->link_type != SCO_LINK)
1366 goto unlock;
1367
1368 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1369 if (!conn)
1370 goto unlock;
1371
1372 conn->type = SCO_LINK;
1373 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001374
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001375 if (!ev->status) {
1376 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001377
1378 if (conn->type == ACL_LINK) {
1379 conn->state = BT_CONFIG;
1380 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001381 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedbergf7520542011-01-20 12:34:39 +02001382 mgmt_connected(hdev->id, &ev->bdaddr);
Marcel Holtmann769be972008-07-14 20:13:49 +02001383 } else
1384 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001385
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001386 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001387 hci_conn_add_sysfs(conn);
1388
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001389 if (test_bit(HCI_AUTH, &hdev->flags))
1390 conn->link_mode |= HCI_LM_AUTH;
1391
1392 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1393 conn->link_mode |= HCI_LM_ENCRYPT;
1394
1395 /* Get remote features */
1396 if (conn->type == ACL_LINK) {
1397 struct hci_cp_read_remote_features cp;
1398 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001399 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1400 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001401 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001402
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001403 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001404 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001405 struct hci_cp_change_conn_ptype cp;
1406 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001407 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1408 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1409 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001410 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001411 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001412 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001413 if (conn->type == ACL_LINK)
1414 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1415 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001416
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001417 if (conn->type == ACL_LINK)
1418 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001419
Marcel Holtmann769be972008-07-14 20:13:49 +02001420 if (ev->status) {
1421 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001422 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001423 } else if (ev->link_type != ACL_LINK)
1424 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001425
1426unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001427 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001428
1429 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001430}
1431
Linus Torvalds1da177e2005-04-16 15:20:36 -07001432static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1433{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001434 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001435 int mask = hdev->link_mode;
1436
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001437 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1438 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001439
1440 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1441
Szymon Janc138d22e2011-02-17 16:44:23 +01001442 if ((mask & HCI_LM_ACCEPT) &&
1443 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001444 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001445 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001446 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447
1448 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001449
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001450 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1451 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001452 memcpy(ie->data.dev_class, ev->dev_class, 3);
1453
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1455 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001456 /* pkt_type not yet used for incoming connections */
1457 conn = hci_conn_add(hdev, ev->link_type, 0, &ev->bdaddr);
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001458 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001459 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001460 hci_dev_unlock(hdev);
1461 return;
1462 }
1463 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001464
Linus Torvalds1da177e2005-04-16 15:20:36 -07001465 memcpy(conn->dev_class, ev->dev_class, 3);
1466 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001467
Linus Torvalds1da177e2005-04-16 15:20:36 -07001468 hci_dev_unlock(hdev);
1469
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001470 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1471 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001472
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001473 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001474
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001475 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1476 cp.role = 0x00; /* Become master */
1477 else
1478 cp.role = 0x01; /* Remain slave */
1479
1480 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1481 sizeof(cp), &cp);
1482 } else {
1483 struct hci_cp_accept_sync_conn_req cp;
1484
1485 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001486 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001487
1488 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1489 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1490 cp.max_latency = cpu_to_le16(0xffff);
1491 cp.content_format = cpu_to_le16(hdev->voice_setting);
1492 cp.retrans_effort = 0xff;
1493
1494 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1495 sizeof(cp), &cp);
1496 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001497 } else {
1498 /* Connection rejected */
1499 struct hci_cp_reject_conn_req cp;
1500
1501 bacpy(&cp.bdaddr, &ev->bdaddr);
1502 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001503 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504 }
1505}
1506
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1508{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001509 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001510 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511
1512 BT_DBG("%s status %d", hdev->name, ev->status);
1513
Johan Hedberg8962ee72011-01-20 12:40:27 +02001514 if (ev->status) {
1515 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001516 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001517 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001518
1519 hci_dev_lock(hdev);
1520
Marcel Holtmann04837f62006-07-03 10:02:33 +02001521 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001522 if (!conn)
1523 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001524
Johan Hedbergf7520542011-01-20 12:34:39 +02001525 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001526
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001527 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedbergf7520542011-01-20 12:34:39 +02001528 mgmt_disconnected(hdev->id, &conn->dst);
1529
1530 hci_proto_disconn_cfm(conn, ev->reason);
1531 hci_conn_del(conn);
1532
1533unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001534 hci_dev_unlock(hdev);
1535}
1536
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001537static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1538{
1539 struct hci_ev_auth_complete *ev = (void *) skb->data;
1540 struct hci_conn *conn;
1541
1542 BT_DBG("%s status %d", hdev->name, ev->status);
1543
1544 hci_dev_lock(hdev);
1545
1546 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001547 if (!conn)
1548 goto unlock;
1549
1550 if (!ev->status) {
1551 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1552 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1553 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001554 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001555 conn->link_mode |= HCI_LM_AUTH;
1556 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001557 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001558 } else {
1559 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1560 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001561
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001562 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1563 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001564
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001565 if (conn->state == BT_CONFIG) {
1566 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1567 struct hci_cp_set_conn_encrypt cp;
1568 cp.handle = ev->handle;
1569 cp.encrypt = 0x01;
1570 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1571 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001572 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001573 conn->state = BT_CONNECTED;
1574 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001575 hci_conn_put(conn);
1576 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001577 } else {
1578 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001579
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001580 hci_conn_hold(conn);
1581 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1582 hci_conn_put(conn);
1583 }
1584
1585 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1586 if (!ev->status) {
1587 struct hci_cp_set_conn_encrypt cp;
1588 cp.handle = ev->handle;
1589 cp.encrypt = 0x01;
1590 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1591 &cp);
1592 } else {
1593 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1594 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001595 }
1596 }
1597
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001598unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001599 hci_dev_unlock(hdev);
1600}
1601
1602static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1603{
Johan Hedberg127178d2010-11-18 22:22:29 +02001604 struct hci_ev_remote_name *ev = (void *) skb->data;
1605 struct hci_conn *conn;
1606
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001607 BT_DBG("%s", hdev->name);
1608
1609 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001610
1611 hci_dev_lock(hdev);
1612
Johan Hedberga88a9652011-03-30 13:18:12 +03001613 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1614 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1615
Johan Hedberg127178d2010-11-18 22:22:29 +02001616 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001617 if (!conn)
1618 goto unlock;
1619
1620 if (!hci_outgoing_auth_needed(hdev, conn))
1621 goto unlock;
1622
1623 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001624 struct hci_cp_auth_requested cp;
1625 cp.handle = __cpu_to_le16(conn->handle);
1626 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1627 }
1628
Johan Hedberg79c6c702011-04-28 11:28:55 -07001629unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001630 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001631}
1632
1633static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1634{
1635 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1636 struct hci_conn *conn;
1637
1638 BT_DBG("%s status %d", hdev->name, ev->status);
1639
1640 hci_dev_lock(hdev);
1641
1642 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1643 if (conn) {
1644 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001645 if (ev->encrypt) {
1646 /* Encryption implies authentication */
1647 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001648 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomes64532ec2011-06-09 18:50:53 -03001649 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001650 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001651 conn->link_mode &= ~HCI_LM_ENCRYPT;
1652 }
1653
1654 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1655
Marcel Holtmannf8558552008-07-14 20:13:49 +02001656 if (conn->state == BT_CONFIG) {
1657 if (!ev->status)
1658 conn->state = BT_CONNECTED;
1659
1660 hci_proto_connect_cfm(conn, ev->status);
1661 hci_conn_put(conn);
1662 } else
1663 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001664 }
1665
1666 hci_dev_unlock(hdev);
1667}
1668
1669static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1670{
1671 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1672 struct hci_conn *conn;
1673
1674 BT_DBG("%s status %d", hdev->name, ev->status);
1675
1676 hci_dev_lock(hdev);
1677
1678 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1679 if (conn) {
1680 if (!ev->status)
1681 conn->link_mode |= HCI_LM_SECURE;
1682
1683 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1684
1685 hci_key_change_cfm(conn, ev->status);
1686 }
1687
1688 hci_dev_unlock(hdev);
1689}
1690
1691static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1692{
1693 struct hci_ev_remote_features *ev = (void *) skb->data;
1694 struct hci_conn *conn;
1695
1696 BT_DBG("%s status %d", hdev->name, ev->status);
1697
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001698 hci_dev_lock(hdev);
1699
1700 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001701 if (!conn)
1702 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001703
Johan Hedbergccd556f2010-11-10 17:11:51 +02001704 if (!ev->status)
1705 memcpy(conn->features, ev->features, 8);
1706
1707 if (conn->state != BT_CONFIG)
1708 goto unlock;
1709
1710 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1711 struct hci_cp_read_remote_ext_features cp;
1712 cp.handle = ev->handle;
1713 cp.page = 0x01;
1714 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001715 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001716 goto unlock;
1717 }
1718
Johan Hedberg127178d2010-11-18 22:22:29 +02001719 if (!ev->status) {
1720 struct hci_cp_remote_name_req cp;
1721 memset(&cp, 0, sizeof(cp));
1722 bacpy(&cp.bdaddr, &conn->dst);
1723 cp.pscan_rep_mode = 0x02;
1724 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1725 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001726
Johan Hedberg127178d2010-11-18 22:22:29 +02001727 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001728 conn->state = BT_CONNECTED;
1729 hci_proto_connect_cfm(conn, ev->status);
1730 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001731 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001732
Johan Hedbergccd556f2010-11-10 17:11:51 +02001733unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001734 hci_dev_unlock(hdev);
1735}
1736
1737static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1738{
1739 BT_DBG("%s", hdev->name);
1740}
1741
1742static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1743{
1744 BT_DBG("%s", hdev->name);
1745}
1746
1747static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1748{
1749 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1750 __u16 opcode;
1751
1752 skb_pull(skb, sizeof(*ev));
1753
1754 opcode = __le16_to_cpu(ev->opcode);
1755
1756 switch (opcode) {
1757 case HCI_OP_INQUIRY_CANCEL:
1758 hci_cc_inquiry_cancel(hdev, skb);
1759 break;
1760
1761 case HCI_OP_EXIT_PERIODIC_INQ:
1762 hci_cc_exit_periodic_inq(hdev, skb);
1763 break;
1764
1765 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1766 hci_cc_remote_name_req_cancel(hdev, skb);
1767 break;
1768
1769 case HCI_OP_ROLE_DISCOVERY:
1770 hci_cc_role_discovery(hdev, skb);
1771 break;
1772
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001773 case HCI_OP_READ_LINK_POLICY:
1774 hci_cc_read_link_policy(hdev, skb);
1775 break;
1776
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001777 case HCI_OP_WRITE_LINK_POLICY:
1778 hci_cc_write_link_policy(hdev, skb);
1779 break;
1780
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001781 case HCI_OP_READ_DEF_LINK_POLICY:
1782 hci_cc_read_def_link_policy(hdev, skb);
1783 break;
1784
1785 case HCI_OP_WRITE_DEF_LINK_POLICY:
1786 hci_cc_write_def_link_policy(hdev, skb);
1787 break;
1788
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001789 case HCI_OP_RESET:
1790 hci_cc_reset(hdev, skb);
1791 break;
1792
1793 case HCI_OP_WRITE_LOCAL_NAME:
1794 hci_cc_write_local_name(hdev, skb);
1795 break;
1796
1797 case HCI_OP_READ_LOCAL_NAME:
1798 hci_cc_read_local_name(hdev, skb);
1799 break;
1800
1801 case HCI_OP_WRITE_AUTH_ENABLE:
1802 hci_cc_write_auth_enable(hdev, skb);
1803 break;
1804
1805 case HCI_OP_WRITE_ENCRYPT_MODE:
1806 hci_cc_write_encrypt_mode(hdev, skb);
1807 break;
1808
1809 case HCI_OP_WRITE_SCAN_ENABLE:
1810 hci_cc_write_scan_enable(hdev, skb);
1811 break;
1812
1813 case HCI_OP_READ_CLASS_OF_DEV:
1814 hci_cc_read_class_of_dev(hdev, skb);
1815 break;
1816
1817 case HCI_OP_WRITE_CLASS_OF_DEV:
1818 hci_cc_write_class_of_dev(hdev, skb);
1819 break;
1820
1821 case HCI_OP_READ_VOICE_SETTING:
1822 hci_cc_read_voice_setting(hdev, skb);
1823 break;
1824
1825 case HCI_OP_WRITE_VOICE_SETTING:
1826 hci_cc_write_voice_setting(hdev, skb);
1827 break;
1828
1829 case HCI_OP_HOST_BUFFER_SIZE:
1830 hci_cc_host_buffer_size(hdev, skb);
1831 break;
1832
Marcel Holtmann333140b2008-07-14 20:13:48 +02001833 case HCI_OP_READ_SSP_MODE:
1834 hci_cc_read_ssp_mode(hdev, skb);
1835 break;
1836
1837 case HCI_OP_WRITE_SSP_MODE:
1838 hci_cc_write_ssp_mode(hdev, skb);
1839 break;
1840
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001841 case HCI_OP_READ_LOCAL_VERSION:
1842 hci_cc_read_local_version(hdev, skb);
1843 break;
1844
1845 case HCI_OP_READ_LOCAL_COMMANDS:
1846 hci_cc_read_local_commands(hdev, skb);
1847 break;
1848
1849 case HCI_OP_READ_LOCAL_FEATURES:
1850 hci_cc_read_local_features(hdev, skb);
1851 break;
1852
Andre Guedesd5fa5132011-06-30 19:20:52 -03001853 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1854 hci_cc_read_local_ext_features(hdev, skb);
1855 break;
1856
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001857 case HCI_OP_READ_BUFFER_SIZE:
1858 hci_cc_read_buffer_size(hdev, skb);
1859 break;
1860
1861 case HCI_OP_READ_BD_ADDR:
1862 hci_cc_read_bd_addr(hdev, skb);
1863 break;
1864
Johan Hedberg23bb5762010-12-21 23:01:27 +02001865 case HCI_OP_WRITE_CA_TIMEOUT:
1866 hci_cc_write_ca_timeout(hdev, skb);
1867 break;
1868
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001869 case HCI_OP_DELETE_STORED_LINK_KEY:
1870 hci_cc_delete_stored_link_key(hdev, skb);
1871 break;
1872
Johan Hedbergd5859e22011-01-25 01:19:58 +02001873 case HCI_OP_SET_EVENT_MASK:
1874 hci_cc_set_event_mask(hdev, skb);
1875 break;
1876
1877 case HCI_OP_WRITE_INQUIRY_MODE:
1878 hci_cc_write_inquiry_mode(hdev, skb);
1879 break;
1880
1881 case HCI_OP_READ_INQ_RSP_TX_POWER:
1882 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1883 break;
1884
1885 case HCI_OP_SET_EVENT_FLT:
1886 hci_cc_set_event_flt(hdev, skb);
1887 break;
1888
Johan Hedberg980e1a52011-01-22 06:10:07 +02001889 case HCI_OP_PIN_CODE_REPLY:
1890 hci_cc_pin_code_reply(hdev, skb);
1891 break;
1892
1893 case HCI_OP_PIN_CODE_NEG_REPLY:
1894 hci_cc_pin_code_neg_reply(hdev, skb);
1895 break;
1896
Szymon Jancc35938b2011-03-22 13:12:21 +01001897 case HCI_OP_READ_LOCAL_OOB_DATA:
1898 hci_cc_read_local_oob_data_reply(hdev, skb);
1899 break;
1900
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001901 case HCI_OP_LE_READ_BUFFER_SIZE:
1902 hci_cc_le_read_buffer_size(hdev, skb);
1903 break;
1904
Johan Hedberga5c29682011-02-19 12:05:57 -03001905 case HCI_OP_USER_CONFIRM_REPLY:
1906 hci_cc_user_confirm_reply(hdev, skb);
1907 break;
1908
1909 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1910 hci_cc_user_confirm_neg_reply(hdev, skb);
1911 break;
1912
Andre Guedes726e1332011-05-26 16:23:52 -03001913 case HCI_OP_LE_SET_SCAN_ENABLE:
1914 hci_cc_le_set_scan_enable(hdev, skb);
1915 break;
1916
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001917 case HCI_OP_LE_LTK_REPLY:
1918 hci_cc_le_ltk_reply(hdev, skb);
1919 break;
1920
1921 case HCI_OP_LE_LTK_NEG_REPLY:
1922 hci_cc_le_ltk_neg_reply(hdev, skb);
1923 break;
1924
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001925 default:
1926 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1927 break;
1928 }
1929
Ville Tervo6bd32322011-02-16 16:32:41 +02001930 if (ev->opcode != HCI_OP_NOP)
1931 del_timer(&hdev->cmd_timer);
1932
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001933 if (ev->ncmd) {
1934 atomic_set(&hdev->cmd_cnt, 1);
1935 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01001936 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001937 }
1938}
1939
1940static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1941{
1942 struct hci_ev_cmd_status *ev = (void *) skb->data;
1943 __u16 opcode;
1944
1945 skb_pull(skb, sizeof(*ev));
1946
1947 opcode = __le16_to_cpu(ev->opcode);
1948
1949 switch (opcode) {
1950 case HCI_OP_INQUIRY:
1951 hci_cs_inquiry(hdev, ev->status);
1952 break;
1953
1954 case HCI_OP_CREATE_CONN:
1955 hci_cs_create_conn(hdev, ev->status);
1956 break;
1957
1958 case HCI_OP_ADD_SCO:
1959 hci_cs_add_sco(hdev, ev->status);
1960 break;
1961
Marcel Holtmannf8558552008-07-14 20:13:49 +02001962 case HCI_OP_AUTH_REQUESTED:
1963 hci_cs_auth_requested(hdev, ev->status);
1964 break;
1965
1966 case HCI_OP_SET_CONN_ENCRYPT:
1967 hci_cs_set_conn_encrypt(hdev, ev->status);
1968 break;
1969
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001970 case HCI_OP_REMOTE_NAME_REQ:
1971 hci_cs_remote_name_req(hdev, ev->status);
1972 break;
1973
Marcel Holtmann769be972008-07-14 20:13:49 +02001974 case HCI_OP_READ_REMOTE_FEATURES:
1975 hci_cs_read_remote_features(hdev, ev->status);
1976 break;
1977
1978 case HCI_OP_READ_REMOTE_EXT_FEATURES:
1979 hci_cs_read_remote_ext_features(hdev, ev->status);
1980 break;
1981
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001982 case HCI_OP_SETUP_SYNC_CONN:
1983 hci_cs_setup_sync_conn(hdev, ev->status);
1984 break;
1985
1986 case HCI_OP_SNIFF_MODE:
1987 hci_cs_sniff_mode(hdev, ev->status);
1988 break;
1989
1990 case HCI_OP_EXIT_SNIFF_MODE:
1991 hci_cs_exit_sniff_mode(hdev, ev->status);
1992 break;
1993
Johan Hedberg8962ee72011-01-20 12:40:27 +02001994 case HCI_OP_DISCONNECT:
1995 if (ev->status != 0)
1996 mgmt_disconnect_failed(hdev->id);
1997 break;
1998
Ville Tervofcd89c02011-02-10 22:38:47 -03001999 case HCI_OP_LE_CREATE_CONN:
2000 hci_cs_le_create_conn(hdev, ev->status);
2001 break;
2002
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002003 case HCI_OP_LE_START_ENC:
2004 hci_cs_le_start_enc(hdev, ev->status);
2005 break;
2006
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002007 default:
2008 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2009 break;
2010 }
2011
Ville Tervo6bd32322011-02-16 16:32:41 +02002012 if (ev->opcode != HCI_OP_NOP)
2013 del_timer(&hdev->cmd_timer);
2014
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002015 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002016 atomic_set(&hdev->cmd_cnt, 1);
2017 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002018 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002019 }
2020}
2021
2022static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2023{
2024 struct hci_ev_role_change *ev = (void *) skb->data;
2025 struct hci_conn *conn;
2026
2027 BT_DBG("%s status %d", hdev->name, ev->status);
2028
2029 hci_dev_lock(hdev);
2030
2031 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2032 if (conn) {
2033 if (!ev->status) {
2034 if (ev->role)
2035 conn->link_mode &= ~HCI_LM_MASTER;
2036 else
2037 conn->link_mode |= HCI_LM_MASTER;
2038 }
2039
2040 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2041
2042 hci_role_switch_cfm(conn, ev->status, ev->role);
2043 }
2044
2045 hci_dev_unlock(hdev);
2046}
2047
Linus Torvalds1da177e2005-04-16 15:20:36 -07002048static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2049{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002050 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002051 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002052 int i;
2053
2054 skb_pull(skb, sizeof(*ev));
2055
2056 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2057
2058 if (skb->len < ev->num_hndl * 4) {
2059 BT_DBG("%s bad parameters", hdev->name);
2060 return;
2061 }
2062
2063 tasklet_disable(&hdev->tx_task);
2064
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002065 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002066 struct hci_conn *conn;
2067 __u16 handle, count;
2068
Harvey Harrison83985312008-05-02 16:25:46 -07002069 handle = get_unaligned_le16(ptr++);
2070 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002071
2072 conn = hci_conn_hash_lookup_handle(hdev, handle);
2073 if (conn) {
2074 conn->sent -= count;
2075
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002076 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002077 hdev->acl_cnt += count;
2078 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002079 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002080 } else if (conn->type == LE_LINK) {
2081 if (hdev->le_pkts) {
2082 hdev->le_cnt += count;
2083 if (hdev->le_cnt > hdev->le_pkts)
2084 hdev->le_cnt = hdev->le_pkts;
2085 } else {
2086 hdev->acl_cnt += count;
2087 if (hdev->acl_cnt > hdev->acl_pkts)
2088 hdev->acl_cnt = hdev->acl_pkts;
2089 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002090 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002091 hdev->sco_cnt += count;
2092 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002093 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002094 }
2095 }
2096 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002097
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002098 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002099
2100 tasklet_enable(&hdev->tx_task);
2101}
2102
Marcel Holtmann04837f62006-07-03 10:02:33 +02002103static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002104{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002105 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002106 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002107
2108 BT_DBG("%s status %d", hdev->name, ev->status);
2109
2110 hci_dev_lock(hdev);
2111
Marcel Holtmann04837f62006-07-03 10:02:33 +02002112 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2113 if (conn) {
2114 conn->mode = ev->mode;
2115 conn->interval = __le16_to_cpu(ev->interval);
2116
2117 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2118 if (conn->mode == HCI_CM_ACTIVE)
2119 conn->power_save = 1;
2120 else
2121 conn->power_save = 0;
2122 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002123
2124 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2125 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002126 }
2127
2128 hci_dev_unlock(hdev);
2129}
2130
Linus Torvalds1da177e2005-04-16 15:20:36 -07002131static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2132{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002133 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2134 struct hci_conn *conn;
2135
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002136 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002137
2138 hci_dev_lock(hdev);
2139
2140 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Marcel Holtmann3d7a9d12009-05-09 12:09:21 -07002141 if (conn && conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002142 hci_conn_hold(conn);
2143 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2144 hci_conn_put(conn);
2145 }
2146
Johan Hedberg03b555e2011-01-04 15:40:05 +02002147 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2148 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2149 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002150 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002151 u8 secure;
2152
2153 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2154 secure = 1;
2155 else
2156 secure = 0;
2157
2158 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2159 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002160
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002161 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002162}
2163
Linus Torvalds1da177e2005-04-16 15:20:36 -07002164static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2165{
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002166 struct hci_ev_link_key_req *ev = (void *) skb->data;
2167 struct hci_cp_link_key_reply cp;
2168 struct hci_conn *conn;
2169 struct link_key *key;
2170
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002171 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002172
2173 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2174 return;
2175
2176 hci_dev_lock(hdev);
2177
2178 key = hci_find_link_key(hdev, &ev->bdaddr);
2179 if (!key) {
2180 BT_DBG("%s link key not found for %s", hdev->name,
2181 batostr(&ev->bdaddr));
2182 goto not_found;
2183 }
2184
2185 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2186 batostr(&ev->bdaddr));
2187
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002188 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2189 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002190 BT_DBG("%s ignoring debug key", hdev->name);
2191 goto not_found;
2192 }
2193
2194 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002195 if (conn) {
2196 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2197 conn->auth_type != 0xff &&
2198 (conn->auth_type & 0x01)) {
2199 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2200 goto not_found;
2201 }
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002202
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002203 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2204 conn->pending_sec_level == BT_SECURITY_HIGH) {
2205 BT_DBG("%s ignoring key unauthenticated for high \
2206 security", hdev->name);
2207 goto not_found;
2208 }
2209
2210 conn->key_type = key->type;
2211 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002212 }
2213
2214 bacpy(&cp.bdaddr, &ev->bdaddr);
2215 memcpy(cp.link_key, key->val, 16);
2216
2217 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2218
2219 hci_dev_unlock(hdev);
2220
2221 return;
2222
2223not_found:
2224 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2225 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002226}
2227
Linus Torvalds1da177e2005-04-16 15:20:36 -07002228static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2229{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002230 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2231 struct hci_conn *conn;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002232 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002233
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002234 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002235
2236 hci_dev_lock(hdev);
2237
2238 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2239 if (conn) {
2240 hci_conn_hold(conn);
2241 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002242 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002243
2244 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2245 conn->key_type = ev->key_type;
2246
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002247 hci_conn_put(conn);
2248 }
2249
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002250 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002251 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002252 ev->key_type, pin_len);
2253
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002254 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002255}
2256
Marcel Holtmann04837f62006-07-03 10:02:33 +02002257static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2258{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002259 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002260 struct hci_conn *conn;
2261
2262 BT_DBG("%s status %d", hdev->name, ev->status);
2263
2264 hci_dev_lock(hdev);
2265
2266 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002267 if (conn && !ev->status) {
2268 struct inquiry_entry *ie;
2269
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002270 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2271 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002272 ie->data.clock_offset = ev->clock_offset;
2273 ie->timestamp = jiffies;
2274 }
2275 }
2276
2277 hci_dev_unlock(hdev);
2278}
2279
Marcel Holtmanna8746412008-07-14 20:13:46 +02002280static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2281{
2282 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2283 struct hci_conn *conn;
2284
2285 BT_DBG("%s status %d", hdev->name, ev->status);
2286
2287 hci_dev_lock(hdev);
2288
2289 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2290 if (conn && !ev->status)
2291 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2292
2293 hci_dev_unlock(hdev);
2294}
2295
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002296static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2297{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002298 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002299 struct inquiry_entry *ie;
2300
2301 BT_DBG("%s", hdev->name);
2302
2303 hci_dev_lock(hdev);
2304
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002305 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2306 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002307 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2308 ie->timestamp = jiffies;
2309 }
2310
2311 hci_dev_unlock(hdev);
2312}
2313
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002314static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2315{
2316 struct inquiry_data data;
2317 int num_rsp = *((__u8 *) skb->data);
2318
2319 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2320
2321 if (!num_rsp)
2322 return;
2323
2324 hci_dev_lock(hdev);
2325
Johan Hedberg314b2382011-04-27 10:29:57 -04002326 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2327
2328 if (test_bit(HCI_MGMT, &hdev->flags))
2329 mgmt_discovering(hdev->id, 1);
2330 }
2331
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002332 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002333 struct inquiry_info_with_rssi_and_pscan_mode *info;
2334 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002335
Johan Hedberge17acd42011-03-30 23:57:16 +03002336 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002337 bacpy(&data.bdaddr, &info->bdaddr);
2338 data.pscan_rep_mode = info->pscan_rep_mode;
2339 data.pscan_period_mode = info->pscan_period_mode;
2340 data.pscan_mode = info->pscan_mode;
2341 memcpy(data.dev_class, info->dev_class, 3);
2342 data.clock_offset = info->clock_offset;
2343 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002344 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002345 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002346 mgmt_device_found(hdev->id, &info->bdaddr,
2347 info->dev_class, info->rssi,
2348 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002349 }
2350 } else {
2351 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2352
Johan Hedberge17acd42011-03-30 23:57:16 +03002353 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002354 bacpy(&data.bdaddr, &info->bdaddr);
2355 data.pscan_rep_mode = info->pscan_rep_mode;
2356 data.pscan_period_mode = info->pscan_period_mode;
2357 data.pscan_mode = 0x00;
2358 memcpy(data.dev_class, info->dev_class, 3);
2359 data.clock_offset = info->clock_offset;
2360 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002361 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002362 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002363 mgmt_device_found(hdev->id, &info->bdaddr,
2364 info->dev_class, info->rssi,
2365 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002366 }
2367 }
2368
2369 hci_dev_unlock(hdev);
2370}
2371
2372static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2373{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002374 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2375 struct hci_conn *conn;
2376
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002377 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002378
Marcel Holtmann41a96212008-07-14 20:13:48 +02002379 hci_dev_lock(hdev);
2380
2381 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002382 if (!conn)
2383 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002384
Johan Hedbergccd556f2010-11-10 17:11:51 +02002385 if (!ev->status && ev->page == 0x01) {
2386 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002387
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002388 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2389 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002390 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002391
Johan Hedbergccd556f2010-11-10 17:11:51 +02002392 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002393 }
2394
Johan Hedbergccd556f2010-11-10 17:11:51 +02002395 if (conn->state != BT_CONFIG)
2396 goto unlock;
2397
Johan Hedberg127178d2010-11-18 22:22:29 +02002398 if (!ev->status) {
2399 struct hci_cp_remote_name_req cp;
2400 memset(&cp, 0, sizeof(cp));
2401 bacpy(&cp.bdaddr, &conn->dst);
2402 cp.pscan_rep_mode = 0x02;
2403 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2404 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002405
Johan Hedberg127178d2010-11-18 22:22:29 +02002406 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002407 conn->state = BT_CONNECTED;
2408 hci_proto_connect_cfm(conn, ev->status);
2409 hci_conn_put(conn);
2410 }
2411
2412unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002413 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002414}
2415
2416static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2417{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002418 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2419 struct hci_conn *conn;
2420
2421 BT_DBG("%s status %d", hdev->name, ev->status);
2422
2423 hci_dev_lock(hdev);
2424
2425 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002426 if (!conn) {
2427 if (ev->link_type == ESCO_LINK)
2428 goto unlock;
2429
2430 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2431 if (!conn)
2432 goto unlock;
2433
2434 conn->type = SCO_LINK;
2435 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002436
Marcel Holtmann732547f2009-04-19 19:14:14 +02002437 switch (ev->status) {
2438 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002439 conn->handle = __le16_to_cpu(ev->handle);
2440 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002441
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002442 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002443 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002444 break;
2445
Nick Pelly5c9b4de2009-09-22 15:19:46 -07002446 case 0x10: /* Connection Accept Timeout */
Stephen Coe705e5712010-02-16 11:29:44 -05002447 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002448 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002449 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002450 case 0x1f: /* Unspecified error */
2451 if (conn->out && conn->attempt < 2) {
2452 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2453 (hdev->esco_type & EDR_ESCO_MASK);
2454 hci_setup_sync(conn, conn->link->handle);
2455 goto unlock;
2456 }
2457 /* fall through */
2458
2459 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002460 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002461 break;
2462 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002463
2464 hci_proto_connect_cfm(conn, ev->status);
2465 if (ev->status)
2466 hci_conn_del(conn);
2467
2468unlock:
2469 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002470}
2471
2472static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2473{
2474 BT_DBG("%s", hdev->name);
2475}
2476
Marcel Holtmann04837f62006-07-03 10:02:33 +02002477static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2478{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002479 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002480
2481 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002482}
2483
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002484static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2485{
2486 struct inquiry_data data;
2487 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2488 int num_rsp = *((__u8 *) skb->data);
2489
2490 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2491
2492 if (!num_rsp)
2493 return;
2494
Johan Hedberg314b2382011-04-27 10:29:57 -04002495 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2496
2497 if (test_bit(HCI_MGMT, &hdev->flags))
2498 mgmt_discovering(hdev->id, 1);
2499 }
2500
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002501 hci_dev_lock(hdev);
2502
Johan Hedberge17acd42011-03-30 23:57:16 +03002503 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002504 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002505 data.pscan_rep_mode = info->pscan_rep_mode;
2506 data.pscan_period_mode = info->pscan_period_mode;
2507 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002508 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002509 data.clock_offset = info->clock_offset;
2510 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002511 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002512 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002513 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class,
2514 info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002515 }
2516
2517 hci_dev_unlock(hdev);
2518}
2519
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002520static inline u8 hci_get_auth_req(struct hci_conn *conn)
2521{
2522 /* If remote requests dedicated bonding follow that lead */
2523 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2524 /* If both remote and local IO capabilities allow MITM
2525 * protection then require it, otherwise don't */
2526 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2527 return 0x02;
2528 else
2529 return 0x03;
2530 }
2531
2532 /* If remote requests no-bonding follow that lead */
2533 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002534 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002535
2536 return conn->auth_type;
2537}
2538
Marcel Holtmann04936842008-07-14 20:13:48 +02002539static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2540{
2541 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2542 struct hci_conn *conn;
2543
2544 BT_DBG("%s", hdev->name);
2545
2546 hci_dev_lock(hdev);
2547
2548 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002549 if (!conn)
2550 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002551
Johan Hedberg03b555e2011-01-04 15:40:05 +02002552 hci_conn_hold(conn);
2553
2554 if (!test_bit(HCI_MGMT, &hdev->flags))
2555 goto unlock;
2556
2557 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2558 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002559 struct hci_cp_io_capability_reply cp;
2560
2561 bacpy(&cp.bdaddr, &ev->bdaddr);
2562 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002563 conn->auth_type = hci_get_auth_req(conn);
2564 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002565
Szymon Jancce85ee12011-03-22 13:12:23 +01002566 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2567 hci_find_remote_oob_data(hdev, &conn->dst))
2568 cp.oob_data = 0x01;
2569 else
2570 cp.oob_data = 0x00;
2571
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002572 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2573 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002574 } else {
2575 struct hci_cp_io_capability_neg_reply cp;
2576
2577 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedbergbe771592011-04-28 11:28:57 -07002578 cp.reason = 0x18; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02002579
2580 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2581 sizeof(cp), &cp);
2582 }
2583
2584unlock:
2585 hci_dev_unlock(hdev);
2586}
2587
2588static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2589{
2590 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2591 struct hci_conn *conn;
2592
2593 BT_DBG("%s", hdev->name);
2594
2595 hci_dev_lock(hdev);
2596
2597 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2598 if (!conn)
2599 goto unlock;
2600
Johan Hedberg03b555e2011-01-04 15:40:05 +02002601 conn->remote_cap = ev->capability;
2602 conn->remote_oob = ev->oob_data;
2603 conn->remote_auth = ev->authentication;
2604
2605unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002606 hci_dev_unlock(hdev);
2607}
2608
Johan Hedberga5c29682011-02-19 12:05:57 -03002609static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2610 struct sk_buff *skb)
2611{
2612 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002613 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002614 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002615
2616 BT_DBG("%s", hdev->name);
2617
2618 hci_dev_lock(hdev);
2619
Johan Hedberg7a828902011-04-28 11:28:53 -07002620 if (!test_bit(HCI_MGMT, &hdev->flags))
2621 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002622
Johan Hedberg7a828902011-04-28 11:28:53 -07002623 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2624 if (!conn)
2625 goto unlock;
2626
2627 loc_mitm = (conn->auth_type & 0x01);
2628 rem_mitm = (conn->remote_auth & 0x01);
2629
2630 /* If we require MITM but the remote device can't provide that
2631 * (it has NoInputNoOutput) then reject the confirmation
2632 * request. The only exception is when we're dedicated bonding
2633 * initiators (connect_cfm_cb set) since then we always have the MITM
2634 * bit set. */
2635 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2636 BT_DBG("Rejecting request: remote device can't provide MITM");
2637 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2638 sizeof(ev->bdaddr), &ev->bdaddr);
2639 goto unlock;
2640 }
2641
2642 /* If no side requires MITM protection; auto-accept */
2643 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2644 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002645
2646 /* If we're not the initiators request authorization to
2647 * proceed from user space (mgmt_user_confirm with
2648 * confirm_hint set to 1). */
2649 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2650 BT_DBG("Confirming auto-accept as acceptor");
2651 confirm_hint = 1;
2652 goto confirm;
2653 }
2654
Johan Hedberg9f616562011-04-28 11:28:54 -07002655 BT_DBG("Auto-accept of user confirmation with %ums delay",
2656 hdev->auto_accept_delay);
2657
2658 if (hdev->auto_accept_delay > 0) {
2659 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2660 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2661 goto unlock;
2662 }
2663
Johan Hedberg7a828902011-04-28 11:28:53 -07002664 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2665 sizeof(ev->bdaddr), &ev->bdaddr);
2666 goto unlock;
2667 }
2668
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002669confirm:
2670 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2671 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002672
2673unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002674 hci_dev_unlock(hdev);
2675}
2676
Marcel Holtmann04936842008-07-14 20:13:48 +02002677static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2678{
2679 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2680 struct hci_conn *conn;
2681
2682 BT_DBG("%s", hdev->name);
2683
2684 hci_dev_lock(hdev);
2685
2686 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002687 if (!conn)
2688 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002689
Johan Hedberg2a611692011-02-19 12:06:00 -03002690 /* To avoid duplicate auth_failed events to user space we check
2691 * the HCI_CONN_AUTH_PEND flag which will be set if we
2692 * initiated the authentication. A traditional auth_complete
2693 * event gets always produced as initiator and is also mapped to
2694 * the mgmt_auth_failed event */
2695 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2696 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2697
2698 hci_conn_put(conn);
2699
2700unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002701 hci_dev_unlock(hdev);
2702}
2703
Marcel Holtmann41a96212008-07-14 20:13:48 +02002704static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2705{
2706 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2707 struct inquiry_entry *ie;
2708
2709 BT_DBG("%s", hdev->name);
2710
2711 hci_dev_lock(hdev);
2712
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002713 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2714 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002715 ie->data.ssp_mode = (ev->features[0] & 0x01);
2716
2717 hci_dev_unlock(hdev);
2718}
2719
Szymon Janc2763eda2011-03-22 13:12:22 +01002720static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2721 struct sk_buff *skb)
2722{
2723 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2724 struct oob_data *data;
2725
2726 BT_DBG("%s", hdev->name);
2727
2728 hci_dev_lock(hdev);
2729
Szymon Jance1ba1f12011-04-06 13:01:59 +02002730 if (!test_bit(HCI_MGMT, &hdev->flags))
2731 goto unlock;
2732
Szymon Janc2763eda2011-03-22 13:12:22 +01002733 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2734 if (data) {
2735 struct hci_cp_remote_oob_data_reply cp;
2736
2737 bacpy(&cp.bdaddr, &ev->bdaddr);
2738 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2739 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2740
2741 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2742 &cp);
2743 } else {
2744 struct hci_cp_remote_oob_data_neg_reply cp;
2745
2746 bacpy(&cp.bdaddr, &ev->bdaddr);
2747 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2748 &cp);
2749 }
2750
Szymon Jance1ba1f12011-04-06 13:01:59 +02002751unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002752 hci_dev_unlock(hdev);
2753}
2754
Ville Tervofcd89c02011-02-10 22:38:47 -03002755static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2756{
2757 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2758 struct hci_conn *conn;
2759
2760 BT_DBG("%s status %d", hdev->name, ev->status);
2761
2762 hci_dev_lock(hdev);
2763
2764 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002765 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08002766 conn = hci_conn_add(hdev, LE_LINK, 0, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002767 if (!conn) {
2768 BT_ERR("No memory for new connection");
2769 hci_dev_unlock(hdev);
2770 return;
2771 }
Andre Guedes149c0972011-05-31 14:20:54 -03002772
2773 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002774 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002775
2776 if (ev->status) {
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002777 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002778 hci_proto_connect_cfm(conn, ev->status);
2779 conn->state = BT_CLOSED;
2780 hci_conn_del(conn);
2781 goto unlock;
2782 }
2783
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002784 mgmt_connected(hdev->id, &ev->bdaddr);
2785
Vinicius Costa Gomes403d2c82011-06-09 18:50:50 -03002786 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002787 conn->handle = __le16_to_cpu(ev->handle);
2788 conn->state = BT_CONNECTED;
2789
2790 hci_conn_hold_device(conn);
2791 hci_conn_add_sysfs(conn);
2792
2793 hci_proto_connect_cfm(conn, ev->status);
2794
2795unlock:
2796 hci_dev_unlock(hdev);
2797}
2798
Andre Guedes5df108f2011-05-26 16:23:51 -03002799static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2800 struct sk_buff *skb)
2801{
2802 struct hci_ev_le_advertising_info *ev;
2803 u8 num_reports;
2804
2805 num_reports = skb->data[0];
2806 ev = (void *) &skb->data[1];
2807
2808 hci_dev_lock(hdev);
2809
2810 hci_add_adv_entry(hdev, ev);
2811
2812 while (--num_reports) {
2813 ev = (void *) (ev->data + ev->length + 1);
2814 hci_add_adv_entry(hdev, ev);
2815 }
2816
2817 hci_dev_unlock(hdev);
2818}
2819
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002820static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2821 struct sk_buff *skb)
2822{
2823 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2824 struct hci_cp_le_ltk_reply cp;
2825 struct hci_conn *conn;
2826
2827 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2828
2829 hci_dev_lock(hdev);
2830
2831 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2832
2833 memset(&cp, 0, sizeof(cp));
2834 cp.handle = cpu_to_le16(conn->handle);
2835 memcpy(cp.ltk, conn->ltk, sizeof(conn->ltk));
2836
2837 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2838
2839 hci_dev_unlock(hdev);
2840}
2841
Ville Tervofcd89c02011-02-10 22:38:47 -03002842static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2843{
2844 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2845
2846 skb_pull(skb, sizeof(*le_ev));
2847
2848 switch (le_ev->subevent) {
2849 case HCI_EV_LE_CONN_COMPLETE:
2850 hci_le_conn_complete_evt(hdev, skb);
2851 break;
2852
Andre Guedes5df108f2011-05-26 16:23:51 -03002853 case HCI_EV_LE_ADVERTISING_REPORT:
2854 hci_le_adv_report_evt(hdev, skb);
2855 break;
2856
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002857 case HCI_EV_LE_LTK_REQ:
2858 hci_le_ltk_request_evt(hdev, skb);
2859 break;
2860
Ville Tervofcd89c02011-02-10 22:38:47 -03002861 default:
2862 break;
2863 }
2864}
2865
Linus Torvalds1da177e2005-04-16 15:20:36 -07002866void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2867{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002868 struct hci_event_hdr *hdr = (void *) skb->data;
2869 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002870
2871 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2872
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002873 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002874 case HCI_EV_INQUIRY_COMPLETE:
2875 hci_inquiry_complete_evt(hdev, skb);
2876 break;
2877
2878 case HCI_EV_INQUIRY_RESULT:
2879 hci_inquiry_result_evt(hdev, skb);
2880 break;
2881
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002882 case HCI_EV_CONN_COMPLETE:
2883 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002884 break;
2885
Linus Torvalds1da177e2005-04-16 15:20:36 -07002886 case HCI_EV_CONN_REQUEST:
2887 hci_conn_request_evt(hdev, skb);
2888 break;
2889
Linus Torvalds1da177e2005-04-16 15:20:36 -07002890 case HCI_EV_DISCONN_COMPLETE:
2891 hci_disconn_complete_evt(hdev, skb);
2892 break;
2893
Linus Torvalds1da177e2005-04-16 15:20:36 -07002894 case HCI_EV_AUTH_COMPLETE:
2895 hci_auth_complete_evt(hdev, skb);
2896 break;
2897
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002898 case HCI_EV_REMOTE_NAME:
2899 hci_remote_name_evt(hdev, skb);
2900 break;
2901
Linus Torvalds1da177e2005-04-16 15:20:36 -07002902 case HCI_EV_ENCRYPT_CHANGE:
2903 hci_encrypt_change_evt(hdev, skb);
2904 break;
2905
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002906 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2907 hci_change_link_key_complete_evt(hdev, skb);
2908 break;
2909
2910 case HCI_EV_REMOTE_FEATURES:
2911 hci_remote_features_evt(hdev, skb);
2912 break;
2913
2914 case HCI_EV_REMOTE_VERSION:
2915 hci_remote_version_evt(hdev, skb);
2916 break;
2917
2918 case HCI_EV_QOS_SETUP_COMPLETE:
2919 hci_qos_setup_complete_evt(hdev, skb);
2920 break;
2921
2922 case HCI_EV_CMD_COMPLETE:
2923 hci_cmd_complete_evt(hdev, skb);
2924 break;
2925
2926 case HCI_EV_CMD_STATUS:
2927 hci_cmd_status_evt(hdev, skb);
2928 break;
2929
2930 case HCI_EV_ROLE_CHANGE:
2931 hci_role_change_evt(hdev, skb);
2932 break;
2933
2934 case HCI_EV_NUM_COMP_PKTS:
2935 hci_num_comp_pkts_evt(hdev, skb);
2936 break;
2937
2938 case HCI_EV_MODE_CHANGE:
2939 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002940 break;
2941
2942 case HCI_EV_PIN_CODE_REQ:
2943 hci_pin_code_request_evt(hdev, skb);
2944 break;
2945
2946 case HCI_EV_LINK_KEY_REQ:
2947 hci_link_key_request_evt(hdev, skb);
2948 break;
2949
2950 case HCI_EV_LINK_KEY_NOTIFY:
2951 hci_link_key_notify_evt(hdev, skb);
2952 break;
2953
2954 case HCI_EV_CLOCK_OFFSET:
2955 hci_clock_offset_evt(hdev, skb);
2956 break;
2957
Marcel Holtmanna8746412008-07-14 20:13:46 +02002958 case HCI_EV_PKT_TYPE_CHANGE:
2959 hci_pkt_type_change_evt(hdev, skb);
2960 break;
2961
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002962 case HCI_EV_PSCAN_REP_MODE:
2963 hci_pscan_rep_mode_evt(hdev, skb);
2964 break;
2965
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002966 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
2967 hci_inquiry_result_with_rssi_evt(hdev, skb);
2968 break;
2969
2970 case HCI_EV_REMOTE_EXT_FEATURES:
2971 hci_remote_ext_features_evt(hdev, skb);
2972 break;
2973
2974 case HCI_EV_SYNC_CONN_COMPLETE:
2975 hci_sync_conn_complete_evt(hdev, skb);
2976 break;
2977
2978 case HCI_EV_SYNC_CONN_CHANGED:
2979 hci_sync_conn_changed_evt(hdev, skb);
2980 break;
2981
Marcel Holtmann04837f62006-07-03 10:02:33 +02002982 case HCI_EV_SNIFF_SUBRATE:
2983 hci_sniff_subrate_evt(hdev, skb);
2984 break;
2985
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002986 case HCI_EV_EXTENDED_INQUIRY_RESULT:
2987 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002988 break;
2989
Marcel Holtmann04936842008-07-14 20:13:48 +02002990 case HCI_EV_IO_CAPA_REQUEST:
2991 hci_io_capa_request_evt(hdev, skb);
2992 break;
2993
Johan Hedberg03b555e2011-01-04 15:40:05 +02002994 case HCI_EV_IO_CAPA_REPLY:
2995 hci_io_capa_reply_evt(hdev, skb);
2996 break;
2997
Johan Hedberga5c29682011-02-19 12:05:57 -03002998 case HCI_EV_USER_CONFIRM_REQUEST:
2999 hci_user_confirm_request_evt(hdev, skb);
3000 break;
3001
Marcel Holtmann04936842008-07-14 20:13:48 +02003002 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3003 hci_simple_pair_complete_evt(hdev, skb);
3004 break;
3005
Marcel Holtmann41a96212008-07-14 20:13:48 +02003006 case HCI_EV_REMOTE_HOST_FEATURES:
3007 hci_remote_host_features_evt(hdev, skb);
3008 break;
3009
Ville Tervofcd89c02011-02-10 22:38:47 -03003010 case HCI_EV_LE_META:
3011 hci_le_meta_evt(hdev, skb);
3012 break;
3013
Szymon Janc2763eda2011-03-22 13:12:22 +01003014 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3015 hci_remote_oob_data_request_evt(hdev, skb);
3016 break;
3017
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003018 default:
3019 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003020 break;
3021 }
3022
3023 kfree_skb(skb);
3024 hdev->stat.evt_rx++;
3025}
3026
3027/* Generate internal stack event */
3028void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3029{
3030 struct hci_event_hdr *hdr;
3031 struct hci_ev_stack_internal *ev;
3032 struct sk_buff *skb;
3033
3034 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3035 if (!skb)
3036 return;
3037
3038 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3039 hdr->evt = HCI_EV_STACK_INTERNAL;
3040 hdr->plen = sizeof(*ev) + dlen;
3041
3042 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3043 ev->type = type;
3044 memcpy(ev->data, data, dlen);
3045
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003046 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003047 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003048
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003049 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003050 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003051 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003052 kfree_skb(skb);
3053}