blob: 4ed59a8a383eaf9fecaf13938ccbf5e12fb202ea [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 Tervo6de6c182011-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 Guedes971e3a42011-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 Guedes971e3a42011-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 Guedeseb9d91f2011-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 Guedes35815082011-05-26 16:23:53 -0300884 if (cp->enable == 0x01) {
885 del_timer(&hdev->adv_timer);
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300886 hci_adv_entries_clear(hdev);
Andre Guedes35815082011-05-26 16:23:53 -0300887 } else if (cp->enable == 0x00) {
888 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
889 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300890
891 hci_dev_unlock(hdev);
892}
893
Vinicius Costa Gomesa7a595f2011-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
Andre Guedesf9b49302011-06-30 19:20:53 -0300918static inline void hci_cc_write_le_host_supported(struct hci_dev *hdev,
919 struct sk_buff *skb)
920{
921 struct hci_cp_read_local_ext_features cp;
922 __u8 status = *((__u8 *) skb->data);
923
924 BT_DBG("%s status 0x%x", hdev->name, status);
925
926 if (status)
927 return;
928
929 cp.page = 0x01;
930 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp), &cp);
931}
932
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200933static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
934{
935 BT_DBG("%s status 0x%x", hdev->name, status);
936
937 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200938 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200939 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -0400940 return;
941 }
942
943 if (test_bit(HCI_MGMT, &hdev->flags) &&
944 !test_and_set_bit(HCI_INQUIRY,
945 &hdev->flags))
946 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200947}
948
Linus Torvalds1da177e2005-04-16 15:20:36 -0700949static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
950{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200951 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200954 BT_DBG("%s status 0x%x", hdev->name, status);
955
956 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700957 if (!cp)
958 return;
959
960 hci_dev_lock(hdev);
961
962 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
963
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200964 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965
966 if (status) {
967 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200968 if (status != 0x0c || conn->attempt > 2) {
969 conn->state = BT_CLOSED;
970 hci_proto_connect_cfm(conn, status);
971 hci_conn_del(conn);
972 } else
973 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974 }
975 } else {
976 if (!conn) {
977 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
978 if (conn) {
979 conn->out = 1;
980 conn->link_mode |= HCI_LM_MASTER;
981 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -0300982 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 }
984 }
985
986 hci_dev_unlock(hdev);
987}
988
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200989static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700990{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200991 struct hci_cp_add_sco *cp;
992 struct hci_conn *acl, *sco;
993 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200995 BT_DBG("%s status 0x%x", hdev->name, status);
996
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200997 if (!status)
998 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001000 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1001 if (!cp)
1002 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001003
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001004 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001006 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001007
1008 hci_dev_lock(hdev);
1009
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001010 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001011 if (acl) {
1012 sco = acl->link;
1013 if (sco) {
1014 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001015
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001016 hci_proto_connect_cfm(sco, status);
1017 hci_conn_del(sco);
1018 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001019 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001020
1021 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001022}
1023
Marcel Holtmannf8558552008-07-14 20:13:49 +02001024static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1025{
1026 struct hci_cp_auth_requested *cp;
1027 struct hci_conn *conn;
1028
1029 BT_DBG("%s status 0x%x", hdev->name, status);
1030
1031 if (!status)
1032 return;
1033
1034 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1035 if (!cp)
1036 return;
1037
1038 hci_dev_lock(hdev);
1039
1040 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1041 if (conn) {
1042 if (conn->state == BT_CONFIG) {
1043 hci_proto_connect_cfm(conn, status);
1044 hci_conn_put(conn);
1045 }
1046 }
1047
1048 hci_dev_unlock(hdev);
1049}
1050
1051static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1052{
1053 struct hci_cp_set_conn_encrypt *cp;
1054 struct hci_conn *conn;
1055
1056 BT_DBG("%s status 0x%x", hdev->name, status);
1057
1058 if (!status)
1059 return;
1060
1061 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1062 if (!cp)
1063 return;
1064
1065 hci_dev_lock(hdev);
1066
1067 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1068 if (conn) {
1069 if (conn->state == BT_CONFIG) {
1070 hci_proto_connect_cfm(conn, status);
1071 hci_conn_put(conn);
1072 }
1073 }
1074
1075 hci_dev_unlock(hdev);
1076}
1077
Johan Hedberg127178d2010-11-18 22:22:29 +02001078static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001079 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001080{
Johan Hedberg392599b2010-11-18 22:22:28 +02001081 if (conn->state != BT_CONFIG || !conn->out)
1082 return 0;
1083
Johan Hedberg765c2a92011-01-19 12:06:52 +05301084 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001085 return 0;
1086
1087 /* Only request authentication for SSP connections or non-SSP
1088 * devices with sec_level HIGH */
1089 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Johan Hedberg765c2a92011-01-19 12:06:52 +05301090 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001091 return 0;
1092
Johan Hedberg392599b2010-11-18 22:22:28 +02001093 return 1;
1094}
1095
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001096static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1097{
Johan Hedberg127178d2010-11-18 22:22:29 +02001098 struct hci_cp_remote_name_req *cp;
1099 struct hci_conn *conn;
1100
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001101 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001102
1103 /* If successful wait for the name req complete event before
1104 * checking for the need to do authentication */
1105 if (!status)
1106 return;
1107
1108 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1109 if (!cp)
1110 return;
1111
1112 hci_dev_lock(hdev);
1113
1114 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001115 if (!conn)
1116 goto unlock;
1117
1118 if (!hci_outgoing_auth_needed(hdev, conn))
1119 goto unlock;
1120
1121 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001122 struct hci_cp_auth_requested cp;
1123 cp.handle = __cpu_to_le16(conn->handle);
1124 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1125 }
1126
Johan Hedberg79c6c702011-04-28 11:28:55 -07001127unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001128 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001129}
1130
Marcel Holtmann769be972008-07-14 20:13:49 +02001131static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1132{
1133 struct hci_cp_read_remote_features *cp;
1134 struct hci_conn *conn;
1135
1136 BT_DBG("%s status 0x%x", hdev->name, status);
1137
1138 if (!status)
1139 return;
1140
1141 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1142 if (!cp)
1143 return;
1144
1145 hci_dev_lock(hdev);
1146
1147 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1148 if (conn) {
1149 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001150 hci_proto_connect_cfm(conn, status);
1151 hci_conn_put(conn);
1152 }
1153 }
1154
1155 hci_dev_unlock(hdev);
1156}
1157
1158static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1159{
1160 struct hci_cp_read_remote_ext_features *cp;
1161 struct hci_conn *conn;
1162
1163 BT_DBG("%s status 0x%x", hdev->name, status);
1164
1165 if (!status)
1166 return;
1167
1168 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1169 if (!cp)
1170 return;
1171
1172 hci_dev_lock(hdev);
1173
1174 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1175 if (conn) {
1176 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001177 hci_proto_connect_cfm(conn, status);
1178 hci_conn_put(conn);
1179 }
1180 }
1181
1182 hci_dev_unlock(hdev);
1183}
1184
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001185static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1186{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001187 struct hci_cp_setup_sync_conn *cp;
1188 struct hci_conn *acl, *sco;
1189 __u16 handle;
1190
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001191 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001192
1193 if (!status)
1194 return;
1195
1196 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1197 if (!cp)
1198 return;
1199
1200 handle = __le16_to_cpu(cp->handle);
1201
1202 BT_DBG("%s handle %d", hdev->name, handle);
1203
1204 hci_dev_lock(hdev);
1205
1206 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001207 if (acl) {
1208 sco = acl->link;
1209 if (sco) {
1210 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001211
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001212 hci_proto_connect_cfm(sco, status);
1213 hci_conn_del(sco);
1214 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001215 }
1216
1217 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001218}
1219
1220static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1221{
1222 struct hci_cp_sniff_mode *cp;
1223 struct hci_conn *conn;
1224
1225 BT_DBG("%s status 0x%x", hdev->name, status);
1226
1227 if (!status)
1228 return;
1229
1230 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1231 if (!cp)
1232 return;
1233
1234 hci_dev_lock(hdev);
1235
1236 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001237 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001238 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1239
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001240 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1241 hci_sco_setup(conn, status);
1242 }
1243
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001244 hci_dev_unlock(hdev);
1245}
1246
1247static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1248{
1249 struct hci_cp_exit_sniff_mode *cp;
1250 struct hci_conn *conn;
1251
1252 BT_DBG("%s status 0x%x", hdev->name, status);
1253
1254 if (!status)
1255 return;
1256
1257 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1258 if (!cp)
1259 return;
1260
1261 hci_dev_lock(hdev);
1262
1263 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001264 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001265 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1266
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001267 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1268 hci_sco_setup(conn, status);
1269 }
1270
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001271 hci_dev_unlock(hdev);
1272}
1273
Ville Tervofcd89c02011-02-10 22:38:47 -03001274static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1275{
1276 struct hci_cp_le_create_conn *cp;
1277 struct hci_conn *conn;
1278
1279 BT_DBG("%s status 0x%x", hdev->name, status);
1280
1281 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1282 if (!cp)
1283 return;
1284
1285 hci_dev_lock(hdev);
1286
1287 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1288
1289 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1290 conn);
1291
1292 if (status) {
1293 if (conn && conn->state == BT_CONNECT) {
1294 conn->state = BT_CLOSED;
1295 hci_proto_connect_cfm(conn, status);
1296 hci_conn_del(conn);
1297 }
1298 } else {
1299 if (!conn) {
1300 conn = hci_conn_add(hdev, LE_LINK, &cp->peer_addr);
Andre Guedes29b79882011-05-31 14:20:54 -03001301 if (conn) {
1302 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001303 conn->out = 1;
Andre Guedes29b79882011-05-31 14:20:54 -03001304 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001305 BT_ERR("No memory for new connection");
Andre Guedes29b79882011-05-31 14:20:54 -03001306 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001307 }
1308 }
1309
1310 hci_dev_unlock(hdev);
1311}
1312
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001313static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1314{
1315 BT_DBG("%s status 0x%x", hdev->name, status);
1316}
1317
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001318static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1319{
1320 __u8 status = *((__u8 *) skb->data);
1321
1322 BT_DBG("%s status %d", hdev->name, status);
1323
Johan Hedberg314b2382011-04-27 10:29:57 -04001324 if (test_bit(HCI_MGMT, &hdev->flags) &&
1325 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1326 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001327
Johan Hedberg23bb5762010-12-21 23:01:27 +02001328 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001329
1330 hci_conn_check_pending(hdev);
1331}
1332
Linus Torvalds1da177e2005-04-16 15:20:36 -07001333static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1334{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001335 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001336 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337 int num_rsp = *((__u8 *) skb->data);
1338
1339 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1340
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001341 if (!num_rsp)
1342 return;
1343
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001345
Johan Hedberg314b2382011-04-27 10:29:57 -04001346 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
1347
1348 if (test_bit(HCI_MGMT, &hdev->flags))
1349 mgmt_discovering(hdev->id, 1);
1350 }
1351
Johan Hedberge17acd42011-03-30 23:57:16 +03001352 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001353 bacpy(&data.bdaddr, &info->bdaddr);
1354 data.pscan_rep_mode = info->pscan_rep_mode;
1355 data.pscan_period_mode = info->pscan_period_mode;
1356 data.pscan_mode = info->pscan_mode;
1357 memcpy(data.dev_class, info->dev_class, 3);
1358 data.clock_offset = info->clock_offset;
1359 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001360 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001361 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03001362 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class, 0,
1363 NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001364 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001365
Linus Torvalds1da177e2005-04-16 15:20:36 -07001366 hci_dev_unlock(hdev);
1367}
1368
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001369static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001370{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001371 struct hci_ev_conn_complete *ev = (void *) skb->data;
1372 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001373
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001374 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001375
Linus Torvalds1da177e2005-04-16 15:20:36 -07001376 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001377
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001378 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001379 if (!conn) {
1380 if (ev->link_type != SCO_LINK)
1381 goto unlock;
1382
1383 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1384 if (!conn)
1385 goto unlock;
1386
1387 conn->type = SCO_LINK;
1388 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001389
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001390 if (!ev->status) {
1391 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001392
1393 if (conn->type == ACL_LINK) {
1394 conn->state = BT_CONFIG;
1395 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001396 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedbergf7520542011-01-20 12:34:39 +02001397 mgmt_connected(hdev->id, &ev->bdaddr);
Marcel Holtmann769be972008-07-14 20:13:49 +02001398 } else
1399 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001400
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001401 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001402 hci_conn_add_sysfs(conn);
1403
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001404 if (test_bit(HCI_AUTH, &hdev->flags))
1405 conn->link_mode |= HCI_LM_AUTH;
1406
1407 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1408 conn->link_mode |= HCI_LM_ENCRYPT;
1409
1410 /* Get remote features */
1411 if (conn->type == ACL_LINK) {
1412 struct hci_cp_read_remote_features cp;
1413 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001414 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1415 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001416 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001417
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001418 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001419 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001420 struct hci_cp_change_conn_ptype cp;
1421 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001422 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1423 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1424 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001425 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001426 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001427 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001428 if (conn->type == ACL_LINK)
1429 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1430 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001431
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001432 if (conn->type == ACL_LINK)
1433 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001434
Marcel Holtmann769be972008-07-14 20:13:49 +02001435 if (ev->status) {
1436 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001437 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001438 } else if (ev->link_type != ACL_LINK)
1439 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001440
1441unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001443
1444 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001445}
1446
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1448{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001449 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450 int mask = hdev->link_mode;
1451
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001452 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1453 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454
1455 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1456
Szymon Janc138d22e2011-02-17 16:44:23 +01001457 if ((mask & HCI_LM_ACCEPT) &&
1458 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001459 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001460 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001462
1463 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001464
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001465 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1466 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001467 memcpy(ie->data.dev_class, ev->dev_class, 3);
1468
Linus Torvalds1da177e2005-04-16 15:20:36 -07001469 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1470 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001471 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1472 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001473 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001474 hci_dev_unlock(hdev);
1475 return;
1476 }
1477 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001478
Linus Torvalds1da177e2005-04-16 15:20:36 -07001479 memcpy(conn->dev_class, ev->dev_class, 3);
1480 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001481
Linus Torvalds1da177e2005-04-16 15:20:36 -07001482 hci_dev_unlock(hdev);
1483
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001484 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1485 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001486
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001487 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001489 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1490 cp.role = 0x00; /* Become master */
1491 else
1492 cp.role = 0x01; /* Remain slave */
1493
1494 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1495 sizeof(cp), &cp);
1496 } else {
1497 struct hci_cp_accept_sync_conn_req cp;
1498
1499 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001500 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001501
1502 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1503 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1504 cp.max_latency = cpu_to_le16(0xffff);
1505 cp.content_format = cpu_to_le16(hdev->voice_setting);
1506 cp.retrans_effort = 0xff;
1507
1508 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1509 sizeof(cp), &cp);
1510 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511 } else {
1512 /* Connection rejected */
1513 struct hci_cp_reject_conn_req cp;
1514
1515 bacpy(&cp.bdaddr, &ev->bdaddr);
1516 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001517 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001518 }
1519}
1520
Linus Torvalds1da177e2005-04-16 15:20:36 -07001521static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1522{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001523 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001524 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001525
1526 BT_DBG("%s status %d", hdev->name, ev->status);
1527
Johan Hedberg8962ee72011-01-20 12:40:27 +02001528 if (ev->status) {
1529 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001531 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001532
1533 hci_dev_lock(hdev);
1534
Marcel Holtmann04837f62006-07-03 10:02:33 +02001535 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001536 if (!conn)
1537 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001538
Johan Hedbergf7520542011-01-20 12:34:39 +02001539 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001540
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001541 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedbergf7520542011-01-20 12:34:39 +02001542 mgmt_disconnected(hdev->id, &conn->dst);
1543
1544 hci_proto_disconn_cfm(conn, ev->reason);
1545 hci_conn_del(conn);
1546
1547unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001548 hci_dev_unlock(hdev);
1549}
1550
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001551static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1552{
1553 struct hci_ev_auth_complete *ev = (void *) skb->data;
1554 struct hci_conn *conn;
1555
1556 BT_DBG("%s status %d", hdev->name, ev->status);
1557
1558 hci_dev_lock(hdev);
1559
1560 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001561 if (!conn)
1562 goto unlock;
1563
1564 if (!ev->status) {
1565 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1566 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1567 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001568 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001569 conn->link_mode |= HCI_LM_AUTH;
1570 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001571 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001572 } else {
1573 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1574 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001575
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001576 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1577 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001578
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001579 if (conn->state == BT_CONFIG) {
1580 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1581 struct hci_cp_set_conn_encrypt cp;
1582 cp.handle = ev->handle;
1583 cp.encrypt = 0x01;
1584 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1585 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001586 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001587 conn->state = BT_CONNECTED;
1588 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001589 hci_conn_put(conn);
1590 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001591 } else {
1592 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001593
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001594 hci_conn_hold(conn);
1595 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1596 hci_conn_put(conn);
1597 }
1598
1599 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1600 if (!ev->status) {
1601 struct hci_cp_set_conn_encrypt cp;
1602 cp.handle = ev->handle;
1603 cp.encrypt = 0x01;
1604 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1605 &cp);
1606 } else {
1607 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1608 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001609 }
1610 }
1611
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001612unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001613 hci_dev_unlock(hdev);
1614}
1615
1616static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1617{
Johan Hedberg127178d2010-11-18 22:22:29 +02001618 struct hci_ev_remote_name *ev = (void *) skb->data;
1619 struct hci_conn *conn;
1620
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001621 BT_DBG("%s", hdev->name);
1622
1623 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001624
1625 hci_dev_lock(hdev);
1626
Johan Hedberga88a9652011-03-30 13:18:12 +03001627 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1628 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1629
Johan Hedberg127178d2010-11-18 22:22:29 +02001630 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001631 if (!conn)
1632 goto unlock;
1633
1634 if (!hci_outgoing_auth_needed(hdev, conn))
1635 goto unlock;
1636
1637 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001638 struct hci_cp_auth_requested cp;
1639 cp.handle = __cpu_to_le16(conn->handle);
1640 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1641 }
1642
Johan Hedberg79c6c702011-04-28 11:28:55 -07001643unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001644 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001645}
1646
1647static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1648{
1649 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1650 struct hci_conn *conn;
1651
1652 BT_DBG("%s status %d", hdev->name, ev->status);
1653
1654 hci_dev_lock(hdev);
1655
1656 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1657 if (conn) {
1658 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001659 if (ev->encrypt) {
1660 /* Encryption implies authentication */
1661 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001662 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03001663 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001664 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001665 conn->link_mode &= ~HCI_LM_ENCRYPT;
1666 }
1667
1668 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1669
Marcel Holtmannf8558552008-07-14 20:13:49 +02001670 if (conn->state == BT_CONFIG) {
1671 if (!ev->status)
1672 conn->state = BT_CONNECTED;
1673
1674 hci_proto_connect_cfm(conn, ev->status);
1675 hci_conn_put(conn);
1676 } else
1677 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001678 }
1679
1680 hci_dev_unlock(hdev);
1681}
1682
1683static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1684{
1685 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1686 struct hci_conn *conn;
1687
1688 BT_DBG("%s status %d", hdev->name, ev->status);
1689
1690 hci_dev_lock(hdev);
1691
1692 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1693 if (conn) {
1694 if (!ev->status)
1695 conn->link_mode |= HCI_LM_SECURE;
1696
1697 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1698
1699 hci_key_change_cfm(conn, ev->status);
1700 }
1701
1702 hci_dev_unlock(hdev);
1703}
1704
1705static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1706{
1707 struct hci_ev_remote_features *ev = (void *) skb->data;
1708 struct hci_conn *conn;
1709
1710 BT_DBG("%s status %d", hdev->name, ev->status);
1711
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001712 hci_dev_lock(hdev);
1713
1714 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001715 if (!conn)
1716 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001717
Johan Hedbergccd556f2010-11-10 17:11:51 +02001718 if (!ev->status)
1719 memcpy(conn->features, ev->features, 8);
1720
1721 if (conn->state != BT_CONFIG)
1722 goto unlock;
1723
1724 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1725 struct hci_cp_read_remote_ext_features cp;
1726 cp.handle = ev->handle;
1727 cp.page = 0x01;
1728 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001729 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001730 goto unlock;
1731 }
1732
Johan Hedberg127178d2010-11-18 22:22:29 +02001733 if (!ev->status) {
1734 struct hci_cp_remote_name_req cp;
1735 memset(&cp, 0, sizeof(cp));
1736 bacpy(&cp.bdaddr, &conn->dst);
1737 cp.pscan_rep_mode = 0x02;
1738 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1739 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001740
Johan Hedberg127178d2010-11-18 22:22:29 +02001741 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001742 conn->state = BT_CONNECTED;
1743 hci_proto_connect_cfm(conn, ev->status);
1744 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001745 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001746
Johan Hedbergccd556f2010-11-10 17:11:51 +02001747unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001748 hci_dev_unlock(hdev);
1749}
1750
1751static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1752{
1753 BT_DBG("%s", hdev->name);
1754}
1755
1756static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1757{
1758 BT_DBG("%s", hdev->name);
1759}
1760
1761static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1762{
1763 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1764 __u16 opcode;
1765
1766 skb_pull(skb, sizeof(*ev));
1767
1768 opcode = __le16_to_cpu(ev->opcode);
1769
1770 switch (opcode) {
1771 case HCI_OP_INQUIRY_CANCEL:
1772 hci_cc_inquiry_cancel(hdev, skb);
1773 break;
1774
1775 case HCI_OP_EXIT_PERIODIC_INQ:
1776 hci_cc_exit_periodic_inq(hdev, skb);
1777 break;
1778
1779 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1780 hci_cc_remote_name_req_cancel(hdev, skb);
1781 break;
1782
1783 case HCI_OP_ROLE_DISCOVERY:
1784 hci_cc_role_discovery(hdev, skb);
1785 break;
1786
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001787 case HCI_OP_READ_LINK_POLICY:
1788 hci_cc_read_link_policy(hdev, skb);
1789 break;
1790
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001791 case HCI_OP_WRITE_LINK_POLICY:
1792 hci_cc_write_link_policy(hdev, skb);
1793 break;
1794
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001795 case HCI_OP_READ_DEF_LINK_POLICY:
1796 hci_cc_read_def_link_policy(hdev, skb);
1797 break;
1798
1799 case HCI_OP_WRITE_DEF_LINK_POLICY:
1800 hci_cc_write_def_link_policy(hdev, skb);
1801 break;
1802
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001803 case HCI_OP_RESET:
1804 hci_cc_reset(hdev, skb);
1805 break;
1806
1807 case HCI_OP_WRITE_LOCAL_NAME:
1808 hci_cc_write_local_name(hdev, skb);
1809 break;
1810
1811 case HCI_OP_READ_LOCAL_NAME:
1812 hci_cc_read_local_name(hdev, skb);
1813 break;
1814
1815 case HCI_OP_WRITE_AUTH_ENABLE:
1816 hci_cc_write_auth_enable(hdev, skb);
1817 break;
1818
1819 case HCI_OP_WRITE_ENCRYPT_MODE:
1820 hci_cc_write_encrypt_mode(hdev, skb);
1821 break;
1822
1823 case HCI_OP_WRITE_SCAN_ENABLE:
1824 hci_cc_write_scan_enable(hdev, skb);
1825 break;
1826
1827 case HCI_OP_READ_CLASS_OF_DEV:
1828 hci_cc_read_class_of_dev(hdev, skb);
1829 break;
1830
1831 case HCI_OP_WRITE_CLASS_OF_DEV:
1832 hci_cc_write_class_of_dev(hdev, skb);
1833 break;
1834
1835 case HCI_OP_READ_VOICE_SETTING:
1836 hci_cc_read_voice_setting(hdev, skb);
1837 break;
1838
1839 case HCI_OP_WRITE_VOICE_SETTING:
1840 hci_cc_write_voice_setting(hdev, skb);
1841 break;
1842
1843 case HCI_OP_HOST_BUFFER_SIZE:
1844 hci_cc_host_buffer_size(hdev, skb);
1845 break;
1846
Marcel Holtmann333140b2008-07-14 20:13:48 +02001847 case HCI_OP_READ_SSP_MODE:
1848 hci_cc_read_ssp_mode(hdev, skb);
1849 break;
1850
1851 case HCI_OP_WRITE_SSP_MODE:
1852 hci_cc_write_ssp_mode(hdev, skb);
1853 break;
1854
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001855 case HCI_OP_READ_LOCAL_VERSION:
1856 hci_cc_read_local_version(hdev, skb);
1857 break;
1858
1859 case HCI_OP_READ_LOCAL_COMMANDS:
1860 hci_cc_read_local_commands(hdev, skb);
1861 break;
1862
1863 case HCI_OP_READ_LOCAL_FEATURES:
1864 hci_cc_read_local_features(hdev, skb);
1865 break;
1866
Andre Guedes971e3a42011-06-30 19:20:52 -03001867 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1868 hci_cc_read_local_ext_features(hdev, skb);
1869 break;
1870
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001871 case HCI_OP_READ_BUFFER_SIZE:
1872 hci_cc_read_buffer_size(hdev, skb);
1873 break;
1874
1875 case HCI_OP_READ_BD_ADDR:
1876 hci_cc_read_bd_addr(hdev, skb);
1877 break;
1878
Johan Hedberg23bb5762010-12-21 23:01:27 +02001879 case HCI_OP_WRITE_CA_TIMEOUT:
1880 hci_cc_write_ca_timeout(hdev, skb);
1881 break;
1882
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001883 case HCI_OP_DELETE_STORED_LINK_KEY:
1884 hci_cc_delete_stored_link_key(hdev, skb);
1885 break;
1886
Johan Hedbergd5859e22011-01-25 01:19:58 +02001887 case HCI_OP_SET_EVENT_MASK:
1888 hci_cc_set_event_mask(hdev, skb);
1889 break;
1890
1891 case HCI_OP_WRITE_INQUIRY_MODE:
1892 hci_cc_write_inquiry_mode(hdev, skb);
1893 break;
1894
1895 case HCI_OP_READ_INQ_RSP_TX_POWER:
1896 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1897 break;
1898
1899 case HCI_OP_SET_EVENT_FLT:
1900 hci_cc_set_event_flt(hdev, skb);
1901 break;
1902
Johan Hedberg980e1a52011-01-22 06:10:07 +02001903 case HCI_OP_PIN_CODE_REPLY:
1904 hci_cc_pin_code_reply(hdev, skb);
1905 break;
1906
1907 case HCI_OP_PIN_CODE_NEG_REPLY:
1908 hci_cc_pin_code_neg_reply(hdev, skb);
1909 break;
1910
Szymon Jancc35938b2011-03-22 13:12:21 +01001911 case HCI_OP_READ_LOCAL_OOB_DATA:
1912 hci_cc_read_local_oob_data_reply(hdev, skb);
1913 break;
1914
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001915 case HCI_OP_LE_READ_BUFFER_SIZE:
1916 hci_cc_le_read_buffer_size(hdev, skb);
1917 break;
1918
Johan Hedberga5c29682011-02-19 12:05:57 -03001919 case HCI_OP_USER_CONFIRM_REPLY:
1920 hci_cc_user_confirm_reply(hdev, skb);
1921 break;
1922
1923 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1924 hci_cc_user_confirm_neg_reply(hdev, skb);
1925 break;
1926
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001927 case HCI_OP_LE_SET_SCAN_ENABLE:
1928 hci_cc_le_set_scan_enable(hdev, skb);
1929 break;
1930
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03001931 case HCI_OP_LE_LTK_REPLY:
1932 hci_cc_le_ltk_reply(hdev, skb);
1933 break;
1934
1935 case HCI_OP_LE_LTK_NEG_REPLY:
1936 hci_cc_le_ltk_neg_reply(hdev, skb);
1937 break;
1938
Andre Guedesf9b49302011-06-30 19:20:53 -03001939 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
1940 hci_cc_write_le_host_supported(hdev, skb);
1941 break;
1942
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001943 default:
1944 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1945 break;
1946 }
1947
Ville Tervo6bd32322011-02-16 16:32:41 +02001948 if (ev->opcode != HCI_OP_NOP)
1949 del_timer(&hdev->cmd_timer);
1950
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001951 if (ev->ncmd) {
1952 atomic_set(&hdev->cmd_cnt, 1);
1953 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01001954 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001955 }
1956}
1957
1958static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1959{
1960 struct hci_ev_cmd_status *ev = (void *) skb->data;
1961 __u16 opcode;
1962
1963 skb_pull(skb, sizeof(*ev));
1964
1965 opcode = __le16_to_cpu(ev->opcode);
1966
1967 switch (opcode) {
1968 case HCI_OP_INQUIRY:
1969 hci_cs_inquiry(hdev, ev->status);
1970 break;
1971
1972 case HCI_OP_CREATE_CONN:
1973 hci_cs_create_conn(hdev, ev->status);
1974 break;
1975
1976 case HCI_OP_ADD_SCO:
1977 hci_cs_add_sco(hdev, ev->status);
1978 break;
1979
Marcel Holtmannf8558552008-07-14 20:13:49 +02001980 case HCI_OP_AUTH_REQUESTED:
1981 hci_cs_auth_requested(hdev, ev->status);
1982 break;
1983
1984 case HCI_OP_SET_CONN_ENCRYPT:
1985 hci_cs_set_conn_encrypt(hdev, ev->status);
1986 break;
1987
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001988 case HCI_OP_REMOTE_NAME_REQ:
1989 hci_cs_remote_name_req(hdev, ev->status);
1990 break;
1991
Marcel Holtmann769be972008-07-14 20:13:49 +02001992 case HCI_OP_READ_REMOTE_FEATURES:
1993 hci_cs_read_remote_features(hdev, ev->status);
1994 break;
1995
1996 case HCI_OP_READ_REMOTE_EXT_FEATURES:
1997 hci_cs_read_remote_ext_features(hdev, ev->status);
1998 break;
1999
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002000 case HCI_OP_SETUP_SYNC_CONN:
2001 hci_cs_setup_sync_conn(hdev, ev->status);
2002 break;
2003
2004 case HCI_OP_SNIFF_MODE:
2005 hci_cs_sniff_mode(hdev, ev->status);
2006 break;
2007
2008 case HCI_OP_EXIT_SNIFF_MODE:
2009 hci_cs_exit_sniff_mode(hdev, ev->status);
2010 break;
2011
Johan Hedberg8962ee72011-01-20 12:40:27 +02002012 case HCI_OP_DISCONNECT:
2013 if (ev->status != 0)
2014 mgmt_disconnect_failed(hdev->id);
2015 break;
2016
Ville Tervofcd89c02011-02-10 22:38:47 -03002017 case HCI_OP_LE_CREATE_CONN:
2018 hci_cs_le_create_conn(hdev, ev->status);
2019 break;
2020
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002021 case HCI_OP_LE_START_ENC:
2022 hci_cs_le_start_enc(hdev, ev->status);
2023 break;
2024
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002025 default:
2026 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2027 break;
2028 }
2029
Ville Tervo6bd32322011-02-16 16:32:41 +02002030 if (ev->opcode != HCI_OP_NOP)
2031 del_timer(&hdev->cmd_timer);
2032
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002033 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002034 atomic_set(&hdev->cmd_cnt, 1);
2035 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002036 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002037 }
2038}
2039
2040static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2041{
2042 struct hci_ev_role_change *ev = (void *) skb->data;
2043 struct hci_conn *conn;
2044
2045 BT_DBG("%s status %d", hdev->name, ev->status);
2046
2047 hci_dev_lock(hdev);
2048
2049 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2050 if (conn) {
2051 if (!ev->status) {
2052 if (ev->role)
2053 conn->link_mode &= ~HCI_LM_MASTER;
2054 else
2055 conn->link_mode |= HCI_LM_MASTER;
2056 }
2057
2058 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2059
2060 hci_role_switch_cfm(conn, ev->status, ev->role);
2061 }
2062
2063 hci_dev_unlock(hdev);
2064}
2065
Linus Torvalds1da177e2005-04-16 15:20:36 -07002066static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2067{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002068 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002069 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002070 int i;
2071
2072 skb_pull(skb, sizeof(*ev));
2073
2074 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2075
2076 if (skb->len < ev->num_hndl * 4) {
2077 BT_DBG("%s bad parameters", hdev->name);
2078 return;
2079 }
2080
2081 tasklet_disable(&hdev->tx_task);
2082
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002083 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002084 struct hci_conn *conn;
2085 __u16 handle, count;
2086
Harvey Harrison83985312008-05-02 16:25:46 -07002087 handle = get_unaligned_le16(ptr++);
2088 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002089
2090 conn = hci_conn_hash_lookup_handle(hdev, handle);
2091 if (conn) {
2092 conn->sent -= count;
2093
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002094 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002095 hdev->acl_cnt += count;
2096 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002097 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002098 } else if (conn->type == LE_LINK) {
2099 if (hdev->le_pkts) {
2100 hdev->le_cnt += count;
2101 if (hdev->le_cnt > hdev->le_pkts)
2102 hdev->le_cnt = hdev->le_pkts;
2103 } else {
2104 hdev->acl_cnt += count;
2105 if (hdev->acl_cnt > hdev->acl_pkts)
2106 hdev->acl_cnt = hdev->acl_pkts;
2107 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002108 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002109 hdev->sco_cnt += count;
2110 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002111 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002112 }
2113 }
2114 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002115
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002116 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002117
2118 tasklet_enable(&hdev->tx_task);
2119}
2120
Marcel Holtmann04837f62006-07-03 10:02:33 +02002121static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002122{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002123 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002124 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002125
2126 BT_DBG("%s status %d", hdev->name, ev->status);
2127
2128 hci_dev_lock(hdev);
2129
Marcel Holtmann04837f62006-07-03 10:02:33 +02002130 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2131 if (conn) {
2132 conn->mode = ev->mode;
2133 conn->interval = __le16_to_cpu(ev->interval);
2134
2135 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2136 if (conn->mode == HCI_CM_ACTIVE)
2137 conn->power_save = 1;
2138 else
2139 conn->power_save = 0;
2140 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002141
2142 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2143 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002144 }
2145
2146 hci_dev_unlock(hdev);
2147}
2148
Linus Torvalds1da177e2005-04-16 15:20:36 -07002149static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2150{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002151 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2152 struct hci_conn *conn;
2153
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002154 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002155
2156 hci_dev_lock(hdev);
2157
2158 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Marcel Holtmann3d7a9d12009-05-09 12:09:21 -07002159 if (conn && conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002160 hci_conn_hold(conn);
2161 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2162 hci_conn_put(conn);
2163 }
2164
Johan Hedberg03b555e2011-01-04 15:40:05 +02002165 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2166 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2167 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002168 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002169 u8 secure;
2170
2171 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2172 secure = 1;
2173 else
2174 secure = 0;
2175
2176 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2177 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002178
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002179 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002180}
2181
Linus Torvalds1da177e2005-04-16 15:20:36 -07002182static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2183{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002184 struct hci_ev_link_key_req *ev = (void *) skb->data;
2185 struct hci_cp_link_key_reply cp;
2186 struct hci_conn *conn;
2187 struct link_key *key;
2188
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002189 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002190
2191 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2192 return;
2193
2194 hci_dev_lock(hdev);
2195
2196 key = hci_find_link_key(hdev, &ev->bdaddr);
2197 if (!key) {
2198 BT_DBG("%s link key not found for %s", hdev->name,
2199 batostr(&ev->bdaddr));
2200 goto not_found;
2201 }
2202
2203 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2204 batostr(&ev->bdaddr));
2205
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002206 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2207 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002208 BT_DBG("%s ignoring debug key", hdev->name);
2209 goto not_found;
2210 }
2211
2212 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002213 if (conn) {
2214 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2215 conn->auth_type != 0xff &&
2216 (conn->auth_type & 0x01)) {
2217 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2218 goto not_found;
2219 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002220
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002221 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2222 conn->pending_sec_level == BT_SECURITY_HIGH) {
2223 BT_DBG("%s ignoring key unauthenticated for high \
2224 security", hdev->name);
2225 goto not_found;
2226 }
2227
2228 conn->key_type = key->type;
2229 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002230 }
2231
2232 bacpy(&cp.bdaddr, &ev->bdaddr);
2233 memcpy(cp.link_key, key->val, 16);
2234
2235 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2236
2237 hci_dev_unlock(hdev);
2238
2239 return;
2240
2241not_found:
2242 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2243 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002244}
2245
Linus Torvalds1da177e2005-04-16 15:20:36 -07002246static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2247{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002248 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2249 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002250 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002251
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002252 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002253
2254 hci_dev_lock(hdev);
2255
2256 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2257 if (conn) {
2258 hci_conn_hold(conn);
2259 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002260 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002261
2262 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2263 conn->key_type = ev->key_type;
2264
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002265 hci_conn_put(conn);
2266 }
2267
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002268 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002269 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002270 ev->key_type, pin_len);
2271
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002272 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002273}
2274
Marcel Holtmann04837f62006-07-03 10:02:33 +02002275static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2276{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002277 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002278 struct hci_conn *conn;
2279
2280 BT_DBG("%s status %d", hdev->name, ev->status);
2281
2282 hci_dev_lock(hdev);
2283
2284 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002285 if (conn && !ev->status) {
2286 struct inquiry_entry *ie;
2287
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002288 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2289 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002290 ie->data.clock_offset = ev->clock_offset;
2291 ie->timestamp = jiffies;
2292 }
2293 }
2294
2295 hci_dev_unlock(hdev);
2296}
2297
Marcel Holtmanna8746412008-07-14 20:13:46 +02002298static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2299{
2300 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2301 struct hci_conn *conn;
2302
2303 BT_DBG("%s status %d", hdev->name, ev->status);
2304
2305 hci_dev_lock(hdev);
2306
2307 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2308 if (conn && !ev->status)
2309 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2310
2311 hci_dev_unlock(hdev);
2312}
2313
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002314static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2315{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002316 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002317 struct inquiry_entry *ie;
2318
2319 BT_DBG("%s", hdev->name);
2320
2321 hci_dev_lock(hdev);
2322
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002323 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2324 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002325 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2326 ie->timestamp = jiffies;
2327 }
2328
2329 hci_dev_unlock(hdev);
2330}
2331
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002332static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2333{
2334 struct inquiry_data data;
2335 int num_rsp = *((__u8 *) skb->data);
2336
2337 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2338
2339 if (!num_rsp)
2340 return;
2341
2342 hci_dev_lock(hdev);
2343
Johan Hedberg314b2382011-04-27 10:29:57 -04002344 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2345
2346 if (test_bit(HCI_MGMT, &hdev->flags))
2347 mgmt_discovering(hdev->id, 1);
2348 }
2349
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002350 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002351 struct inquiry_info_with_rssi_and_pscan_mode *info;
2352 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002353
Johan Hedberge17acd42011-03-30 23:57:16 +03002354 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002355 bacpy(&data.bdaddr, &info->bdaddr);
2356 data.pscan_rep_mode = info->pscan_rep_mode;
2357 data.pscan_period_mode = info->pscan_period_mode;
2358 data.pscan_mode = info->pscan_mode;
2359 memcpy(data.dev_class, info->dev_class, 3);
2360 data.clock_offset = info->clock_offset;
2361 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002362 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002363 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002364 mgmt_device_found(hdev->id, &info->bdaddr,
2365 info->dev_class, info->rssi,
2366 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002367 }
2368 } else {
2369 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2370
Johan Hedberge17acd42011-03-30 23:57:16 +03002371 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002372 bacpy(&data.bdaddr, &info->bdaddr);
2373 data.pscan_rep_mode = info->pscan_rep_mode;
2374 data.pscan_period_mode = info->pscan_period_mode;
2375 data.pscan_mode = 0x00;
2376 memcpy(data.dev_class, info->dev_class, 3);
2377 data.clock_offset = info->clock_offset;
2378 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002379 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002380 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002381 mgmt_device_found(hdev->id, &info->bdaddr,
2382 info->dev_class, info->rssi,
2383 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002384 }
2385 }
2386
2387 hci_dev_unlock(hdev);
2388}
2389
2390static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2391{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002392 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2393 struct hci_conn *conn;
2394
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002395 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002396
Marcel Holtmann41a96212008-07-14 20:13:48 +02002397 hci_dev_lock(hdev);
2398
2399 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002400 if (!conn)
2401 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002402
Johan Hedbergccd556f2010-11-10 17:11:51 +02002403 if (!ev->status && ev->page == 0x01) {
2404 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002405
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002406 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2407 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002408 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002409
Johan Hedbergccd556f2010-11-10 17:11:51 +02002410 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002411 }
2412
Johan Hedbergccd556f2010-11-10 17:11:51 +02002413 if (conn->state != BT_CONFIG)
2414 goto unlock;
2415
Johan Hedberg127178d2010-11-18 22:22:29 +02002416 if (!ev->status) {
2417 struct hci_cp_remote_name_req cp;
2418 memset(&cp, 0, sizeof(cp));
2419 bacpy(&cp.bdaddr, &conn->dst);
2420 cp.pscan_rep_mode = 0x02;
2421 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2422 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002423
Johan Hedberg127178d2010-11-18 22:22:29 +02002424 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002425 conn->state = BT_CONNECTED;
2426 hci_proto_connect_cfm(conn, ev->status);
2427 hci_conn_put(conn);
2428 }
2429
2430unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002431 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002432}
2433
2434static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2435{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002436 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2437 struct hci_conn *conn;
2438
2439 BT_DBG("%s status %d", hdev->name, ev->status);
2440
2441 hci_dev_lock(hdev);
2442
2443 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002444 if (!conn) {
2445 if (ev->link_type == ESCO_LINK)
2446 goto unlock;
2447
2448 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2449 if (!conn)
2450 goto unlock;
2451
2452 conn->type = SCO_LINK;
2453 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002454
Marcel Holtmann732547f2009-04-19 19:14:14 +02002455 switch (ev->status) {
2456 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002457 conn->handle = __le16_to_cpu(ev->handle);
2458 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002459
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002460 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002461 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002462 break;
2463
Stephen Coe705e5712010-02-16 11:29:44 -05002464 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002465 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002466 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002467 case 0x1f: /* Unspecified error */
2468 if (conn->out && conn->attempt < 2) {
2469 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2470 (hdev->esco_type & EDR_ESCO_MASK);
2471 hci_setup_sync(conn, conn->link->handle);
2472 goto unlock;
2473 }
2474 /* fall through */
2475
2476 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002477 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002478 break;
2479 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002480
2481 hci_proto_connect_cfm(conn, ev->status);
2482 if (ev->status)
2483 hci_conn_del(conn);
2484
2485unlock:
2486 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002487}
2488
2489static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2490{
2491 BT_DBG("%s", hdev->name);
2492}
2493
Marcel Holtmann04837f62006-07-03 10:02:33 +02002494static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2495{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002496 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002497
2498 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002499}
2500
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002501static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2502{
2503 struct inquiry_data data;
2504 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2505 int num_rsp = *((__u8 *) skb->data);
2506
2507 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2508
2509 if (!num_rsp)
2510 return;
2511
Johan Hedberg314b2382011-04-27 10:29:57 -04002512 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2513
2514 if (test_bit(HCI_MGMT, &hdev->flags))
2515 mgmt_discovering(hdev->id, 1);
2516 }
2517
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002518 hci_dev_lock(hdev);
2519
Johan Hedberge17acd42011-03-30 23:57:16 +03002520 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002521 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002522 data.pscan_rep_mode = info->pscan_rep_mode;
2523 data.pscan_period_mode = info->pscan_period_mode;
2524 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002525 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002526 data.clock_offset = info->clock_offset;
2527 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002528 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002529 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002530 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class,
2531 info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002532 }
2533
2534 hci_dev_unlock(hdev);
2535}
2536
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002537static inline u8 hci_get_auth_req(struct hci_conn *conn)
2538{
2539 /* If remote requests dedicated bonding follow that lead */
2540 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2541 /* If both remote and local IO capabilities allow MITM
2542 * protection then require it, otherwise don't */
2543 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2544 return 0x02;
2545 else
2546 return 0x03;
2547 }
2548
2549 /* If remote requests no-bonding follow that lead */
2550 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002551 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002552
2553 return conn->auth_type;
2554}
2555
Marcel Holtmann04936842008-07-14 20:13:48 +02002556static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2557{
2558 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2559 struct hci_conn *conn;
2560
2561 BT_DBG("%s", hdev->name);
2562
2563 hci_dev_lock(hdev);
2564
2565 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002566 if (!conn)
2567 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002568
Johan Hedberg03b555e2011-01-04 15:40:05 +02002569 hci_conn_hold(conn);
2570
2571 if (!test_bit(HCI_MGMT, &hdev->flags))
2572 goto unlock;
2573
2574 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2575 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002576 struct hci_cp_io_capability_reply cp;
2577
2578 bacpy(&cp.bdaddr, &ev->bdaddr);
2579 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002580 conn->auth_type = hci_get_auth_req(conn);
2581 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002582
Szymon Jancce85ee12011-03-22 13:12:23 +01002583 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2584 hci_find_remote_oob_data(hdev, &conn->dst))
2585 cp.oob_data = 0x01;
2586 else
2587 cp.oob_data = 0x00;
2588
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002589 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2590 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002591 } else {
2592 struct hci_cp_io_capability_neg_reply cp;
2593
2594 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedbergbe771592011-04-28 11:28:57 -07002595 cp.reason = 0x18; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02002596
2597 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2598 sizeof(cp), &cp);
2599 }
2600
2601unlock:
2602 hci_dev_unlock(hdev);
2603}
2604
2605static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2606{
2607 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2608 struct hci_conn *conn;
2609
2610 BT_DBG("%s", hdev->name);
2611
2612 hci_dev_lock(hdev);
2613
2614 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2615 if (!conn)
2616 goto unlock;
2617
Johan Hedberg03b555e2011-01-04 15:40:05 +02002618 conn->remote_cap = ev->capability;
2619 conn->remote_oob = ev->oob_data;
2620 conn->remote_auth = ev->authentication;
2621
2622unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002623 hci_dev_unlock(hdev);
2624}
2625
Johan Hedberga5c29682011-02-19 12:05:57 -03002626static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2627 struct sk_buff *skb)
2628{
2629 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002630 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002631 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002632
2633 BT_DBG("%s", hdev->name);
2634
2635 hci_dev_lock(hdev);
2636
Johan Hedberg7a828902011-04-28 11:28:53 -07002637 if (!test_bit(HCI_MGMT, &hdev->flags))
2638 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002639
Johan Hedberg7a828902011-04-28 11:28:53 -07002640 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2641 if (!conn)
2642 goto unlock;
2643
2644 loc_mitm = (conn->auth_type & 0x01);
2645 rem_mitm = (conn->remote_auth & 0x01);
2646
2647 /* If we require MITM but the remote device can't provide that
2648 * (it has NoInputNoOutput) then reject the confirmation
2649 * request. The only exception is when we're dedicated bonding
2650 * initiators (connect_cfm_cb set) since then we always have the MITM
2651 * bit set. */
2652 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2653 BT_DBG("Rejecting request: remote device can't provide MITM");
2654 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2655 sizeof(ev->bdaddr), &ev->bdaddr);
2656 goto unlock;
2657 }
2658
2659 /* If no side requires MITM protection; auto-accept */
2660 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2661 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002662
2663 /* If we're not the initiators request authorization to
2664 * proceed from user space (mgmt_user_confirm with
2665 * confirm_hint set to 1). */
2666 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2667 BT_DBG("Confirming auto-accept as acceptor");
2668 confirm_hint = 1;
2669 goto confirm;
2670 }
2671
Johan Hedberg9f616562011-04-28 11:28:54 -07002672 BT_DBG("Auto-accept of user confirmation with %ums delay",
2673 hdev->auto_accept_delay);
2674
2675 if (hdev->auto_accept_delay > 0) {
2676 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2677 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2678 goto unlock;
2679 }
2680
Johan Hedberg7a828902011-04-28 11:28:53 -07002681 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2682 sizeof(ev->bdaddr), &ev->bdaddr);
2683 goto unlock;
2684 }
2685
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002686confirm:
2687 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2688 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002689
2690unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002691 hci_dev_unlock(hdev);
2692}
2693
Marcel Holtmann04936842008-07-14 20:13:48 +02002694static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2695{
2696 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2697 struct hci_conn *conn;
2698
2699 BT_DBG("%s", hdev->name);
2700
2701 hci_dev_lock(hdev);
2702
2703 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002704 if (!conn)
2705 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002706
Johan Hedberg2a611692011-02-19 12:06:00 -03002707 /* To avoid duplicate auth_failed events to user space we check
2708 * the HCI_CONN_AUTH_PEND flag which will be set if we
2709 * initiated the authentication. A traditional auth_complete
2710 * event gets always produced as initiator and is also mapped to
2711 * the mgmt_auth_failed event */
2712 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2713 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2714
2715 hci_conn_put(conn);
2716
2717unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002718 hci_dev_unlock(hdev);
2719}
2720
Marcel Holtmann41a96212008-07-14 20:13:48 +02002721static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2722{
2723 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2724 struct inquiry_entry *ie;
2725
2726 BT_DBG("%s", hdev->name);
2727
2728 hci_dev_lock(hdev);
2729
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002730 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2731 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002732 ie->data.ssp_mode = (ev->features[0] & 0x01);
2733
2734 hci_dev_unlock(hdev);
2735}
2736
Szymon Janc2763eda2011-03-22 13:12:22 +01002737static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2738 struct sk_buff *skb)
2739{
2740 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2741 struct oob_data *data;
2742
2743 BT_DBG("%s", hdev->name);
2744
2745 hci_dev_lock(hdev);
2746
Szymon Jance1ba1f12011-04-06 13:01:59 +02002747 if (!test_bit(HCI_MGMT, &hdev->flags))
2748 goto unlock;
2749
Szymon Janc2763eda2011-03-22 13:12:22 +01002750 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2751 if (data) {
2752 struct hci_cp_remote_oob_data_reply cp;
2753
2754 bacpy(&cp.bdaddr, &ev->bdaddr);
2755 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2756 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2757
2758 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2759 &cp);
2760 } else {
2761 struct hci_cp_remote_oob_data_neg_reply cp;
2762
2763 bacpy(&cp.bdaddr, &ev->bdaddr);
2764 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2765 &cp);
2766 }
2767
Szymon Jance1ba1f12011-04-06 13:01:59 +02002768unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002769 hci_dev_unlock(hdev);
2770}
2771
Ville Tervofcd89c02011-02-10 22:38:47 -03002772static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2773{
2774 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2775 struct hci_conn *conn;
2776
2777 BT_DBG("%s status %d", hdev->name, ev->status);
2778
2779 hci_dev_lock(hdev);
2780
2781 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002782 if (!conn) {
2783 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
2784 if (!conn) {
2785 BT_ERR("No memory for new connection");
2786 hci_dev_unlock(hdev);
2787 return;
2788 }
Andre Guedes29b79882011-05-31 14:20:54 -03002789
2790 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002791 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002792
2793 if (ev->status) {
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002794 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002795 hci_proto_connect_cfm(conn, ev->status);
2796 conn->state = BT_CLOSED;
2797 hci_conn_del(conn);
2798 goto unlock;
2799 }
2800
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002801 mgmt_connected(hdev->id, &ev->bdaddr);
2802
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03002803 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002804 conn->handle = __le16_to_cpu(ev->handle);
2805 conn->state = BT_CONNECTED;
2806
2807 hci_conn_hold_device(conn);
2808 hci_conn_add_sysfs(conn);
2809
2810 hci_proto_connect_cfm(conn, ev->status);
2811
2812unlock:
2813 hci_dev_unlock(hdev);
2814}
2815
Andre Guedes9aa04c92011-05-26 16:23:51 -03002816static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2817 struct sk_buff *skb)
2818{
2819 struct hci_ev_le_advertising_info *ev;
2820 u8 num_reports;
2821
2822 num_reports = skb->data[0];
2823 ev = (void *) &skb->data[1];
2824
2825 hci_dev_lock(hdev);
2826
2827 hci_add_adv_entry(hdev, ev);
2828
2829 while (--num_reports) {
2830 ev = (void *) (ev->data + ev->length + 1);
2831 hci_add_adv_entry(hdev, ev);
2832 }
2833
2834 hci_dev_unlock(hdev);
2835}
2836
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002837static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2838 struct sk_buff *skb)
2839{
2840 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2841 struct hci_cp_le_ltk_reply cp;
2842 struct hci_conn *conn;
2843
2844 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2845
2846 hci_dev_lock(hdev);
2847
2848 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2849
2850 memset(&cp, 0, sizeof(cp));
2851 cp.handle = cpu_to_le16(conn->handle);
2852 memcpy(cp.ltk, conn->ltk, sizeof(conn->ltk));
2853
2854 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2855
2856 hci_dev_unlock(hdev);
2857}
2858
Ville Tervofcd89c02011-02-10 22:38:47 -03002859static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2860{
2861 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2862
2863 skb_pull(skb, sizeof(*le_ev));
2864
2865 switch (le_ev->subevent) {
2866 case HCI_EV_LE_CONN_COMPLETE:
2867 hci_le_conn_complete_evt(hdev, skb);
2868 break;
2869
Andre Guedes9aa04c92011-05-26 16:23:51 -03002870 case HCI_EV_LE_ADVERTISING_REPORT:
2871 hci_le_adv_report_evt(hdev, skb);
2872 break;
2873
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03002874 case HCI_EV_LE_LTK_REQ:
2875 hci_le_ltk_request_evt(hdev, skb);
2876 break;
2877
Ville Tervofcd89c02011-02-10 22:38:47 -03002878 default:
2879 break;
2880 }
2881}
2882
Linus Torvalds1da177e2005-04-16 15:20:36 -07002883void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2884{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002885 struct hci_event_hdr *hdr = (void *) skb->data;
2886 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002887
2888 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2889
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002890 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002891 case HCI_EV_INQUIRY_COMPLETE:
2892 hci_inquiry_complete_evt(hdev, skb);
2893 break;
2894
2895 case HCI_EV_INQUIRY_RESULT:
2896 hci_inquiry_result_evt(hdev, skb);
2897 break;
2898
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002899 case HCI_EV_CONN_COMPLETE:
2900 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002901 break;
2902
Linus Torvalds1da177e2005-04-16 15:20:36 -07002903 case HCI_EV_CONN_REQUEST:
2904 hci_conn_request_evt(hdev, skb);
2905 break;
2906
Linus Torvalds1da177e2005-04-16 15:20:36 -07002907 case HCI_EV_DISCONN_COMPLETE:
2908 hci_disconn_complete_evt(hdev, skb);
2909 break;
2910
Linus Torvalds1da177e2005-04-16 15:20:36 -07002911 case HCI_EV_AUTH_COMPLETE:
2912 hci_auth_complete_evt(hdev, skb);
2913 break;
2914
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002915 case HCI_EV_REMOTE_NAME:
2916 hci_remote_name_evt(hdev, skb);
2917 break;
2918
Linus Torvalds1da177e2005-04-16 15:20:36 -07002919 case HCI_EV_ENCRYPT_CHANGE:
2920 hci_encrypt_change_evt(hdev, skb);
2921 break;
2922
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002923 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2924 hci_change_link_key_complete_evt(hdev, skb);
2925 break;
2926
2927 case HCI_EV_REMOTE_FEATURES:
2928 hci_remote_features_evt(hdev, skb);
2929 break;
2930
2931 case HCI_EV_REMOTE_VERSION:
2932 hci_remote_version_evt(hdev, skb);
2933 break;
2934
2935 case HCI_EV_QOS_SETUP_COMPLETE:
2936 hci_qos_setup_complete_evt(hdev, skb);
2937 break;
2938
2939 case HCI_EV_CMD_COMPLETE:
2940 hci_cmd_complete_evt(hdev, skb);
2941 break;
2942
2943 case HCI_EV_CMD_STATUS:
2944 hci_cmd_status_evt(hdev, skb);
2945 break;
2946
2947 case HCI_EV_ROLE_CHANGE:
2948 hci_role_change_evt(hdev, skb);
2949 break;
2950
2951 case HCI_EV_NUM_COMP_PKTS:
2952 hci_num_comp_pkts_evt(hdev, skb);
2953 break;
2954
2955 case HCI_EV_MODE_CHANGE:
2956 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002957 break;
2958
2959 case HCI_EV_PIN_CODE_REQ:
2960 hci_pin_code_request_evt(hdev, skb);
2961 break;
2962
2963 case HCI_EV_LINK_KEY_REQ:
2964 hci_link_key_request_evt(hdev, skb);
2965 break;
2966
2967 case HCI_EV_LINK_KEY_NOTIFY:
2968 hci_link_key_notify_evt(hdev, skb);
2969 break;
2970
2971 case HCI_EV_CLOCK_OFFSET:
2972 hci_clock_offset_evt(hdev, skb);
2973 break;
2974
Marcel Holtmanna8746412008-07-14 20:13:46 +02002975 case HCI_EV_PKT_TYPE_CHANGE:
2976 hci_pkt_type_change_evt(hdev, skb);
2977 break;
2978
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002979 case HCI_EV_PSCAN_REP_MODE:
2980 hci_pscan_rep_mode_evt(hdev, skb);
2981 break;
2982
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002983 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
2984 hci_inquiry_result_with_rssi_evt(hdev, skb);
2985 break;
2986
2987 case HCI_EV_REMOTE_EXT_FEATURES:
2988 hci_remote_ext_features_evt(hdev, skb);
2989 break;
2990
2991 case HCI_EV_SYNC_CONN_COMPLETE:
2992 hci_sync_conn_complete_evt(hdev, skb);
2993 break;
2994
2995 case HCI_EV_SYNC_CONN_CHANGED:
2996 hci_sync_conn_changed_evt(hdev, skb);
2997 break;
2998
Marcel Holtmann04837f62006-07-03 10:02:33 +02002999 case HCI_EV_SNIFF_SUBRATE:
3000 hci_sniff_subrate_evt(hdev, skb);
3001 break;
3002
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003003 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3004 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003005 break;
3006
Marcel Holtmann04936842008-07-14 20:13:48 +02003007 case HCI_EV_IO_CAPA_REQUEST:
3008 hci_io_capa_request_evt(hdev, skb);
3009 break;
3010
Johan Hedberg03b555e2011-01-04 15:40:05 +02003011 case HCI_EV_IO_CAPA_REPLY:
3012 hci_io_capa_reply_evt(hdev, skb);
3013 break;
3014
Johan Hedberga5c29682011-02-19 12:05:57 -03003015 case HCI_EV_USER_CONFIRM_REQUEST:
3016 hci_user_confirm_request_evt(hdev, skb);
3017 break;
3018
Marcel Holtmann04936842008-07-14 20:13:48 +02003019 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3020 hci_simple_pair_complete_evt(hdev, skb);
3021 break;
3022
Marcel Holtmann41a96212008-07-14 20:13:48 +02003023 case HCI_EV_REMOTE_HOST_FEATURES:
3024 hci_remote_host_features_evt(hdev, skb);
3025 break;
3026
Ville Tervofcd89c02011-02-10 22:38:47 -03003027 case HCI_EV_LE_META:
3028 hci_le_meta_evt(hdev, skb);
3029 break;
3030
Szymon Janc2763eda2011-03-22 13:12:22 +01003031 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3032 hci_remote_oob_data_request_evt(hdev, skb);
3033 break;
3034
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003035 default:
3036 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003037 break;
3038 }
3039
3040 kfree_skb(skb);
3041 hdev->stat.evt_rx++;
3042}
3043
3044/* Generate internal stack event */
3045void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3046{
3047 struct hci_event_hdr *hdr;
3048 struct hci_ev_stack_internal *ev;
3049 struct sk_buff *skb;
3050
3051 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3052 if (!skb)
3053 return;
3054
3055 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3056 hdr->evt = HCI_EV_STACK_INTERNAL;
3057 hdr->plen = sizeof(*ev) + dlen;
3058
3059 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3060 ev->type = type;
3061 memcpy(ev->data, data, dlen);
3062
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003063 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003064 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003065
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003066 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003067 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003068 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003069 kfree_skb(skb);
3070}