blob: 2ec64f503fa35a7b00beef6dff04a6fc60defe4d [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI event handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28
29#include <linux/types.h>
30#include <linux/errno.h>
31#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#include <linux/slab.h>
33#include <linux/poll.h>
34#include <linux/fcntl.h>
35#include <linux/init.h>
36#include <linux/skbuff.h>
37#include <linux/interrupt.h>
38#include <linux/notifier.h>
39#include <net/sock.h>
40
41#include <asm/system.h>
Andrei Emeltchenko70f230202010-12-01 16:58:25 +020042#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070043#include <asm/unaligned.h>
44
45#include <net/bluetooth/bluetooth.h>
46#include <net/bluetooth/hci_core.h>
47
Linus Torvalds1da177e2005-04-16 15:20:36 -070048/* Handle HCI Event packets */
49
Marcel Holtmanna9de9242007-10-20 13:33:56 +020050static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070051{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020052 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
Marcel Holtmanna9de9242007-10-20 13:33:56 +020054 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
Marcel Holtmanna9de9242007-10-20 13:33:56 +020056 if (status)
57 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070058
Johan Hedberg314b2382011-04-27 10:29:57 -040059 if (test_bit(HCI_MGMT, &hdev->flags) &&
60 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
61 mgmt_discovering(hdev->id, 0);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010062
Johan Hedberg23bb5762010-12-21 23:01:27 +020063 hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010064
Marcel Holtmanna9de9242007-10-20 13:33:56 +020065 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070066}
67
Marcel Holtmanna9de9242007-10-20 13:33:56 +020068static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070069{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020070 __u8 status = *((__u8 *) skb->data);
71
72 BT_DBG("%s status 0x%x", hdev->name, status);
73
74 if (status)
75 return;
76
Johan Hedberg314b2382011-04-27 10:29:57 -040077 if (test_bit(HCI_MGMT, &hdev->flags) &&
78 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
79 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020080
81 hci_conn_check_pending(hdev);
82}
83
84static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
85{
86 BT_DBG("%s", hdev->name);
87}
88
89static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
90{
91 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070092 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070093
Marcel Holtmanna9de9242007-10-20 13:33:56 +020094 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Marcel Holtmanna9de9242007-10-20 13:33:56 +020096 if (rp->status)
97 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Marcel Holtmanna9de9242007-10-20 13:33:56 +020099 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200101 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
102 if (conn) {
103 if (rp->role)
104 conn->link_mode &= ~HCI_LM_MASTER;
105 else
106 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200108
109 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110}
111
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200112static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
113{
114 struct hci_rp_read_link_policy *rp = (void *) skb->data;
115 struct hci_conn *conn;
116
117 BT_DBG("%s status 0x%x", hdev->name, rp->status);
118
119 if (rp->status)
120 return;
121
122 hci_dev_lock(hdev);
123
124 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
125 if (conn)
126 conn->link_policy = __le16_to_cpu(rp->policy);
127
128 hci_dev_unlock(hdev);
129}
130
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200131static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200133 struct hci_rp_write_link_policy *rp = (void *) skb->data;
134 struct hci_conn *conn;
135 void *sent;
136
137 BT_DBG("%s status 0x%x", hdev->name, rp->status);
138
139 if (rp->status)
140 return;
141
142 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
143 if (!sent)
144 return;
145
146 hci_dev_lock(hdev);
147
148 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200149 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700150 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200151
152 hci_dev_unlock(hdev);
153}
154
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200155static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
156{
157 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
158
159 BT_DBG("%s status 0x%x", hdev->name, rp->status);
160
161 if (rp->status)
162 return;
163
164 hdev->link_policy = __le16_to_cpu(rp->policy);
165}
166
167static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
168{
169 __u8 status = *((__u8 *) skb->data);
170 void *sent;
171
172 BT_DBG("%s status 0x%x", hdev->name, status);
173
174 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
175 if (!sent)
176 return;
177
178 if (!status)
179 hdev->link_policy = get_unaligned_le16(sent);
180
Johan Hedberg23bb5762010-12-21 23:01:27 +0200181 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200182}
183
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200184static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
185{
186 __u8 status = *((__u8 *) skb->data);
187
188 BT_DBG("%s status 0x%x", hdev->name, status);
189
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300190 clear_bit(HCI_RESET, &hdev->flags);
191
Johan Hedberg23bb5762010-12-21 23:01:27 +0200192 hci_req_complete(hdev, HCI_OP_RESET, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200193}
194
195static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
196{
197 __u8 status = *((__u8 *) skb->data);
198 void *sent;
199
200 BT_DBG("%s status 0x%x", hdev->name, status);
201
202 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
203 if (!sent)
204 return;
205
Johan Hedbergb312b1612011-03-16 14:29:37 +0200206 if (test_bit(HCI_MGMT, &hdev->flags))
207 mgmt_set_local_name_complete(hdev->id, sent, status);
208
209 if (status)
210 return;
211
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200212 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200213}
214
215static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
216{
217 struct hci_rp_read_local_name *rp = (void *) skb->data;
218
219 BT_DBG("%s status 0x%x", hdev->name, rp->status);
220
221 if (rp->status)
222 return;
223
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200224 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200225}
226
227static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
228{
229 __u8 status = *((__u8 *) skb->data);
230 void *sent;
231
232 BT_DBG("%s status 0x%x", hdev->name, status);
233
234 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
235 if (!sent)
236 return;
237
238 if (!status) {
239 __u8 param = *((__u8 *) sent);
240
241 if (param == AUTH_ENABLED)
242 set_bit(HCI_AUTH, &hdev->flags);
243 else
244 clear_bit(HCI_AUTH, &hdev->flags);
245 }
246
Johan Hedberg23bb5762010-12-21 23:01:27 +0200247 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200248}
249
250static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
251{
252 __u8 status = *((__u8 *) skb->data);
253 void *sent;
254
255 BT_DBG("%s status 0x%x", hdev->name, status);
256
257 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
258 if (!sent)
259 return;
260
261 if (!status) {
262 __u8 param = *((__u8 *) sent);
263
264 if (param)
265 set_bit(HCI_ENCRYPT, &hdev->flags);
266 else
267 clear_bit(HCI_ENCRYPT, &hdev->flags);
268 }
269
Johan Hedberg23bb5762010-12-21 23:01:27 +0200270 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200271}
272
273static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
274{
275 __u8 status = *((__u8 *) skb->data);
276 void *sent;
277
278 BT_DBG("%s status 0x%x", hdev->name, status);
279
280 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
281 if (!sent)
282 return;
283
284 if (!status) {
285 __u8 param = *((__u8 *) sent);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200286 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200287
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200288 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
289 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200290
Johan Hedberg73f22f62010-12-29 16:00:25 +0200291 if (param & SCAN_INQUIRY) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200292 set_bit(HCI_ISCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200293 if (!old_iscan)
294 mgmt_discoverable(hdev->id, 1);
295 } else if (old_iscan)
Johan Hedberg73f22f62010-12-29 16:00:25 +0200296 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200297
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200298 if (param & SCAN_PAGE) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200299 set_bit(HCI_PSCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200300 if (!old_pscan)
301 mgmt_connectable(hdev->id, 1);
302 } else if (old_pscan)
303 mgmt_connectable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200304 }
305
Johan Hedberg23bb5762010-12-21 23:01:27 +0200306 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200307}
308
309static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
310{
311 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
312
313 BT_DBG("%s status 0x%x", hdev->name, rp->status);
314
315 if (rp->status)
316 return;
317
318 memcpy(hdev->dev_class, rp->dev_class, 3);
319
320 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
321 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
322}
323
324static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
325{
326 __u8 status = *((__u8 *) skb->data);
327 void *sent;
328
329 BT_DBG("%s status 0x%x", hdev->name, status);
330
Marcel Holtmannf383f272008-07-14 20:13:47 +0200331 if (status)
332 return;
333
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200334 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
335 if (!sent)
336 return;
337
Marcel Holtmannf383f272008-07-14 20:13:47 +0200338 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200339}
340
341static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
342{
343 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200345
346 BT_DBG("%s status 0x%x", hdev->name, rp->status);
347
348 if (rp->status)
349 return;
350
351 setting = __le16_to_cpu(rp->voice_setting);
352
Marcel Holtmannf383f272008-07-14 20:13:47 +0200353 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200354 return;
355
356 hdev->voice_setting = setting;
357
358 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
359
360 if (hdev->notify) {
361 tasklet_disable(&hdev->tx_task);
362 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
363 tasklet_enable(&hdev->tx_task);
364 }
365}
366
367static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
368{
369 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200370 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 void *sent;
372
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200373 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374
Marcel Holtmannf383f272008-07-14 20:13:47 +0200375 if (status)
376 return;
377
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200378 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
379 if (!sent)
380 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381
Marcel Holtmannf383f272008-07-14 20:13:47 +0200382 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383
Marcel Holtmannf383f272008-07-14 20:13:47 +0200384 if (hdev->voice_setting == setting)
385 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386
Marcel Holtmannf383f272008-07-14 20:13:47 +0200387 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Marcel Holtmannf383f272008-07-14 20:13:47 +0200389 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
390
391 if (hdev->notify) {
392 tasklet_disable(&hdev->tx_task);
393 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
394 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 }
396}
397
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200398static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200400 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200402 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Johan Hedberg23bb5762010-12-21 23:01:27 +0200404 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405}
406
Marcel Holtmann333140b2008-07-14 20:13:48 +0200407static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
408{
409 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
410
411 BT_DBG("%s status 0x%x", hdev->name, rp->status);
412
413 if (rp->status)
414 return;
415
416 hdev->ssp_mode = rp->mode;
417}
418
419static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
420{
421 __u8 status = *((__u8 *) skb->data);
422 void *sent;
423
424 BT_DBG("%s status 0x%x", hdev->name, status);
425
426 if (status)
427 return;
428
429 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
430 if (!sent)
431 return;
432
433 hdev->ssp_mode = *((__u8 *) sent);
434}
435
Johan Hedbergd5859e22011-01-25 01:19:58 +0200436static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
437{
438 if (hdev->features[6] & LMP_EXT_INQ)
439 return 2;
440
441 if (hdev->features[3] & LMP_RSSI_INQ)
442 return 1;
443
444 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
445 hdev->lmp_subver == 0x0757)
446 return 1;
447
448 if (hdev->manufacturer == 15) {
449 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
450 return 1;
451 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
452 return 1;
453 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
454 return 1;
455 }
456
457 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
458 hdev->lmp_subver == 0x1805)
459 return 1;
460
461 return 0;
462}
463
464static void hci_setup_inquiry_mode(struct hci_dev *hdev)
465{
466 u8 mode;
467
468 mode = hci_get_inquiry_mode(hdev);
469
470 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
471}
472
473static void hci_setup_event_mask(struct hci_dev *hdev)
474{
475 /* The second byte is 0xff instead of 0x9f (two reserved bits
476 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
477 * command otherwise */
478 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
479
Ville Tervo7f4f0572011-05-27 11:16:21 +0300480 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
481 * any event mask for pre 1.2 devices */
482 if (hdev->lmp_ver <= 1)
483 return;
484
485 events[4] |= 0x01; /* Flow Specification Complete */
486 events[4] |= 0x02; /* Inquiry Result with RSSI */
487 events[4] |= 0x04; /* Read Remote Extended Features Complete */
488 events[5] |= 0x08; /* Synchronous Connection Complete */
489 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200490
491 if (hdev->features[3] & LMP_RSSI_INQ)
492 events[4] |= 0x04; /* Inquiry Result with RSSI */
493
494 if (hdev->features[5] & LMP_SNIFF_SUBR)
495 events[5] |= 0x20; /* Sniff Subrating */
496
497 if (hdev->features[5] & LMP_PAUSE_ENC)
498 events[5] |= 0x80; /* Encryption Key Refresh Complete */
499
500 if (hdev->features[6] & LMP_EXT_INQ)
501 events[5] |= 0x40; /* Extended Inquiry Result */
502
503 if (hdev->features[6] & LMP_NO_FLUSH)
504 events[7] |= 0x01; /* Enhanced Flush Complete */
505
506 if (hdev->features[7] & LMP_LSTO)
507 events[6] |= 0x80; /* Link Supervision Timeout Changed */
508
509 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
510 events[6] |= 0x01; /* IO Capability Request */
511 events[6] |= 0x02; /* IO Capability Response */
512 events[6] |= 0x04; /* User Confirmation Request */
513 events[6] |= 0x08; /* User Passkey Request */
514 events[6] |= 0x10; /* Remote OOB Data Request */
515 events[6] |= 0x20; /* Simple Pairing Complete */
516 events[7] |= 0x04; /* User Passkey Notification */
517 events[7] |= 0x08; /* Keypress Notification */
518 events[7] |= 0x10; /* Remote Host Supported
519 * Features Notification */
520 }
521
522 if (hdev->features[4] & LMP_LE)
523 events[7] |= 0x20; /* LE Meta-Event */
524
525 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
526}
527
528static void hci_setup(struct hci_dev *hdev)
529{
530 hci_setup_event_mask(hdev);
531
532 if (hdev->lmp_ver > 1)
533 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
534
535 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
536 u8 mode = 0x01;
537 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
538 }
539
540 if (hdev->features[3] & LMP_RSSI_INQ)
541 hci_setup_inquiry_mode(hdev);
542
543 if (hdev->features[7] & LMP_INQ_TX_PWR)
544 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
545}
546
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200547static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
548{
549 struct hci_rp_read_local_version *rp = (void *) skb->data;
550
551 BT_DBG("%s status 0x%x", hdev->name, rp->status);
552
553 if (rp->status)
554 return;
555
556 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200557 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200558 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200559 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200560 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200561
562 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
563 hdev->manufacturer,
564 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200565
566 if (test_bit(HCI_INIT, &hdev->flags))
567 hci_setup(hdev);
568}
569
570static void hci_setup_link_policy(struct hci_dev *hdev)
571{
572 u16 link_policy = 0;
573
574 if (hdev->features[0] & LMP_RSWITCH)
575 link_policy |= HCI_LP_RSWITCH;
576 if (hdev->features[0] & LMP_HOLD)
577 link_policy |= HCI_LP_HOLD;
578 if (hdev->features[0] & LMP_SNIFF)
579 link_policy |= HCI_LP_SNIFF;
580 if (hdev->features[1] & LMP_PARK)
581 link_policy |= HCI_LP_PARK;
582
583 link_policy = cpu_to_le16(link_policy);
584 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
585 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200586}
587
588static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
589{
590 struct hci_rp_read_local_commands *rp = (void *) skb->data;
591
592 BT_DBG("%s status 0x%x", hdev->name, rp->status);
593
594 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200595 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200596
597 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200598
599 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
600 hci_setup_link_policy(hdev);
601
602done:
603 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200604}
605
606static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
607{
608 struct hci_rp_read_local_features *rp = (void *) skb->data;
609
610 BT_DBG("%s status 0x%x", hdev->name, rp->status);
611
612 if (rp->status)
613 return;
614
615 memcpy(hdev->features, rp->features, 8);
616
617 /* Adjust default settings according to features
618 * supported by device. */
619
620 if (hdev->features[0] & LMP_3SLOT)
621 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
622
623 if (hdev->features[0] & LMP_5SLOT)
624 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
625
626 if (hdev->features[1] & LMP_HV2) {
627 hdev->pkt_type |= (HCI_HV2);
628 hdev->esco_type |= (ESCO_HV2);
629 }
630
631 if (hdev->features[1] & LMP_HV3) {
632 hdev->pkt_type |= (HCI_HV3);
633 hdev->esco_type |= (ESCO_HV3);
634 }
635
636 if (hdev->features[3] & LMP_ESCO)
637 hdev->esco_type |= (ESCO_EV3);
638
639 if (hdev->features[4] & LMP_EV4)
640 hdev->esco_type |= (ESCO_EV4);
641
642 if (hdev->features[4] & LMP_EV5)
643 hdev->esco_type |= (ESCO_EV5);
644
Marcel Holtmannefc76882009-02-06 09:13:37 +0100645 if (hdev->features[5] & LMP_EDR_ESCO_2M)
646 hdev->esco_type |= (ESCO_2EV3);
647
648 if (hdev->features[5] & LMP_EDR_ESCO_3M)
649 hdev->esco_type |= (ESCO_3EV3);
650
651 if (hdev->features[5] & LMP_EDR_3S_ESCO)
652 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
653
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200654 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
655 hdev->features[0], hdev->features[1],
656 hdev->features[2], hdev->features[3],
657 hdev->features[4], hdev->features[5],
658 hdev->features[6], hdev->features[7]);
659}
660
661static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
662{
663 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
664
665 BT_DBG("%s status 0x%x", hdev->name, rp->status);
666
667 if (rp->status)
668 return;
669
670 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
671 hdev->sco_mtu = rp->sco_mtu;
672 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
673 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
674
675 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
676 hdev->sco_mtu = 64;
677 hdev->sco_pkts = 8;
678 }
679
680 hdev->acl_cnt = hdev->acl_pkts;
681 hdev->sco_cnt = hdev->sco_pkts;
682
683 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
684 hdev->acl_mtu, hdev->acl_pkts,
685 hdev->sco_mtu, hdev->sco_pkts);
686}
687
688static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
689{
690 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
691
692 BT_DBG("%s status 0x%x", hdev->name, rp->status);
693
694 if (!rp->status)
695 bacpy(&hdev->bdaddr, &rp->bdaddr);
696
Johan Hedberg23bb5762010-12-21 23:01:27 +0200697 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
698}
699
700static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
701{
702 __u8 status = *((__u8 *) skb->data);
703
704 BT_DBG("%s status 0x%x", hdev->name, status);
705
706 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200707}
708
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200709static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
710 struct sk_buff *skb)
711{
712 __u8 status = *((__u8 *) skb->data);
713
714 BT_DBG("%s status 0x%x", hdev->name, status);
715
716 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
717}
718
Johan Hedbergd5859e22011-01-25 01:19:58 +0200719static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
720{
721 __u8 status = *((__u8 *) skb->data);
722
723 BT_DBG("%s status 0x%x", hdev->name, status);
724
725 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
726}
727
728static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
729 struct sk_buff *skb)
730{
731 __u8 status = *((__u8 *) skb->data);
732
733 BT_DBG("%s status 0x%x", hdev->name, status);
734
735 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
736}
737
738static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
739 struct sk_buff *skb)
740{
741 __u8 status = *((__u8 *) skb->data);
742
743 BT_DBG("%s status 0x%x", hdev->name, status);
744
745 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
746}
747
748static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
749{
750 __u8 status = *((__u8 *) skb->data);
751
752 BT_DBG("%s status 0x%x", hdev->name, status);
753
754 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
755}
756
Johan Hedberg980e1a52011-01-22 06:10:07 +0200757static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
758{
759 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
760 struct hci_cp_pin_code_reply *cp;
761 struct hci_conn *conn;
762
763 BT_DBG("%s status 0x%x", hdev->name, rp->status);
764
765 if (test_bit(HCI_MGMT, &hdev->flags))
766 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
767
768 if (rp->status != 0)
769 return;
770
771 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
772 if (!cp)
773 return;
774
775 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
776 if (conn)
777 conn->pin_length = cp->pin_len;
778}
779
780static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
781{
782 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
783
784 BT_DBG("%s status 0x%x", hdev->name, rp->status);
785
786 if (test_bit(HCI_MGMT, &hdev->flags))
787 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
788 rp->status);
789}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300790static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
791 struct sk_buff *skb)
792{
793 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
794
795 BT_DBG("%s status 0x%x", hdev->name, rp->status);
796
797 if (rp->status)
798 return;
799
800 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
801 hdev->le_pkts = rp->le_max_pkt;
802
803 hdev->le_cnt = hdev->le_pkts;
804
805 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
806
807 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
808}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200809
Johan Hedberga5c29682011-02-19 12:05:57 -0300810static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
811{
812 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
813
814 BT_DBG("%s status 0x%x", hdev->name, rp->status);
815
816 if (test_bit(HCI_MGMT, &hdev->flags))
817 mgmt_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
818 rp->status);
819}
820
821static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
822 struct sk_buff *skb)
823{
824 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
825
826 BT_DBG("%s status 0x%x", hdev->name, rp->status);
827
828 if (test_bit(HCI_MGMT, &hdev->flags))
829 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
830 rp->status);
831}
832
Szymon Jancc35938b2011-03-22 13:12:21 +0100833static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
834 struct sk_buff *skb)
835{
836 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
837
838 BT_DBG("%s status 0x%x", hdev->name, rp->status);
839
840 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
841 rp->randomizer, rp->status);
842}
843
Andre Guedes726e1332011-05-26 16:23:52 -0300844static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
845 struct sk_buff *skb)
846{
847 struct hci_cp_le_set_scan_enable *cp;
848 __u8 status = *((__u8 *) skb->data);
849
850 BT_DBG("%s status 0x%x", hdev->name, status);
851
852 if (status)
853 return;
854
855 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
856 if (!cp)
857 return;
858
859 hci_dev_lock(hdev);
860
Andre Guedes45e600f2011-05-26 16:23:53 -0300861 if (cp->enable == 0x01) {
862 del_timer(&hdev->adv_timer);
Andre Guedes726e1332011-05-26 16:23:52 -0300863 hci_adv_entries_clear(hdev);
Andre Guedes45e600f2011-05-26 16:23:53 -0300864 } else if (cp->enable == 0x00) {
865 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
866 }
Andre Guedes726e1332011-05-26 16:23:52 -0300867
868 hci_dev_unlock(hdev);
869}
870
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -0300871static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
872{
873 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
874
875 BT_DBG("%s status 0x%x", hdev->name, rp->status);
876
877 if (rp->status)
878 return;
879
880 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
881}
882
883static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
884{
885 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
886
887 BT_DBG("%s status 0x%x", hdev->name, rp->status);
888
889 if (rp->status)
890 return;
891
892 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
893}
894
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200895static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
896{
897 BT_DBG("%s status 0x%x", hdev->name, status);
898
899 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200900 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200901 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -0400902 return;
903 }
904
905 if (test_bit(HCI_MGMT, &hdev->flags) &&
906 !test_and_set_bit(HCI_INQUIRY,
907 &hdev->flags))
908 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200909}
910
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
912{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200913 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200916 BT_DBG("%s status 0x%x", hdev->name, status);
917
918 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700919 if (!cp)
920 return;
921
922 hci_dev_lock(hdev);
923
924 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
925
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200926 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700927
928 if (status) {
929 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200930 if (status != 0x0c || conn->attempt > 2) {
931 conn->state = BT_CLOSED;
932 hci_proto_connect_cfm(conn, status);
933 hci_conn_del(conn);
934 } else
935 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700936 }
937 } else {
938 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -0800939 conn = hci_conn_add(hdev, ACL_LINK, 0, &cp->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940 if (conn) {
941 conn->out = 1;
942 conn->link_mode |= HCI_LM_MASTER;
943 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -0300944 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945 }
946 }
947
948 hci_dev_unlock(hdev);
949}
950
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200951static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200953 struct hci_cp_add_sco *cp;
954 struct hci_conn *acl, *sco;
955 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200957 BT_DBG("%s status 0x%x", hdev->name, status);
958
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200959 if (!status)
960 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200962 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
963 if (!cp)
964 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200966 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700967
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200968 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +0100969
970 hci_dev_lock(hdev);
971
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200972 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +0200973 if (acl) {
974 sco = acl->link;
975 if (sco) {
976 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200977
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +0200978 hci_proto_connect_cfm(sco, status);
979 hci_conn_del(sco);
980 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200981 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +0100982
983 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984}
985
Marcel Holtmannf8558552008-07-14 20:13:49 +0200986static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
987{
988 struct hci_cp_auth_requested *cp;
989 struct hci_conn *conn;
990
991 BT_DBG("%s status 0x%x", hdev->name, status);
992
993 if (!status)
994 return;
995
996 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
997 if (!cp)
998 return;
999
1000 hci_dev_lock(hdev);
1001
1002 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1003 if (conn) {
1004 if (conn->state == BT_CONFIG) {
1005 hci_proto_connect_cfm(conn, status);
1006 hci_conn_put(conn);
1007 }
1008 }
1009
1010 hci_dev_unlock(hdev);
1011}
1012
1013static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1014{
1015 struct hci_cp_set_conn_encrypt *cp;
1016 struct hci_conn *conn;
1017
1018 BT_DBG("%s status 0x%x", hdev->name, status);
1019
1020 if (!status)
1021 return;
1022
1023 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1024 if (!cp)
1025 return;
1026
1027 hci_dev_lock(hdev);
1028
1029 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1030 if (conn) {
1031 if (conn->state == BT_CONFIG) {
1032 hci_proto_connect_cfm(conn, status);
1033 hci_conn_put(conn);
1034 }
1035 }
1036
1037 hci_dev_unlock(hdev);
1038}
1039
Johan Hedberg127178d2010-11-18 22:22:29 +02001040static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001041 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001042{
Johan Hedberg392599b2010-11-18 22:22:28 +02001043 if (conn->state != BT_CONFIG || !conn->out)
1044 return 0;
1045
Johan Hedberg765c2a92011-01-19 12:06:52 +05301046 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001047 return 0;
1048
1049 /* Only request authentication for SSP connections or non-SSP
1050 * devices with sec_level HIGH */
1051 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Johan Hedberg765c2a92011-01-19 12:06:52 +05301052 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001053 return 0;
1054
Johan Hedberg392599b2010-11-18 22:22:28 +02001055 return 1;
1056}
1057
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001058static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1059{
Johan Hedberg127178d2010-11-18 22:22:29 +02001060 struct hci_cp_remote_name_req *cp;
1061 struct hci_conn *conn;
1062
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001063 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001064
1065 /* If successful wait for the name req complete event before
1066 * checking for the need to do authentication */
1067 if (!status)
1068 return;
1069
1070 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1071 if (!cp)
1072 return;
1073
1074 hci_dev_lock(hdev);
1075
1076 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001077 if (!conn)
1078 goto unlock;
1079
1080 if (!hci_outgoing_auth_needed(hdev, conn))
1081 goto unlock;
1082
1083 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001084 struct hci_cp_auth_requested cp;
1085 cp.handle = __cpu_to_le16(conn->handle);
1086 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1087 }
1088
Johan Hedberg79c6c702011-04-28 11:28:55 -07001089unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001090 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001091}
1092
Marcel Holtmann769be972008-07-14 20:13:49 +02001093static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1094{
1095 struct hci_cp_read_remote_features *cp;
1096 struct hci_conn *conn;
1097
1098 BT_DBG("%s status 0x%x", hdev->name, status);
1099
1100 if (!status)
1101 return;
1102
1103 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1104 if (!cp)
1105 return;
1106
1107 hci_dev_lock(hdev);
1108
1109 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1110 if (conn) {
1111 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001112 hci_proto_connect_cfm(conn, status);
1113 hci_conn_put(conn);
1114 }
1115 }
1116
1117 hci_dev_unlock(hdev);
1118}
1119
1120static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1121{
1122 struct hci_cp_read_remote_ext_features *cp;
1123 struct hci_conn *conn;
1124
1125 BT_DBG("%s status 0x%x", hdev->name, status);
1126
1127 if (!status)
1128 return;
1129
1130 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1131 if (!cp)
1132 return;
1133
1134 hci_dev_lock(hdev);
1135
1136 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1137 if (conn) {
1138 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001139 hci_proto_connect_cfm(conn, status);
1140 hci_conn_put(conn);
1141 }
1142 }
1143
1144 hci_dev_unlock(hdev);
1145}
1146
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001147static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1148{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001149 struct hci_cp_setup_sync_conn *cp;
1150 struct hci_conn *acl, *sco;
1151 __u16 handle;
1152
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001153 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001154
1155 if (!status)
1156 return;
1157
1158 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1159 if (!cp)
1160 return;
1161
1162 handle = __le16_to_cpu(cp->handle);
1163
1164 BT_DBG("%s handle %d", hdev->name, handle);
1165
1166 hci_dev_lock(hdev);
1167
1168 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001169 if (acl) {
1170 sco = acl->link;
1171 if (sco) {
1172 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001173
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001174 hci_proto_connect_cfm(sco, status);
1175 hci_conn_del(sco);
1176 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001177 }
1178
1179 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001180}
1181
1182static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1183{
1184 struct hci_cp_sniff_mode *cp;
1185 struct hci_conn *conn;
1186
1187 BT_DBG("%s status 0x%x", hdev->name, status);
1188
1189 if (!status)
1190 return;
1191
1192 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1193 if (!cp)
1194 return;
1195
1196 hci_dev_lock(hdev);
1197
1198 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001199 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001200 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1201
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001202 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1203 hci_sco_setup(conn, status);
1204 }
1205
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001206 hci_dev_unlock(hdev);
1207}
1208
1209static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1210{
1211 struct hci_cp_exit_sniff_mode *cp;
1212 struct hci_conn *conn;
1213
1214 BT_DBG("%s status 0x%x", hdev->name, status);
1215
1216 if (!status)
1217 return;
1218
1219 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1220 if (!cp)
1221 return;
1222
1223 hci_dev_lock(hdev);
1224
1225 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001226 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001227 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1228
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001229 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1230 hci_sco_setup(conn, status);
1231 }
1232
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001233 hci_dev_unlock(hdev);
1234}
1235
Ville Tervofcd89c02011-02-10 22:38:47 -03001236static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1237{
1238 struct hci_cp_le_create_conn *cp;
1239 struct hci_conn *conn;
1240
1241 BT_DBG("%s status 0x%x", hdev->name, status);
1242
1243 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1244 if (!cp)
1245 return;
1246
1247 hci_dev_lock(hdev);
1248
1249 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1250
1251 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1252 conn);
1253
1254 if (status) {
1255 if (conn && conn->state == BT_CONNECT) {
1256 conn->state = BT_CLOSED;
1257 hci_proto_connect_cfm(conn, status);
1258 hci_conn_del(conn);
1259 }
1260 } else {
1261 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001262 conn = hci_conn_add(hdev, LE_LINK, 0, &cp->peer_addr);
Andre Guedes149c0972011-05-31 14:20:54 -03001263 if (conn) {
1264 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001265 conn->out = 1;
Andre Guedes149c0972011-05-31 14:20:54 -03001266 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001267 BT_ERR("No memory for new connection");
Andre Guedes149c0972011-05-31 14:20:54 -03001268 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001269 }
1270 }
1271
1272 hci_dev_unlock(hdev);
1273}
1274
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001275static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1276{
1277 BT_DBG("%s status 0x%x", hdev->name, status);
1278}
1279
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001280static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1281{
1282 __u8 status = *((__u8 *) skb->data);
1283
1284 BT_DBG("%s status %d", hdev->name, status);
1285
Johan Hedberg314b2382011-04-27 10:29:57 -04001286 if (test_bit(HCI_MGMT, &hdev->flags) &&
1287 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1288 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001289
Johan Hedberg23bb5762010-12-21 23:01:27 +02001290 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001291
1292 hci_conn_check_pending(hdev);
1293}
1294
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1296{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001297 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001298 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299 int num_rsp = *((__u8 *) skb->data);
1300
1301 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1302
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001303 if (!num_rsp)
1304 return;
1305
Linus Torvalds1da177e2005-04-16 15:20:36 -07001306 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001307
Johan Hedberg314b2382011-04-27 10:29:57 -04001308 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
1309
1310 if (test_bit(HCI_MGMT, &hdev->flags))
1311 mgmt_discovering(hdev->id, 1);
1312 }
1313
Johan Hedberge17acd42011-03-30 23:57:16 +03001314 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001315 bacpy(&data.bdaddr, &info->bdaddr);
1316 data.pscan_rep_mode = info->pscan_rep_mode;
1317 data.pscan_period_mode = info->pscan_period_mode;
1318 data.pscan_mode = info->pscan_mode;
1319 memcpy(data.dev_class, info->dev_class, 3);
1320 data.clock_offset = info->clock_offset;
1321 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001322 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03001324 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class, 0,
1325 NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001327
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328 hci_dev_unlock(hdev);
1329}
1330
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001331static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001333 struct hci_ev_conn_complete *ev = (void *) skb->data;
1334 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001335
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001336 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001337
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001339
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001340 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001341 if (!conn) {
1342 if (ev->link_type != SCO_LINK)
1343 goto unlock;
1344
1345 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1346 if (!conn)
1347 goto unlock;
1348
1349 conn->type = SCO_LINK;
1350 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001351
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001352 if (!ev->status) {
1353 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001354
1355 if (conn->type == ACL_LINK) {
1356 conn->state = BT_CONFIG;
1357 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001358 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedbergf7520542011-01-20 12:34:39 +02001359 mgmt_connected(hdev->id, &ev->bdaddr);
Marcel Holtmann769be972008-07-14 20:13:49 +02001360 } else
1361 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001362
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001363 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001364 hci_conn_add_sysfs(conn);
1365
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001366 if (test_bit(HCI_AUTH, &hdev->flags))
1367 conn->link_mode |= HCI_LM_AUTH;
1368
1369 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1370 conn->link_mode |= HCI_LM_ENCRYPT;
1371
1372 /* Get remote features */
1373 if (conn->type == ACL_LINK) {
1374 struct hci_cp_read_remote_features cp;
1375 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001376 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1377 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001378 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001379
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001380 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001381 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001382 struct hci_cp_change_conn_ptype cp;
1383 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001384 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1385 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1386 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001387 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001388 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001389 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001390 if (conn->type == ACL_LINK)
1391 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1392 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001393
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001394 if (conn->type == ACL_LINK)
1395 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001396
Marcel Holtmann769be972008-07-14 20:13:49 +02001397 if (ev->status) {
1398 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001399 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001400 } else if (ev->link_type != ACL_LINK)
1401 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001402
1403unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001404 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001405
1406 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001407}
1408
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1410{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001411 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001412 int mask = hdev->link_mode;
1413
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001414 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1415 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001416
1417 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1418
Szymon Janc138d22e2011-02-17 16:44:23 +01001419 if ((mask & HCI_LM_ACCEPT) &&
1420 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001422 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001423 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001424
1425 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001426
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001427 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1428 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001429 memcpy(ie->data.dev_class, ev->dev_class, 3);
1430
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1432 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001433 /* pkt_type not yet used for incoming connections */
1434 conn = hci_conn_add(hdev, ev->link_type, 0, &ev->bdaddr);
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001435 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001436 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001437 hci_dev_unlock(hdev);
1438 return;
1439 }
1440 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001441
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 memcpy(conn->dev_class, ev->dev_class, 3);
1443 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001444
Linus Torvalds1da177e2005-04-16 15:20:36 -07001445 hci_dev_unlock(hdev);
1446
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001447 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1448 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001449
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001450 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001451
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001452 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1453 cp.role = 0x00; /* Become master */
1454 else
1455 cp.role = 0x01; /* Remain slave */
1456
1457 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1458 sizeof(cp), &cp);
1459 } else {
1460 struct hci_cp_accept_sync_conn_req cp;
1461
1462 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001463 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001464
1465 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1466 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1467 cp.max_latency = cpu_to_le16(0xffff);
1468 cp.content_format = cpu_to_le16(hdev->voice_setting);
1469 cp.retrans_effort = 0xff;
1470
1471 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1472 sizeof(cp), &cp);
1473 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001474 } else {
1475 /* Connection rejected */
1476 struct hci_cp_reject_conn_req cp;
1477
1478 bacpy(&cp.bdaddr, &ev->bdaddr);
1479 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001480 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001481 }
1482}
1483
Linus Torvalds1da177e2005-04-16 15:20:36 -07001484static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1485{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001486 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001487 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488
1489 BT_DBG("%s status %d", hdev->name, ev->status);
1490
Johan Hedberg8962ee72011-01-20 12:40:27 +02001491 if (ev->status) {
1492 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001493 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001494 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001495
1496 hci_dev_lock(hdev);
1497
Marcel Holtmann04837f62006-07-03 10:02:33 +02001498 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001499 if (!conn)
1500 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001501
Johan Hedbergf7520542011-01-20 12:34:39 +02001502 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001503
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001504 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedbergf7520542011-01-20 12:34:39 +02001505 mgmt_disconnected(hdev->id, &conn->dst);
1506
1507 hci_proto_disconn_cfm(conn, ev->reason);
1508 hci_conn_del(conn);
1509
1510unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511 hci_dev_unlock(hdev);
1512}
1513
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001514static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1515{
1516 struct hci_ev_auth_complete *ev = (void *) skb->data;
1517 struct hci_conn *conn;
1518
1519 BT_DBG("%s status %d", hdev->name, ev->status);
1520
1521 hci_dev_lock(hdev);
1522
1523 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001524 if (!conn)
1525 goto unlock;
1526
1527 if (!ev->status) {
1528 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1529 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1530 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001531 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001532 conn->link_mode |= HCI_LM_AUTH;
1533 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001534 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001535 } else {
1536 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1537 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001538
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001539 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1540 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001541
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001542 if (conn->state == BT_CONFIG) {
1543 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1544 struct hci_cp_set_conn_encrypt cp;
1545 cp.handle = ev->handle;
1546 cp.encrypt = 0x01;
1547 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1548 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001549 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001550 conn->state = BT_CONNECTED;
1551 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001552 hci_conn_put(conn);
1553 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001554 } else {
1555 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001556
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001557 hci_conn_hold(conn);
1558 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1559 hci_conn_put(conn);
1560 }
1561
1562 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1563 if (!ev->status) {
1564 struct hci_cp_set_conn_encrypt cp;
1565 cp.handle = ev->handle;
1566 cp.encrypt = 0x01;
1567 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1568 &cp);
1569 } else {
1570 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1571 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001572 }
1573 }
1574
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001575unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001576 hci_dev_unlock(hdev);
1577}
1578
1579static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1580{
Johan Hedberg127178d2010-11-18 22:22:29 +02001581 struct hci_ev_remote_name *ev = (void *) skb->data;
1582 struct hci_conn *conn;
1583
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001584 BT_DBG("%s", hdev->name);
1585
1586 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001587
1588 hci_dev_lock(hdev);
1589
Johan Hedberga88a9652011-03-30 13:18:12 +03001590 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1591 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1592
Johan Hedberg127178d2010-11-18 22:22:29 +02001593 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001594 if (!conn)
1595 goto unlock;
1596
1597 if (!hci_outgoing_auth_needed(hdev, conn))
1598 goto unlock;
1599
1600 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001601 struct hci_cp_auth_requested cp;
1602 cp.handle = __cpu_to_le16(conn->handle);
1603 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1604 }
1605
Johan Hedberg79c6c702011-04-28 11:28:55 -07001606unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001607 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001608}
1609
1610static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1611{
1612 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1613 struct hci_conn *conn;
1614
1615 BT_DBG("%s status %d", hdev->name, ev->status);
1616
1617 hci_dev_lock(hdev);
1618
1619 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1620 if (conn) {
1621 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001622 if (ev->encrypt) {
1623 /* Encryption implies authentication */
1624 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001625 conn->link_mode |= HCI_LM_ENCRYPT;
Marcel Holtmannae293192008-07-14 20:13:45 +02001626 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001627 conn->link_mode &= ~HCI_LM_ENCRYPT;
1628 }
1629
1630 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1631
Marcel Holtmannf8558552008-07-14 20:13:49 +02001632 if (conn->state == BT_CONFIG) {
1633 if (!ev->status)
1634 conn->state = BT_CONNECTED;
1635
1636 hci_proto_connect_cfm(conn, ev->status);
1637 hci_conn_put(conn);
1638 } else
1639 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001640 }
1641
1642 hci_dev_unlock(hdev);
1643}
1644
1645static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1646{
1647 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1648 struct hci_conn *conn;
1649
1650 BT_DBG("%s status %d", hdev->name, ev->status);
1651
1652 hci_dev_lock(hdev);
1653
1654 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1655 if (conn) {
1656 if (!ev->status)
1657 conn->link_mode |= HCI_LM_SECURE;
1658
1659 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1660
1661 hci_key_change_cfm(conn, ev->status);
1662 }
1663
1664 hci_dev_unlock(hdev);
1665}
1666
1667static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1668{
1669 struct hci_ev_remote_features *ev = (void *) skb->data;
1670 struct hci_conn *conn;
1671
1672 BT_DBG("%s status %d", hdev->name, ev->status);
1673
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001674 hci_dev_lock(hdev);
1675
1676 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001677 if (!conn)
1678 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001679
Johan Hedbergccd556f2010-11-10 17:11:51 +02001680 if (!ev->status)
1681 memcpy(conn->features, ev->features, 8);
1682
1683 if (conn->state != BT_CONFIG)
1684 goto unlock;
1685
1686 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1687 struct hci_cp_read_remote_ext_features cp;
1688 cp.handle = ev->handle;
1689 cp.page = 0x01;
1690 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001691 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001692 goto unlock;
1693 }
1694
Johan Hedberg127178d2010-11-18 22:22:29 +02001695 if (!ev->status) {
1696 struct hci_cp_remote_name_req cp;
1697 memset(&cp, 0, sizeof(cp));
1698 bacpy(&cp.bdaddr, &conn->dst);
1699 cp.pscan_rep_mode = 0x02;
1700 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1701 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001702
Johan Hedberg127178d2010-11-18 22:22:29 +02001703 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001704 conn->state = BT_CONNECTED;
1705 hci_proto_connect_cfm(conn, ev->status);
1706 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001707 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001708
Johan Hedbergccd556f2010-11-10 17:11:51 +02001709unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001710 hci_dev_unlock(hdev);
1711}
1712
1713static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1714{
1715 BT_DBG("%s", hdev->name);
1716}
1717
1718static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1719{
1720 BT_DBG("%s", hdev->name);
1721}
1722
1723static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1724{
1725 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1726 __u16 opcode;
1727
1728 skb_pull(skb, sizeof(*ev));
1729
1730 opcode = __le16_to_cpu(ev->opcode);
1731
1732 switch (opcode) {
1733 case HCI_OP_INQUIRY_CANCEL:
1734 hci_cc_inquiry_cancel(hdev, skb);
1735 break;
1736
1737 case HCI_OP_EXIT_PERIODIC_INQ:
1738 hci_cc_exit_periodic_inq(hdev, skb);
1739 break;
1740
1741 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1742 hci_cc_remote_name_req_cancel(hdev, skb);
1743 break;
1744
1745 case HCI_OP_ROLE_DISCOVERY:
1746 hci_cc_role_discovery(hdev, skb);
1747 break;
1748
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001749 case HCI_OP_READ_LINK_POLICY:
1750 hci_cc_read_link_policy(hdev, skb);
1751 break;
1752
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001753 case HCI_OP_WRITE_LINK_POLICY:
1754 hci_cc_write_link_policy(hdev, skb);
1755 break;
1756
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001757 case HCI_OP_READ_DEF_LINK_POLICY:
1758 hci_cc_read_def_link_policy(hdev, skb);
1759 break;
1760
1761 case HCI_OP_WRITE_DEF_LINK_POLICY:
1762 hci_cc_write_def_link_policy(hdev, skb);
1763 break;
1764
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001765 case HCI_OP_RESET:
1766 hci_cc_reset(hdev, skb);
1767 break;
1768
1769 case HCI_OP_WRITE_LOCAL_NAME:
1770 hci_cc_write_local_name(hdev, skb);
1771 break;
1772
1773 case HCI_OP_READ_LOCAL_NAME:
1774 hci_cc_read_local_name(hdev, skb);
1775 break;
1776
1777 case HCI_OP_WRITE_AUTH_ENABLE:
1778 hci_cc_write_auth_enable(hdev, skb);
1779 break;
1780
1781 case HCI_OP_WRITE_ENCRYPT_MODE:
1782 hci_cc_write_encrypt_mode(hdev, skb);
1783 break;
1784
1785 case HCI_OP_WRITE_SCAN_ENABLE:
1786 hci_cc_write_scan_enable(hdev, skb);
1787 break;
1788
1789 case HCI_OP_READ_CLASS_OF_DEV:
1790 hci_cc_read_class_of_dev(hdev, skb);
1791 break;
1792
1793 case HCI_OP_WRITE_CLASS_OF_DEV:
1794 hci_cc_write_class_of_dev(hdev, skb);
1795 break;
1796
1797 case HCI_OP_READ_VOICE_SETTING:
1798 hci_cc_read_voice_setting(hdev, skb);
1799 break;
1800
1801 case HCI_OP_WRITE_VOICE_SETTING:
1802 hci_cc_write_voice_setting(hdev, skb);
1803 break;
1804
1805 case HCI_OP_HOST_BUFFER_SIZE:
1806 hci_cc_host_buffer_size(hdev, skb);
1807 break;
1808
Marcel Holtmann333140b2008-07-14 20:13:48 +02001809 case HCI_OP_READ_SSP_MODE:
1810 hci_cc_read_ssp_mode(hdev, skb);
1811 break;
1812
1813 case HCI_OP_WRITE_SSP_MODE:
1814 hci_cc_write_ssp_mode(hdev, skb);
1815 break;
1816
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001817 case HCI_OP_READ_LOCAL_VERSION:
1818 hci_cc_read_local_version(hdev, skb);
1819 break;
1820
1821 case HCI_OP_READ_LOCAL_COMMANDS:
1822 hci_cc_read_local_commands(hdev, skb);
1823 break;
1824
1825 case HCI_OP_READ_LOCAL_FEATURES:
1826 hci_cc_read_local_features(hdev, skb);
1827 break;
1828
1829 case HCI_OP_READ_BUFFER_SIZE:
1830 hci_cc_read_buffer_size(hdev, skb);
1831 break;
1832
1833 case HCI_OP_READ_BD_ADDR:
1834 hci_cc_read_bd_addr(hdev, skb);
1835 break;
1836
Johan Hedberg23bb5762010-12-21 23:01:27 +02001837 case HCI_OP_WRITE_CA_TIMEOUT:
1838 hci_cc_write_ca_timeout(hdev, skb);
1839 break;
1840
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001841 case HCI_OP_DELETE_STORED_LINK_KEY:
1842 hci_cc_delete_stored_link_key(hdev, skb);
1843 break;
1844
Johan Hedbergd5859e22011-01-25 01:19:58 +02001845 case HCI_OP_SET_EVENT_MASK:
1846 hci_cc_set_event_mask(hdev, skb);
1847 break;
1848
1849 case HCI_OP_WRITE_INQUIRY_MODE:
1850 hci_cc_write_inquiry_mode(hdev, skb);
1851 break;
1852
1853 case HCI_OP_READ_INQ_RSP_TX_POWER:
1854 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1855 break;
1856
1857 case HCI_OP_SET_EVENT_FLT:
1858 hci_cc_set_event_flt(hdev, skb);
1859 break;
1860
Johan Hedberg980e1a52011-01-22 06:10:07 +02001861 case HCI_OP_PIN_CODE_REPLY:
1862 hci_cc_pin_code_reply(hdev, skb);
1863 break;
1864
1865 case HCI_OP_PIN_CODE_NEG_REPLY:
1866 hci_cc_pin_code_neg_reply(hdev, skb);
1867 break;
1868
Szymon Jancc35938b2011-03-22 13:12:21 +01001869 case HCI_OP_READ_LOCAL_OOB_DATA:
1870 hci_cc_read_local_oob_data_reply(hdev, skb);
1871 break;
1872
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001873 case HCI_OP_LE_READ_BUFFER_SIZE:
1874 hci_cc_le_read_buffer_size(hdev, skb);
1875 break;
1876
Johan Hedberga5c29682011-02-19 12:05:57 -03001877 case HCI_OP_USER_CONFIRM_REPLY:
1878 hci_cc_user_confirm_reply(hdev, skb);
1879 break;
1880
1881 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1882 hci_cc_user_confirm_neg_reply(hdev, skb);
1883 break;
1884
Andre Guedes726e1332011-05-26 16:23:52 -03001885 case HCI_OP_LE_SET_SCAN_ENABLE:
1886 hci_cc_le_set_scan_enable(hdev, skb);
1887 break;
1888
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001889 case HCI_OP_LE_LTK_REPLY:
1890 hci_cc_le_ltk_reply(hdev, skb);
1891 break;
1892
1893 case HCI_OP_LE_LTK_NEG_REPLY:
1894 hci_cc_le_ltk_neg_reply(hdev, skb);
1895 break;
1896
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001897 default:
1898 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1899 break;
1900 }
1901
Ville Tervo6bd32322011-02-16 16:32:41 +02001902 if (ev->opcode != HCI_OP_NOP)
1903 del_timer(&hdev->cmd_timer);
1904
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001905 if (ev->ncmd) {
1906 atomic_set(&hdev->cmd_cnt, 1);
1907 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01001908 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001909 }
1910}
1911
1912static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1913{
1914 struct hci_ev_cmd_status *ev = (void *) skb->data;
1915 __u16 opcode;
1916
1917 skb_pull(skb, sizeof(*ev));
1918
1919 opcode = __le16_to_cpu(ev->opcode);
1920
1921 switch (opcode) {
1922 case HCI_OP_INQUIRY:
1923 hci_cs_inquiry(hdev, ev->status);
1924 break;
1925
1926 case HCI_OP_CREATE_CONN:
1927 hci_cs_create_conn(hdev, ev->status);
1928 break;
1929
1930 case HCI_OP_ADD_SCO:
1931 hci_cs_add_sco(hdev, ev->status);
1932 break;
1933
Marcel Holtmannf8558552008-07-14 20:13:49 +02001934 case HCI_OP_AUTH_REQUESTED:
1935 hci_cs_auth_requested(hdev, ev->status);
1936 break;
1937
1938 case HCI_OP_SET_CONN_ENCRYPT:
1939 hci_cs_set_conn_encrypt(hdev, ev->status);
1940 break;
1941
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001942 case HCI_OP_REMOTE_NAME_REQ:
1943 hci_cs_remote_name_req(hdev, ev->status);
1944 break;
1945
Marcel Holtmann769be972008-07-14 20:13:49 +02001946 case HCI_OP_READ_REMOTE_FEATURES:
1947 hci_cs_read_remote_features(hdev, ev->status);
1948 break;
1949
1950 case HCI_OP_READ_REMOTE_EXT_FEATURES:
1951 hci_cs_read_remote_ext_features(hdev, ev->status);
1952 break;
1953
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001954 case HCI_OP_SETUP_SYNC_CONN:
1955 hci_cs_setup_sync_conn(hdev, ev->status);
1956 break;
1957
1958 case HCI_OP_SNIFF_MODE:
1959 hci_cs_sniff_mode(hdev, ev->status);
1960 break;
1961
1962 case HCI_OP_EXIT_SNIFF_MODE:
1963 hci_cs_exit_sniff_mode(hdev, ev->status);
1964 break;
1965
Johan Hedberg8962ee72011-01-20 12:40:27 +02001966 case HCI_OP_DISCONNECT:
1967 if (ev->status != 0)
1968 mgmt_disconnect_failed(hdev->id);
1969 break;
1970
Ville Tervofcd89c02011-02-10 22:38:47 -03001971 case HCI_OP_LE_CREATE_CONN:
1972 hci_cs_le_create_conn(hdev, ev->status);
1973 break;
1974
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001975 case HCI_OP_LE_START_ENC:
1976 hci_cs_le_start_enc(hdev, ev->status);
1977 break;
1978
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001979 default:
1980 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1981 break;
1982 }
1983
Ville Tervo6bd32322011-02-16 16:32:41 +02001984 if (ev->opcode != HCI_OP_NOP)
1985 del_timer(&hdev->cmd_timer);
1986
Gustavo F. Padovan10572132011-03-16 15:36:29 -03001987 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001988 atomic_set(&hdev->cmd_cnt, 1);
1989 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01001990 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001991 }
1992}
1993
1994static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1995{
1996 struct hci_ev_role_change *ev = (void *) skb->data;
1997 struct hci_conn *conn;
1998
1999 BT_DBG("%s status %d", hdev->name, ev->status);
2000
2001 hci_dev_lock(hdev);
2002
2003 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2004 if (conn) {
2005 if (!ev->status) {
2006 if (ev->role)
2007 conn->link_mode &= ~HCI_LM_MASTER;
2008 else
2009 conn->link_mode |= HCI_LM_MASTER;
2010 }
2011
2012 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2013
2014 hci_role_switch_cfm(conn, ev->status, ev->role);
2015 }
2016
2017 hci_dev_unlock(hdev);
2018}
2019
Linus Torvalds1da177e2005-04-16 15:20:36 -07002020static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2021{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002022 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002023 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002024 int i;
2025
2026 skb_pull(skb, sizeof(*ev));
2027
2028 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2029
2030 if (skb->len < ev->num_hndl * 4) {
2031 BT_DBG("%s bad parameters", hdev->name);
2032 return;
2033 }
2034
2035 tasklet_disable(&hdev->tx_task);
2036
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002037 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038 struct hci_conn *conn;
2039 __u16 handle, count;
2040
Harvey Harrison83985312008-05-02 16:25:46 -07002041 handle = get_unaligned_le16(ptr++);
2042 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043
2044 conn = hci_conn_hash_lookup_handle(hdev, handle);
2045 if (conn) {
2046 conn->sent -= count;
2047
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002048 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002049 hdev->acl_cnt += count;
2050 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002051 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002052 } else if (conn->type == LE_LINK) {
2053 if (hdev->le_pkts) {
2054 hdev->le_cnt += count;
2055 if (hdev->le_cnt > hdev->le_pkts)
2056 hdev->le_cnt = hdev->le_pkts;
2057 } else {
2058 hdev->acl_cnt += count;
2059 if (hdev->acl_cnt > hdev->acl_pkts)
2060 hdev->acl_cnt = hdev->acl_pkts;
2061 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002062 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002063 hdev->sco_cnt += count;
2064 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002065 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002066 }
2067 }
2068 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002069
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002070 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002071
2072 tasklet_enable(&hdev->tx_task);
2073}
2074
Marcel Holtmann04837f62006-07-03 10:02:33 +02002075static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002076{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002077 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002078 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002079
2080 BT_DBG("%s status %d", hdev->name, ev->status);
2081
2082 hci_dev_lock(hdev);
2083
Marcel Holtmann04837f62006-07-03 10:02:33 +02002084 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2085 if (conn) {
2086 conn->mode = ev->mode;
2087 conn->interval = __le16_to_cpu(ev->interval);
2088
2089 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2090 if (conn->mode == HCI_CM_ACTIVE)
2091 conn->power_save = 1;
2092 else
2093 conn->power_save = 0;
2094 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002095
2096 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2097 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002098 }
2099
2100 hci_dev_unlock(hdev);
2101}
2102
Linus Torvalds1da177e2005-04-16 15:20:36 -07002103static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2104{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002105 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2106 struct hci_conn *conn;
2107
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002108 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002109
2110 hci_dev_lock(hdev);
2111
2112 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Marcel Holtmann3d7a9d12009-05-09 12:09:21 -07002113 if (conn && conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002114 hci_conn_hold(conn);
2115 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2116 hci_conn_put(conn);
2117 }
2118
Johan Hedberg03b555e2011-01-04 15:40:05 +02002119 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2120 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2121 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002122 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002123 u8 secure;
2124
2125 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2126 secure = 1;
2127 else
2128 secure = 0;
2129
2130 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2131 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002132
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002133 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002134}
2135
Linus Torvalds1da177e2005-04-16 15:20:36 -07002136static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2137{
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002138 struct hci_ev_link_key_req *ev = (void *) skb->data;
2139 struct hci_cp_link_key_reply cp;
2140 struct hci_conn *conn;
2141 struct link_key *key;
2142
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002143 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002144
2145 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2146 return;
2147
2148 hci_dev_lock(hdev);
2149
2150 key = hci_find_link_key(hdev, &ev->bdaddr);
2151 if (!key) {
2152 BT_DBG("%s link key not found for %s", hdev->name,
2153 batostr(&ev->bdaddr));
2154 goto not_found;
2155 }
2156
2157 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2158 batostr(&ev->bdaddr));
2159
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002160 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2161 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002162 BT_DBG("%s ignoring debug key", hdev->name);
2163 goto not_found;
2164 }
2165
2166 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002167 if (conn) {
2168 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2169 conn->auth_type != 0xff &&
2170 (conn->auth_type & 0x01)) {
2171 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2172 goto not_found;
2173 }
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002174
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002175 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2176 conn->pending_sec_level == BT_SECURITY_HIGH) {
2177 BT_DBG("%s ignoring key unauthenticated for high \
2178 security", hdev->name);
2179 goto not_found;
2180 }
2181
2182 conn->key_type = key->type;
2183 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002184 }
2185
2186 bacpy(&cp.bdaddr, &ev->bdaddr);
2187 memcpy(cp.link_key, key->val, 16);
2188
2189 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2190
2191 hci_dev_unlock(hdev);
2192
2193 return;
2194
2195not_found:
2196 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2197 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002198}
2199
Linus Torvalds1da177e2005-04-16 15:20:36 -07002200static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2201{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002202 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2203 struct hci_conn *conn;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002204 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002205
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002206 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002207
2208 hci_dev_lock(hdev);
2209
2210 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2211 if (conn) {
2212 hci_conn_hold(conn);
2213 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002214 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002215
2216 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2217 conn->key_type = ev->key_type;
2218
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002219 hci_conn_put(conn);
2220 }
2221
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002222 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002223 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002224 ev->key_type, pin_len);
2225
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002226 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002227}
2228
Marcel Holtmann04837f62006-07-03 10:02:33 +02002229static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2230{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002231 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002232 struct hci_conn *conn;
2233
2234 BT_DBG("%s status %d", hdev->name, ev->status);
2235
2236 hci_dev_lock(hdev);
2237
2238 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002239 if (conn && !ev->status) {
2240 struct inquiry_entry *ie;
2241
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002242 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2243 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002244 ie->data.clock_offset = ev->clock_offset;
2245 ie->timestamp = jiffies;
2246 }
2247 }
2248
2249 hci_dev_unlock(hdev);
2250}
2251
Marcel Holtmanna8746412008-07-14 20:13:46 +02002252static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2253{
2254 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2255 struct hci_conn *conn;
2256
2257 BT_DBG("%s status %d", hdev->name, ev->status);
2258
2259 hci_dev_lock(hdev);
2260
2261 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2262 if (conn && !ev->status)
2263 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2264
2265 hci_dev_unlock(hdev);
2266}
2267
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002268static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2269{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002270 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002271 struct inquiry_entry *ie;
2272
2273 BT_DBG("%s", hdev->name);
2274
2275 hci_dev_lock(hdev);
2276
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002277 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2278 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002279 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2280 ie->timestamp = jiffies;
2281 }
2282
2283 hci_dev_unlock(hdev);
2284}
2285
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002286static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2287{
2288 struct inquiry_data data;
2289 int num_rsp = *((__u8 *) skb->data);
2290
2291 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2292
2293 if (!num_rsp)
2294 return;
2295
2296 hci_dev_lock(hdev);
2297
Johan Hedberg314b2382011-04-27 10:29:57 -04002298 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2299
2300 if (test_bit(HCI_MGMT, &hdev->flags))
2301 mgmt_discovering(hdev->id, 1);
2302 }
2303
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002304 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002305 struct inquiry_info_with_rssi_and_pscan_mode *info;
2306 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002307
Johan Hedberge17acd42011-03-30 23:57:16 +03002308 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002309 bacpy(&data.bdaddr, &info->bdaddr);
2310 data.pscan_rep_mode = info->pscan_rep_mode;
2311 data.pscan_period_mode = info->pscan_period_mode;
2312 data.pscan_mode = info->pscan_mode;
2313 memcpy(data.dev_class, info->dev_class, 3);
2314 data.clock_offset = info->clock_offset;
2315 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002316 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002317 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002318 mgmt_device_found(hdev->id, &info->bdaddr,
2319 info->dev_class, info->rssi,
2320 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002321 }
2322 } else {
2323 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2324
Johan Hedberge17acd42011-03-30 23:57:16 +03002325 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002326 bacpy(&data.bdaddr, &info->bdaddr);
2327 data.pscan_rep_mode = info->pscan_rep_mode;
2328 data.pscan_period_mode = info->pscan_period_mode;
2329 data.pscan_mode = 0x00;
2330 memcpy(data.dev_class, info->dev_class, 3);
2331 data.clock_offset = info->clock_offset;
2332 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002333 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002334 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002335 mgmt_device_found(hdev->id, &info->bdaddr,
2336 info->dev_class, info->rssi,
2337 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002338 }
2339 }
2340
2341 hci_dev_unlock(hdev);
2342}
2343
2344static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2345{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002346 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2347 struct hci_conn *conn;
2348
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002349 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002350
Marcel Holtmann41a96212008-07-14 20:13:48 +02002351 hci_dev_lock(hdev);
2352
2353 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002354 if (!conn)
2355 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002356
Johan Hedbergccd556f2010-11-10 17:11:51 +02002357 if (!ev->status && ev->page == 0x01) {
2358 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002359
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002360 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2361 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002362 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002363
Johan Hedbergccd556f2010-11-10 17:11:51 +02002364 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002365 }
2366
Johan Hedbergccd556f2010-11-10 17:11:51 +02002367 if (conn->state != BT_CONFIG)
2368 goto unlock;
2369
Johan Hedberg127178d2010-11-18 22:22:29 +02002370 if (!ev->status) {
2371 struct hci_cp_remote_name_req cp;
2372 memset(&cp, 0, sizeof(cp));
2373 bacpy(&cp.bdaddr, &conn->dst);
2374 cp.pscan_rep_mode = 0x02;
2375 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2376 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002377
Johan Hedberg127178d2010-11-18 22:22:29 +02002378 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002379 conn->state = BT_CONNECTED;
2380 hci_proto_connect_cfm(conn, ev->status);
2381 hci_conn_put(conn);
2382 }
2383
2384unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002385 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002386}
2387
2388static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2389{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002390 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2391 struct hci_conn *conn;
2392
2393 BT_DBG("%s status %d", hdev->name, ev->status);
2394
2395 hci_dev_lock(hdev);
2396
2397 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002398 if (!conn) {
2399 if (ev->link_type == ESCO_LINK)
2400 goto unlock;
2401
2402 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2403 if (!conn)
2404 goto unlock;
2405
2406 conn->type = SCO_LINK;
2407 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002408
Marcel Holtmann732547f2009-04-19 19:14:14 +02002409 switch (ev->status) {
2410 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002411 conn->handle = __le16_to_cpu(ev->handle);
2412 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002413
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002414 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002415 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002416 break;
2417
Nick Pelly5c9b4de2009-09-22 15:19:46 -07002418 case 0x10: /* Connection Accept Timeout */
Stephen Coe705e5712010-02-16 11:29:44 -05002419 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002420 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002421 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002422 case 0x1f: /* Unspecified error */
2423 if (conn->out && conn->attempt < 2) {
2424 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2425 (hdev->esco_type & EDR_ESCO_MASK);
2426 hci_setup_sync(conn, conn->link->handle);
2427 goto unlock;
2428 }
2429 /* fall through */
2430
2431 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002432 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002433 break;
2434 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002435
2436 hci_proto_connect_cfm(conn, ev->status);
2437 if (ev->status)
2438 hci_conn_del(conn);
2439
2440unlock:
2441 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002442}
2443
2444static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2445{
2446 BT_DBG("%s", hdev->name);
2447}
2448
Marcel Holtmann04837f62006-07-03 10:02:33 +02002449static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2450{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002451 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002452
2453 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002454}
2455
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002456static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2457{
2458 struct inquiry_data data;
2459 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2460 int num_rsp = *((__u8 *) skb->data);
2461
2462 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2463
2464 if (!num_rsp)
2465 return;
2466
Johan Hedberg314b2382011-04-27 10:29:57 -04002467 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2468
2469 if (test_bit(HCI_MGMT, &hdev->flags))
2470 mgmt_discovering(hdev->id, 1);
2471 }
2472
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002473 hci_dev_lock(hdev);
2474
Johan Hedberge17acd42011-03-30 23:57:16 +03002475 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002476 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002477 data.pscan_rep_mode = info->pscan_rep_mode;
2478 data.pscan_period_mode = info->pscan_period_mode;
2479 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002480 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002481 data.clock_offset = info->clock_offset;
2482 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002483 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002484 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002485 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class,
2486 info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002487 }
2488
2489 hci_dev_unlock(hdev);
2490}
2491
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002492static inline u8 hci_get_auth_req(struct hci_conn *conn)
2493{
2494 /* If remote requests dedicated bonding follow that lead */
2495 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2496 /* If both remote and local IO capabilities allow MITM
2497 * protection then require it, otherwise don't */
2498 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2499 return 0x02;
2500 else
2501 return 0x03;
2502 }
2503
2504 /* If remote requests no-bonding follow that lead */
2505 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002506 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002507
2508 return conn->auth_type;
2509}
2510
Marcel Holtmann04936842008-07-14 20:13:48 +02002511static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2512{
2513 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2514 struct hci_conn *conn;
2515
2516 BT_DBG("%s", hdev->name);
2517
2518 hci_dev_lock(hdev);
2519
2520 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002521 if (!conn)
2522 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002523
Johan Hedberg03b555e2011-01-04 15:40:05 +02002524 hci_conn_hold(conn);
2525
2526 if (!test_bit(HCI_MGMT, &hdev->flags))
2527 goto unlock;
2528
2529 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2530 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002531 struct hci_cp_io_capability_reply cp;
2532
2533 bacpy(&cp.bdaddr, &ev->bdaddr);
2534 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002535 conn->auth_type = hci_get_auth_req(conn);
2536 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002537
Szymon Jancce85ee12011-03-22 13:12:23 +01002538 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2539 hci_find_remote_oob_data(hdev, &conn->dst))
2540 cp.oob_data = 0x01;
2541 else
2542 cp.oob_data = 0x00;
2543
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002544 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2545 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002546 } else {
2547 struct hci_cp_io_capability_neg_reply cp;
2548
2549 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedbergbe771592011-04-28 11:28:57 -07002550 cp.reason = 0x18; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02002551
2552 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2553 sizeof(cp), &cp);
2554 }
2555
2556unlock:
2557 hci_dev_unlock(hdev);
2558}
2559
2560static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2561{
2562 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2563 struct hci_conn *conn;
2564
2565 BT_DBG("%s", hdev->name);
2566
2567 hci_dev_lock(hdev);
2568
2569 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2570 if (!conn)
2571 goto unlock;
2572
Johan Hedberg03b555e2011-01-04 15:40:05 +02002573 conn->remote_cap = ev->capability;
2574 conn->remote_oob = ev->oob_data;
2575 conn->remote_auth = ev->authentication;
2576
2577unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002578 hci_dev_unlock(hdev);
2579}
2580
Johan Hedberga5c29682011-02-19 12:05:57 -03002581static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2582 struct sk_buff *skb)
2583{
2584 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002585 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002586 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002587
2588 BT_DBG("%s", hdev->name);
2589
2590 hci_dev_lock(hdev);
2591
Johan Hedberg7a828902011-04-28 11:28:53 -07002592 if (!test_bit(HCI_MGMT, &hdev->flags))
2593 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002594
Johan Hedberg7a828902011-04-28 11:28:53 -07002595 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2596 if (!conn)
2597 goto unlock;
2598
2599 loc_mitm = (conn->auth_type & 0x01);
2600 rem_mitm = (conn->remote_auth & 0x01);
2601
2602 /* If we require MITM but the remote device can't provide that
2603 * (it has NoInputNoOutput) then reject the confirmation
2604 * request. The only exception is when we're dedicated bonding
2605 * initiators (connect_cfm_cb set) since then we always have the MITM
2606 * bit set. */
2607 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2608 BT_DBG("Rejecting request: remote device can't provide MITM");
2609 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2610 sizeof(ev->bdaddr), &ev->bdaddr);
2611 goto unlock;
2612 }
2613
2614 /* If no side requires MITM protection; auto-accept */
2615 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2616 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002617
2618 /* If we're not the initiators request authorization to
2619 * proceed from user space (mgmt_user_confirm with
2620 * confirm_hint set to 1). */
2621 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2622 BT_DBG("Confirming auto-accept as acceptor");
2623 confirm_hint = 1;
2624 goto confirm;
2625 }
2626
Johan Hedberg9f616562011-04-28 11:28:54 -07002627 BT_DBG("Auto-accept of user confirmation with %ums delay",
2628 hdev->auto_accept_delay);
2629
2630 if (hdev->auto_accept_delay > 0) {
2631 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2632 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2633 goto unlock;
2634 }
2635
Johan Hedberg7a828902011-04-28 11:28:53 -07002636 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2637 sizeof(ev->bdaddr), &ev->bdaddr);
2638 goto unlock;
2639 }
2640
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002641confirm:
2642 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2643 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002644
2645unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002646 hci_dev_unlock(hdev);
2647}
2648
Marcel Holtmann04936842008-07-14 20:13:48 +02002649static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2650{
2651 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2652 struct hci_conn *conn;
2653
2654 BT_DBG("%s", hdev->name);
2655
2656 hci_dev_lock(hdev);
2657
2658 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002659 if (!conn)
2660 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002661
Johan Hedberg2a611692011-02-19 12:06:00 -03002662 /* To avoid duplicate auth_failed events to user space we check
2663 * the HCI_CONN_AUTH_PEND flag which will be set if we
2664 * initiated the authentication. A traditional auth_complete
2665 * event gets always produced as initiator and is also mapped to
2666 * the mgmt_auth_failed event */
2667 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2668 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2669
2670 hci_conn_put(conn);
2671
2672unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002673 hci_dev_unlock(hdev);
2674}
2675
Marcel Holtmann41a96212008-07-14 20:13:48 +02002676static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2677{
2678 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2679 struct inquiry_entry *ie;
2680
2681 BT_DBG("%s", hdev->name);
2682
2683 hci_dev_lock(hdev);
2684
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002685 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2686 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002687 ie->data.ssp_mode = (ev->features[0] & 0x01);
2688
2689 hci_dev_unlock(hdev);
2690}
2691
Szymon Janc2763eda2011-03-22 13:12:22 +01002692static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2693 struct sk_buff *skb)
2694{
2695 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2696 struct oob_data *data;
2697
2698 BT_DBG("%s", hdev->name);
2699
2700 hci_dev_lock(hdev);
2701
Szymon Jance1ba1f12011-04-06 13:01:59 +02002702 if (!test_bit(HCI_MGMT, &hdev->flags))
2703 goto unlock;
2704
Szymon Janc2763eda2011-03-22 13:12:22 +01002705 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2706 if (data) {
2707 struct hci_cp_remote_oob_data_reply cp;
2708
2709 bacpy(&cp.bdaddr, &ev->bdaddr);
2710 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2711 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2712
2713 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2714 &cp);
2715 } else {
2716 struct hci_cp_remote_oob_data_neg_reply cp;
2717
2718 bacpy(&cp.bdaddr, &ev->bdaddr);
2719 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2720 &cp);
2721 }
2722
Szymon Jance1ba1f12011-04-06 13:01:59 +02002723unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002724 hci_dev_unlock(hdev);
2725}
2726
Ville Tervofcd89c02011-02-10 22:38:47 -03002727static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2728{
2729 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2730 struct hci_conn *conn;
2731
2732 BT_DBG("%s status %d", hdev->name, ev->status);
2733
2734 hci_dev_lock(hdev);
2735
2736 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002737 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08002738 conn = hci_conn_add(hdev, LE_LINK, 0, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002739 if (!conn) {
2740 BT_ERR("No memory for new connection");
2741 hci_dev_unlock(hdev);
2742 return;
2743 }
Andre Guedes149c0972011-05-31 14:20:54 -03002744
2745 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002746 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002747
2748 if (ev->status) {
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002749 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002750 hci_proto_connect_cfm(conn, ev->status);
2751 conn->state = BT_CLOSED;
2752 hci_conn_del(conn);
2753 goto unlock;
2754 }
2755
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002756 mgmt_connected(hdev->id, &ev->bdaddr);
2757
Vinicius Costa Gomes403d2c82011-06-09 18:50:50 -03002758 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002759 conn->handle = __le16_to_cpu(ev->handle);
2760 conn->state = BT_CONNECTED;
2761
2762 hci_conn_hold_device(conn);
2763 hci_conn_add_sysfs(conn);
2764
2765 hci_proto_connect_cfm(conn, ev->status);
2766
2767unlock:
2768 hci_dev_unlock(hdev);
2769}
2770
Andre Guedes5df108f2011-05-26 16:23:51 -03002771static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2772 struct sk_buff *skb)
2773{
2774 struct hci_ev_le_advertising_info *ev;
2775 u8 num_reports;
2776
2777 num_reports = skb->data[0];
2778 ev = (void *) &skb->data[1];
2779
2780 hci_dev_lock(hdev);
2781
2782 hci_add_adv_entry(hdev, ev);
2783
2784 while (--num_reports) {
2785 ev = (void *) (ev->data + ev->length + 1);
2786 hci_add_adv_entry(hdev, ev);
2787 }
2788
2789 hci_dev_unlock(hdev);
2790}
2791
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002792static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2793 struct sk_buff *skb)
2794{
2795 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2796 struct hci_cp_le_ltk_reply cp;
2797 struct hci_conn *conn;
2798
2799 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2800
2801 hci_dev_lock(hdev);
2802
2803 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2804
2805 memset(&cp, 0, sizeof(cp));
2806 cp.handle = cpu_to_le16(conn->handle);
2807 memcpy(cp.ltk, conn->ltk, sizeof(conn->ltk));
2808
2809 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2810
2811 hci_dev_unlock(hdev);
2812}
2813
Ville Tervofcd89c02011-02-10 22:38:47 -03002814static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2815{
2816 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2817
2818 skb_pull(skb, sizeof(*le_ev));
2819
2820 switch (le_ev->subevent) {
2821 case HCI_EV_LE_CONN_COMPLETE:
2822 hci_le_conn_complete_evt(hdev, skb);
2823 break;
2824
Andre Guedes5df108f2011-05-26 16:23:51 -03002825 case HCI_EV_LE_ADVERTISING_REPORT:
2826 hci_le_adv_report_evt(hdev, skb);
2827 break;
2828
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002829 case HCI_EV_LE_LTK_REQ:
2830 hci_le_ltk_request_evt(hdev, skb);
2831 break;
2832
Ville Tervofcd89c02011-02-10 22:38:47 -03002833 default:
2834 break;
2835 }
2836}
2837
Linus Torvalds1da177e2005-04-16 15:20:36 -07002838void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2839{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002840 struct hci_event_hdr *hdr = (void *) skb->data;
2841 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002842
2843 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2844
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002845 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002846 case HCI_EV_INQUIRY_COMPLETE:
2847 hci_inquiry_complete_evt(hdev, skb);
2848 break;
2849
2850 case HCI_EV_INQUIRY_RESULT:
2851 hci_inquiry_result_evt(hdev, skb);
2852 break;
2853
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002854 case HCI_EV_CONN_COMPLETE:
2855 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002856 break;
2857
Linus Torvalds1da177e2005-04-16 15:20:36 -07002858 case HCI_EV_CONN_REQUEST:
2859 hci_conn_request_evt(hdev, skb);
2860 break;
2861
Linus Torvalds1da177e2005-04-16 15:20:36 -07002862 case HCI_EV_DISCONN_COMPLETE:
2863 hci_disconn_complete_evt(hdev, skb);
2864 break;
2865
Linus Torvalds1da177e2005-04-16 15:20:36 -07002866 case HCI_EV_AUTH_COMPLETE:
2867 hci_auth_complete_evt(hdev, skb);
2868 break;
2869
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002870 case HCI_EV_REMOTE_NAME:
2871 hci_remote_name_evt(hdev, skb);
2872 break;
2873
Linus Torvalds1da177e2005-04-16 15:20:36 -07002874 case HCI_EV_ENCRYPT_CHANGE:
2875 hci_encrypt_change_evt(hdev, skb);
2876 break;
2877
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002878 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2879 hci_change_link_key_complete_evt(hdev, skb);
2880 break;
2881
2882 case HCI_EV_REMOTE_FEATURES:
2883 hci_remote_features_evt(hdev, skb);
2884 break;
2885
2886 case HCI_EV_REMOTE_VERSION:
2887 hci_remote_version_evt(hdev, skb);
2888 break;
2889
2890 case HCI_EV_QOS_SETUP_COMPLETE:
2891 hci_qos_setup_complete_evt(hdev, skb);
2892 break;
2893
2894 case HCI_EV_CMD_COMPLETE:
2895 hci_cmd_complete_evt(hdev, skb);
2896 break;
2897
2898 case HCI_EV_CMD_STATUS:
2899 hci_cmd_status_evt(hdev, skb);
2900 break;
2901
2902 case HCI_EV_ROLE_CHANGE:
2903 hci_role_change_evt(hdev, skb);
2904 break;
2905
2906 case HCI_EV_NUM_COMP_PKTS:
2907 hci_num_comp_pkts_evt(hdev, skb);
2908 break;
2909
2910 case HCI_EV_MODE_CHANGE:
2911 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002912 break;
2913
2914 case HCI_EV_PIN_CODE_REQ:
2915 hci_pin_code_request_evt(hdev, skb);
2916 break;
2917
2918 case HCI_EV_LINK_KEY_REQ:
2919 hci_link_key_request_evt(hdev, skb);
2920 break;
2921
2922 case HCI_EV_LINK_KEY_NOTIFY:
2923 hci_link_key_notify_evt(hdev, skb);
2924 break;
2925
2926 case HCI_EV_CLOCK_OFFSET:
2927 hci_clock_offset_evt(hdev, skb);
2928 break;
2929
Marcel Holtmanna8746412008-07-14 20:13:46 +02002930 case HCI_EV_PKT_TYPE_CHANGE:
2931 hci_pkt_type_change_evt(hdev, skb);
2932 break;
2933
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002934 case HCI_EV_PSCAN_REP_MODE:
2935 hci_pscan_rep_mode_evt(hdev, skb);
2936 break;
2937
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002938 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
2939 hci_inquiry_result_with_rssi_evt(hdev, skb);
2940 break;
2941
2942 case HCI_EV_REMOTE_EXT_FEATURES:
2943 hci_remote_ext_features_evt(hdev, skb);
2944 break;
2945
2946 case HCI_EV_SYNC_CONN_COMPLETE:
2947 hci_sync_conn_complete_evt(hdev, skb);
2948 break;
2949
2950 case HCI_EV_SYNC_CONN_CHANGED:
2951 hci_sync_conn_changed_evt(hdev, skb);
2952 break;
2953
Marcel Holtmann04837f62006-07-03 10:02:33 +02002954 case HCI_EV_SNIFF_SUBRATE:
2955 hci_sniff_subrate_evt(hdev, skb);
2956 break;
2957
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002958 case HCI_EV_EXTENDED_INQUIRY_RESULT:
2959 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002960 break;
2961
Marcel Holtmann04936842008-07-14 20:13:48 +02002962 case HCI_EV_IO_CAPA_REQUEST:
2963 hci_io_capa_request_evt(hdev, skb);
2964 break;
2965
Johan Hedberg03b555e2011-01-04 15:40:05 +02002966 case HCI_EV_IO_CAPA_REPLY:
2967 hci_io_capa_reply_evt(hdev, skb);
2968 break;
2969
Johan Hedberga5c29682011-02-19 12:05:57 -03002970 case HCI_EV_USER_CONFIRM_REQUEST:
2971 hci_user_confirm_request_evt(hdev, skb);
2972 break;
2973
Marcel Holtmann04936842008-07-14 20:13:48 +02002974 case HCI_EV_SIMPLE_PAIR_COMPLETE:
2975 hci_simple_pair_complete_evt(hdev, skb);
2976 break;
2977
Marcel Holtmann41a96212008-07-14 20:13:48 +02002978 case HCI_EV_REMOTE_HOST_FEATURES:
2979 hci_remote_host_features_evt(hdev, skb);
2980 break;
2981
Ville Tervofcd89c02011-02-10 22:38:47 -03002982 case HCI_EV_LE_META:
2983 hci_le_meta_evt(hdev, skb);
2984 break;
2985
Szymon Janc2763eda2011-03-22 13:12:22 +01002986 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
2987 hci_remote_oob_data_request_evt(hdev, skb);
2988 break;
2989
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002990 default:
2991 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002992 break;
2993 }
2994
2995 kfree_skb(skb);
2996 hdev->stat.evt_rx++;
2997}
2998
2999/* Generate internal stack event */
3000void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3001{
3002 struct hci_event_hdr *hdr;
3003 struct hci_ev_stack_internal *ev;
3004 struct sk_buff *skb;
3005
3006 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3007 if (!skb)
3008 return;
3009
3010 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3011 hdr->evt = HCI_EV_STACK_INTERNAL;
3012 hdr->plen = sizeof(*ev) + dlen;
3013
3014 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3015 ev->type = type;
3016 memcpy(ev->data, data, dlen);
3017
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003018 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003019 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003020
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003021 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003022 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003023 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003024 kfree_skb(skb);
3025}