blob: 76812243b57154aa7f001fadee339fe439c58379 [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI event handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28
29#include <linux/types.h>
30#include <linux/errno.h>
31#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#include <linux/slab.h>
33#include <linux/poll.h>
34#include <linux/fcntl.h>
35#include <linux/init.h>
36#include <linux/skbuff.h>
37#include <linux/interrupt.h>
38#include <linux/notifier.h>
39#include <net/sock.h>
40
41#include <asm/system.h>
Andrei Emeltchenko70f230202010-12-01 16:58:25 +020042#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070043#include <asm/unaligned.h>
44
45#include <net/bluetooth/bluetooth.h>
46#include <net/bluetooth/hci_core.h>
47
Linus Torvalds1da177e2005-04-16 15:20:36 -070048/* Handle HCI Event packets */
49
Marcel Holtmanna9de9242007-10-20 13:33:56 +020050static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070051{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020052 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
Marcel Holtmanna9de9242007-10-20 13:33:56 +020054 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
Marcel Holtmanna9de9242007-10-20 13:33:56 +020056 if (status)
57 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070058
Johan Hedberg314b2382011-04-27 10:29:57 -040059 if (test_bit(HCI_MGMT, &hdev->flags) &&
60 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
61 mgmt_discovering(hdev->id, 0);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010062
Johan Hedberg23bb5762010-12-21 23:01:27 +020063 hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010064
Marcel Holtmanna9de9242007-10-20 13:33:56 +020065 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070066}
67
Marcel Holtmanna9de9242007-10-20 13:33:56 +020068static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070069{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020070 __u8 status = *((__u8 *) skb->data);
71
72 BT_DBG("%s status 0x%x", hdev->name, status);
73
74 if (status)
75 return;
76
Johan Hedberg314b2382011-04-27 10:29:57 -040077 if (test_bit(HCI_MGMT, &hdev->flags) &&
78 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
79 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020080
81 hci_conn_check_pending(hdev);
82}
83
84static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
85{
86 BT_DBG("%s", hdev->name);
87}
88
89static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
90{
91 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070092 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070093
Marcel Holtmanna9de9242007-10-20 13:33:56 +020094 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Marcel Holtmanna9de9242007-10-20 13:33:56 +020096 if (rp->status)
97 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Marcel Holtmanna9de9242007-10-20 13:33:56 +020099 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200101 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
102 if (conn) {
103 if (rp->role)
104 conn->link_mode &= ~HCI_LM_MASTER;
105 else
106 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200108
109 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110}
111
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200112static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
113{
114 struct hci_rp_read_link_policy *rp = (void *) skb->data;
115 struct hci_conn *conn;
116
117 BT_DBG("%s status 0x%x", hdev->name, rp->status);
118
119 if (rp->status)
120 return;
121
122 hci_dev_lock(hdev);
123
124 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
125 if (conn)
126 conn->link_policy = __le16_to_cpu(rp->policy);
127
128 hci_dev_unlock(hdev);
129}
130
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200131static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200133 struct hci_rp_write_link_policy *rp = (void *) skb->data;
134 struct hci_conn *conn;
135 void *sent;
136
137 BT_DBG("%s status 0x%x", hdev->name, rp->status);
138
139 if (rp->status)
140 return;
141
142 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
143 if (!sent)
144 return;
145
146 hci_dev_lock(hdev);
147
148 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200149 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700150 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200151
152 hci_dev_unlock(hdev);
153}
154
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200155static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
156{
157 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
158
159 BT_DBG("%s status 0x%x", hdev->name, rp->status);
160
161 if (rp->status)
162 return;
163
164 hdev->link_policy = __le16_to_cpu(rp->policy);
165}
166
167static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
168{
169 __u8 status = *((__u8 *) skb->data);
170 void *sent;
171
172 BT_DBG("%s status 0x%x", hdev->name, status);
173
174 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
175 if (!sent)
176 return;
177
178 if (!status)
179 hdev->link_policy = get_unaligned_le16(sent);
180
Johan Hedberg23bb5762010-12-21 23:01:27 +0200181 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200182}
183
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200184static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
185{
186 __u8 status = *((__u8 *) skb->data);
187
188 BT_DBG("%s status 0x%x", hdev->name, status);
189
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300190 clear_bit(HCI_RESET, &hdev->flags);
191
Johan Hedberg23bb5762010-12-21 23:01:27 +0200192 hci_req_complete(hdev, HCI_OP_RESET, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200193}
194
195static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
196{
197 __u8 status = *((__u8 *) skb->data);
198 void *sent;
199
200 BT_DBG("%s status 0x%x", hdev->name, status);
201
202 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
203 if (!sent)
204 return;
205
Johan Hedbergb312b1612011-03-16 14:29:37 +0200206 if (test_bit(HCI_MGMT, &hdev->flags))
207 mgmt_set_local_name_complete(hdev->id, sent, status);
208
209 if (status)
210 return;
211
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200212 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200213}
214
215static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
216{
217 struct hci_rp_read_local_name *rp = (void *) skb->data;
218
219 BT_DBG("%s status 0x%x", hdev->name, rp->status);
220
221 if (rp->status)
222 return;
223
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200224 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200225}
226
227static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
228{
229 __u8 status = *((__u8 *) skb->data);
230 void *sent;
231
232 BT_DBG("%s status 0x%x", hdev->name, status);
233
234 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
235 if (!sent)
236 return;
237
238 if (!status) {
239 __u8 param = *((__u8 *) sent);
240
241 if (param == AUTH_ENABLED)
242 set_bit(HCI_AUTH, &hdev->flags);
243 else
244 clear_bit(HCI_AUTH, &hdev->flags);
245 }
246
Johan Hedberg23bb5762010-12-21 23:01:27 +0200247 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200248}
249
250static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
251{
252 __u8 status = *((__u8 *) skb->data);
253 void *sent;
254
255 BT_DBG("%s status 0x%x", hdev->name, status);
256
257 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
258 if (!sent)
259 return;
260
261 if (!status) {
262 __u8 param = *((__u8 *) sent);
263
264 if (param)
265 set_bit(HCI_ENCRYPT, &hdev->flags);
266 else
267 clear_bit(HCI_ENCRYPT, &hdev->flags);
268 }
269
Johan Hedberg23bb5762010-12-21 23:01:27 +0200270 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200271}
272
273static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
274{
275 __u8 status = *((__u8 *) skb->data);
276 void *sent;
277
278 BT_DBG("%s status 0x%x", hdev->name, status);
279
280 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
281 if (!sent)
282 return;
283
284 if (!status) {
285 __u8 param = *((__u8 *) sent);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200286 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200287
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200288 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
289 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200290
Johan Hedberg73f22f62010-12-29 16:00:25 +0200291 if (param & SCAN_INQUIRY) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200292 set_bit(HCI_ISCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200293 if (!old_iscan)
294 mgmt_discoverable(hdev->id, 1);
295 } else if (old_iscan)
Johan Hedberg73f22f62010-12-29 16:00:25 +0200296 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200297
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200298 if (param & SCAN_PAGE) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200299 set_bit(HCI_PSCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200300 if (!old_pscan)
301 mgmt_connectable(hdev->id, 1);
302 } else if (old_pscan)
303 mgmt_connectable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200304 }
305
Johan Hedberg23bb5762010-12-21 23:01:27 +0200306 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200307}
308
309static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
310{
311 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
312
313 BT_DBG("%s status 0x%x", hdev->name, rp->status);
314
315 if (rp->status)
316 return;
317
318 memcpy(hdev->dev_class, rp->dev_class, 3);
319
320 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
321 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
322}
323
324static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
325{
326 __u8 status = *((__u8 *) skb->data);
327 void *sent;
328
329 BT_DBG("%s status 0x%x", hdev->name, status);
330
Marcel Holtmannf383f272008-07-14 20:13:47 +0200331 if (status)
332 return;
333
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200334 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
335 if (!sent)
336 return;
337
Marcel Holtmannf383f272008-07-14 20:13:47 +0200338 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200339}
340
341static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
342{
343 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200345
346 BT_DBG("%s status 0x%x", hdev->name, rp->status);
347
348 if (rp->status)
349 return;
350
351 setting = __le16_to_cpu(rp->voice_setting);
352
Marcel Holtmannf383f272008-07-14 20:13:47 +0200353 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200354 return;
355
356 hdev->voice_setting = setting;
357
358 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
359
360 if (hdev->notify) {
361 tasklet_disable(&hdev->tx_task);
362 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
363 tasklet_enable(&hdev->tx_task);
364 }
365}
366
367static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
368{
369 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200370 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 void *sent;
372
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200373 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374
Marcel Holtmannf383f272008-07-14 20:13:47 +0200375 if (status)
376 return;
377
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200378 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
379 if (!sent)
380 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381
Marcel Holtmannf383f272008-07-14 20:13:47 +0200382 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383
Marcel Holtmannf383f272008-07-14 20:13:47 +0200384 if (hdev->voice_setting == setting)
385 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386
Marcel Holtmannf383f272008-07-14 20:13:47 +0200387 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Marcel Holtmannf383f272008-07-14 20:13:47 +0200389 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
390
391 if (hdev->notify) {
392 tasklet_disable(&hdev->tx_task);
393 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
394 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 }
396}
397
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200398static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200400 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200402 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Johan Hedberg23bb5762010-12-21 23:01:27 +0200404 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405}
406
Marcel Holtmann333140b2008-07-14 20:13:48 +0200407static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
408{
409 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
410
411 BT_DBG("%s status 0x%x", hdev->name, rp->status);
412
413 if (rp->status)
414 return;
415
416 hdev->ssp_mode = rp->mode;
417}
418
419static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
420{
421 __u8 status = *((__u8 *) skb->data);
422 void *sent;
423
424 BT_DBG("%s status 0x%x", hdev->name, status);
425
426 if (status)
427 return;
428
429 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
430 if (!sent)
431 return;
432
433 hdev->ssp_mode = *((__u8 *) sent);
434}
435
Johan Hedbergd5859e22011-01-25 01:19:58 +0200436static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
437{
438 if (hdev->features[6] & LMP_EXT_INQ)
439 return 2;
440
441 if (hdev->features[3] & LMP_RSSI_INQ)
442 return 1;
443
444 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
445 hdev->lmp_subver == 0x0757)
446 return 1;
447
448 if (hdev->manufacturer == 15) {
449 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
450 return 1;
451 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
452 return 1;
453 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
454 return 1;
455 }
456
457 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
458 hdev->lmp_subver == 0x1805)
459 return 1;
460
461 return 0;
462}
463
464static void hci_setup_inquiry_mode(struct hci_dev *hdev)
465{
466 u8 mode;
467
468 mode = hci_get_inquiry_mode(hdev);
469
470 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
471}
472
473static void hci_setup_event_mask(struct hci_dev *hdev)
474{
475 /* The second byte is 0xff instead of 0x9f (two reserved bits
476 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
477 * command otherwise */
478 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
479
Ville Tervo7f4f0572011-05-27 11:16:21 +0300480 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
481 * any event mask for pre 1.2 devices */
482 if (hdev->lmp_ver <= 1)
483 return;
484
485 events[4] |= 0x01; /* Flow Specification Complete */
486 events[4] |= 0x02; /* Inquiry Result with RSSI */
487 events[4] |= 0x04; /* Read Remote Extended Features Complete */
488 events[5] |= 0x08; /* Synchronous Connection Complete */
489 events[5] |= 0x10; /* Synchronous Connection Changed */
Johan Hedbergd5859e22011-01-25 01:19:58 +0200490
491 if (hdev->features[3] & LMP_RSSI_INQ)
492 events[4] |= 0x04; /* Inquiry Result with RSSI */
493
494 if (hdev->features[5] & LMP_SNIFF_SUBR)
495 events[5] |= 0x20; /* Sniff Subrating */
496
497 if (hdev->features[5] & LMP_PAUSE_ENC)
498 events[5] |= 0x80; /* Encryption Key Refresh Complete */
499
500 if (hdev->features[6] & LMP_EXT_INQ)
501 events[5] |= 0x40; /* Extended Inquiry Result */
502
503 if (hdev->features[6] & LMP_NO_FLUSH)
504 events[7] |= 0x01; /* Enhanced Flush Complete */
505
506 if (hdev->features[7] & LMP_LSTO)
507 events[6] |= 0x80; /* Link Supervision Timeout Changed */
508
509 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
510 events[6] |= 0x01; /* IO Capability Request */
511 events[6] |= 0x02; /* IO Capability Response */
512 events[6] |= 0x04; /* User Confirmation Request */
513 events[6] |= 0x08; /* User Passkey Request */
514 events[6] |= 0x10; /* Remote OOB Data Request */
515 events[6] |= 0x20; /* Simple Pairing Complete */
516 events[7] |= 0x04; /* User Passkey Notification */
517 events[7] |= 0x08; /* Keypress Notification */
518 events[7] |= 0x10; /* Remote Host Supported
519 * Features Notification */
520 }
521
522 if (hdev->features[4] & LMP_LE)
523 events[7] |= 0x20; /* LE Meta-Event */
524
525 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
526}
527
528static void hci_setup(struct hci_dev *hdev)
529{
530 hci_setup_event_mask(hdev);
531
532 if (hdev->lmp_ver > 1)
533 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
534
535 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
536 u8 mode = 0x01;
537 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
538 }
539
540 if (hdev->features[3] & LMP_RSSI_INQ)
541 hci_setup_inquiry_mode(hdev);
542
543 if (hdev->features[7] & LMP_INQ_TX_PWR)
544 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
Andre Guedesd5fa5132011-06-30 19:20:52 -0300545
546 if (hdev->features[7] & LMP_EXTFEATURES) {
547 struct hci_cp_read_local_ext_features cp;
548
549 cp.page = 0x01;
550 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES,
551 sizeof(cp), &cp);
552 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200553}
554
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200555static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
556{
557 struct hci_rp_read_local_version *rp = (void *) skb->data;
558
559 BT_DBG("%s status 0x%x", hdev->name, rp->status);
560
561 if (rp->status)
562 return;
563
564 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200565 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200566 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200567 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200568 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200569
570 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
571 hdev->manufacturer,
572 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200573
574 if (test_bit(HCI_INIT, &hdev->flags))
575 hci_setup(hdev);
576}
577
578static void hci_setup_link_policy(struct hci_dev *hdev)
579{
580 u16 link_policy = 0;
581
582 if (hdev->features[0] & LMP_RSWITCH)
583 link_policy |= HCI_LP_RSWITCH;
584 if (hdev->features[0] & LMP_HOLD)
585 link_policy |= HCI_LP_HOLD;
586 if (hdev->features[0] & LMP_SNIFF)
587 link_policy |= HCI_LP_SNIFF;
588 if (hdev->features[1] & LMP_PARK)
589 link_policy |= HCI_LP_PARK;
590
591 link_policy = cpu_to_le16(link_policy);
592 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
593 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200594}
595
596static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
597{
598 struct hci_rp_read_local_commands *rp = (void *) skb->data;
599
600 BT_DBG("%s status 0x%x", hdev->name, rp->status);
601
602 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200603 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200604
605 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200606
607 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
608 hci_setup_link_policy(hdev);
609
610done:
611 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200612}
613
614static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
615{
616 struct hci_rp_read_local_features *rp = (void *) skb->data;
617
618 BT_DBG("%s status 0x%x", hdev->name, rp->status);
619
620 if (rp->status)
621 return;
622
623 memcpy(hdev->features, rp->features, 8);
624
625 /* Adjust default settings according to features
626 * supported by device. */
627
628 if (hdev->features[0] & LMP_3SLOT)
629 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
630
631 if (hdev->features[0] & LMP_5SLOT)
632 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
633
634 if (hdev->features[1] & LMP_HV2) {
635 hdev->pkt_type |= (HCI_HV2);
636 hdev->esco_type |= (ESCO_HV2);
637 }
638
639 if (hdev->features[1] & LMP_HV3) {
640 hdev->pkt_type |= (HCI_HV3);
641 hdev->esco_type |= (ESCO_HV3);
642 }
643
644 if (hdev->features[3] & LMP_ESCO)
645 hdev->esco_type |= (ESCO_EV3);
646
647 if (hdev->features[4] & LMP_EV4)
648 hdev->esco_type |= (ESCO_EV4);
649
650 if (hdev->features[4] & LMP_EV5)
651 hdev->esco_type |= (ESCO_EV5);
652
Marcel Holtmannefc76882009-02-06 09:13:37 +0100653 if (hdev->features[5] & LMP_EDR_ESCO_2M)
654 hdev->esco_type |= (ESCO_2EV3);
655
656 if (hdev->features[5] & LMP_EDR_ESCO_3M)
657 hdev->esco_type |= (ESCO_3EV3);
658
659 if (hdev->features[5] & LMP_EDR_3S_ESCO)
660 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
661
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200662 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
663 hdev->features[0], hdev->features[1],
664 hdev->features[2], hdev->features[3],
665 hdev->features[4], hdev->features[5],
666 hdev->features[6], hdev->features[7]);
667}
668
Andre Guedesd5fa5132011-06-30 19:20:52 -0300669static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
670 struct sk_buff *skb)
671{
672 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
673
674 BT_DBG("%s status 0x%x", hdev->name, rp->status);
675
676 if (rp->status)
677 return;
678
679 memcpy(hdev->extfeatures, rp->features, 8);
680
681 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
682}
683
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200684static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
685{
686 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
687
688 BT_DBG("%s status 0x%x", hdev->name, rp->status);
689
690 if (rp->status)
691 return;
692
693 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
694 hdev->sco_mtu = rp->sco_mtu;
695 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
696 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
697
698 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
699 hdev->sco_mtu = 64;
700 hdev->sco_pkts = 8;
701 }
702
703 hdev->acl_cnt = hdev->acl_pkts;
704 hdev->sco_cnt = hdev->sco_pkts;
705
706 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
707 hdev->acl_mtu, hdev->acl_pkts,
708 hdev->sco_mtu, hdev->sco_pkts);
709}
710
711static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
712{
713 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
714
715 BT_DBG("%s status 0x%x", hdev->name, rp->status);
716
717 if (!rp->status)
718 bacpy(&hdev->bdaddr, &rp->bdaddr);
719
Johan Hedberg23bb5762010-12-21 23:01:27 +0200720 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
721}
722
723static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
724{
725 __u8 status = *((__u8 *) skb->data);
726
727 BT_DBG("%s status 0x%x", hdev->name, status);
728
729 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200730}
731
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200732static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
733 struct sk_buff *skb)
734{
735 __u8 status = *((__u8 *) skb->data);
736
737 BT_DBG("%s status 0x%x", hdev->name, status);
738
739 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
740}
741
Johan Hedbergd5859e22011-01-25 01:19:58 +0200742static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
743{
744 __u8 status = *((__u8 *) skb->data);
745
746 BT_DBG("%s status 0x%x", hdev->name, status);
747
748 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
749}
750
751static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
752 struct sk_buff *skb)
753{
754 __u8 status = *((__u8 *) skb->data);
755
756 BT_DBG("%s status 0x%x", hdev->name, status);
757
758 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
759}
760
761static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
762 struct sk_buff *skb)
763{
764 __u8 status = *((__u8 *) skb->data);
765
766 BT_DBG("%s status 0x%x", hdev->name, status);
767
768 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
769}
770
771static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
772{
773 __u8 status = *((__u8 *) skb->data);
774
775 BT_DBG("%s status 0x%x", hdev->name, status);
776
777 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
778}
779
Johan Hedberg980e1a52011-01-22 06:10:07 +0200780static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
781{
782 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
783 struct hci_cp_pin_code_reply *cp;
784 struct hci_conn *conn;
785
786 BT_DBG("%s status 0x%x", hdev->name, rp->status);
787
788 if (test_bit(HCI_MGMT, &hdev->flags))
789 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
790
791 if (rp->status != 0)
792 return;
793
794 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
795 if (!cp)
796 return;
797
798 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
799 if (conn)
800 conn->pin_length = cp->pin_len;
801}
802
803static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
804{
805 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
806
807 BT_DBG("%s status 0x%x", hdev->name, rp->status);
808
809 if (test_bit(HCI_MGMT, &hdev->flags))
810 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
811 rp->status);
812}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300813static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
814 struct sk_buff *skb)
815{
816 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
817
818 BT_DBG("%s status 0x%x", hdev->name, rp->status);
819
820 if (rp->status)
821 return;
822
823 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
824 hdev->le_pkts = rp->le_max_pkt;
825
826 hdev->le_cnt = hdev->le_pkts;
827
828 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
829
830 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
831}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200832
Johan Hedberga5c29682011-02-19 12:05:57 -0300833static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
834{
835 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
836
837 BT_DBG("%s status 0x%x", hdev->name, rp->status);
838
839 if (test_bit(HCI_MGMT, &hdev->flags))
840 mgmt_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
841 rp->status);
842}
843
844static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
845 struct sk_buff *skb)
846{
847 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
848
849 BT_DBG("%s status 0x%x", hdev->name, rp->status);
850
851 if (test_bit(HCI_MGMT, &hdev->flags))
852 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
853 rp->status);
854}
855
Szymon Jancc35938b2011-03-22 13:12:21 +0100856static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
857 struct sk_buff *skb)
858{
859 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
860
861 BT_DBG("%s status 0x%x", hdev->name, rp->status);
862
863 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
864 rp->randomizer, rp->status);
865}
866
Andre Guedes726e1332011-05-26 16:23:52 -0300867static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
868 struct sk_buff *skb)
869{
870 struct hci_cp_le_set_scan_enable *cp;
871 __u8 status = *((__u8 *) skb->data);
872
873 BT_DBG("%s status 0x%x", hdev->name, status);
874
875 if (status)
876 return;
877
878 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
879 if (!cp)
880 return;
881
882 hci_dev_lock(hdev);
883
Andre Guedes45e600f2011-05-26 16:23:53 -0300884 if (cp->enable == 0x01) {
885 del_timer(&hdev->adv_timer);
Andre Guedes726e1332011-05-26 16:23:52 -0300886 hci_adv_entries_clear(hdev);
Andre Guedes45e600f2011-05-26 16:23:53 -0300887 } else if (cp->enable == 0x00) {
888 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
889 }
Andre Guedes726e1332011-05-26 16:23:52 -0300890
891 hci_dev_unlock(hdev);
892}
893
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -0300894static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
895{
896 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
897
898 BT_DBG("%s status 0x%x", hdev->name, rp->status);
899
900 if (rp->status)
901 return;
902
903 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
904}
905
906static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
907{
908 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
909
910 BT_DBG("%s status 0x%x", hdev->name, rp->status);
911
912 if (rp->status)
913 return;
914
915 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
916}
917
Andre Guedese326af42011-06-30 19:20:53 -0300918static inline void hci_cc_write_le_host_supported(struct hci_dev *hdev,
919 struct sk_buff *skb)
920{
921 struct hci_cp_read_local_ext_features cp;
922 __u8 status = *((__u8 *) skb->data);
923
924 BT_DBG("%s status 0x%x", hdev->name, status);
925
926 if (status)
927 return;
928
929 cp.page = 0x01;
930 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp), &cp);
931}
932
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200933static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
934{
935 BT_DBG("%s status 0x%x", hdev->name, status);
936
937 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +0200938 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200939 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -0400940 return;
941 }
942
943 if (test_bit(HCI_MGMT, &hdev->flags) &&
944 !test_and_set_bit(HCI_INQUIRY,
945 &hdev->flags))
946 mgmt_discovering(hdev->id, 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200947}
948
Linus Torvalds1da177e2005-04-16 15:20:36 -0700949static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
950{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200951 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200954 BT_DBG("%s status 0x%x", hdev->name, status);
955
956 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700957 if (!cp)
958 return;
959
960 hci_dev_lock(hdev);
961
962 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
963
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200964 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965
966 if (status) {
967 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200968 if (status != 0x0c || conn->attempt > 2) {
969 conn->state = BT_CLOSED;
970 hci_proto_connect_cfm(conn, status);
971 hci_conn_del(conn);
972 } else
973 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974 }
975 } else {
976 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -0800977 conn = hci_conn_add(hdev, ACL_LINK, 0, &cp->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978 if (conn) {
979 conn->out = 1;
980 conn->link_mode |= HCI_LM_MASTER;
981 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -0300982 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 }
984 }
985
986 hci_dev_unlock(hdev);
987}
988
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200989static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700990{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200991 struct hci_cp_add_sco *cp;
992 struct hci_conn *acl, *sco;
993 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200995 BT_DBG("%s status 0x%x", hdev->name, status);
996
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200997 if (!status)
998 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001000 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1001 if (!cp)
1002 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001003
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001004 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001006 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001007
1008 hci_dev_lock(hdev);
1009
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001010 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001011 if (acl) {
1012 sco = acl->link;
1013 if (sco) {
1014 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001015
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001016 hci_proto_connect_cfm(sco, status);
1017 hci_conn_del(sco);
1018 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001019 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001020
1021 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001022}
1023
Marcel Holtmannf8558552008-07-14 20:13:49 +02001024static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1025{
1026 struct hci_cp_auth_requested *cp;
1027 struct hci_conn *conn;
1028
1029 BT_DBG("%s status 0x%x", hdev->name, status);
1030
1031 if (!status)
1032 return;
1033
1034 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1035 if (!cp)
1036 return;
1037
1038 hci_dev_lock(hdev);
1039
1040 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1041 if (conn) {
1042 if (conn->state == BT_CONFIG) {
1043 hci_proto_connect_cfm(conn, status);
1044 hci_conn_put(conn);
1045 }
1046 }
1047
1048 hci_dev_unlock(hdev);
1049}
1050
1051static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1052{
1053 struct hci_cp_set_conn_encrypt *cp;
1054 struct hci_conn *conn;
1055
1056 BT_DBG("%s status 0x%x", hdev->name, status);
1057
1058 if (!status)
1059 return;
1060
1061 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1062 if (!cp)
1063 return;
1064
1065 hci_dev_lock(hdev);
1066
1067 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1068 if (conn) {
1069 if (conn->state == BT_CONFIG) {
1070 hci_proto_connect_cfm(conn, status);
1071 hci_conn_put(conn);
1072 }
1073 }
1074
1075 hci_dev_unlock(hdev);
1076}
1077
Johan Hedberg127178d2010-11-18 22:22:29 +02001078static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001079 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001080{
Johan Hedberg392599b2010-11-18 22:22:28 +02001081 if (conn->state != BT_CONFIG || !conn->out)
1082 return 0;
1083
Johan Hedberg765c2a92011-01-19 12:06:52 +05301084 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001085 return 0;
1086
1087 /* Only request authentication for SSP connections or non-SSP
1088 * devices with sec_level HIGH */
1089 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Johan Hedberg765c2a92011-01-19 12:06:52 +05301090 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001091 return 0;
1092
Johan Hedberg392599b2010-11-18 22:22:28 +02001093 return 1;
1094}
1095
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001096static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1097{
Johan Hedberg127178d2010-11-18 22:22:29 +02001098 struct hci_cp_remote_name_req *cp;
1099 struct hci_conn *conn;
1100
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001101 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001102
1103 /* If successful wait for the name req complete event before
1104 * checking for the need to do authentication */
1105 if (!status)
1106 return;
1107
1108 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1109 if (!cp)
1110 return;
1111
1112 hci_dev_lock(hdev);
1113
1114 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001115 if (!conn)
1116 goto unlock;
1117
1118 if (!hci_outgoing_auth_needed(hdev, conn))
1119 goto unlock;
1120
1121 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001122 struct hci_cp_auth_requested cp;
1123 cp.handle = __cpu_to_le16(conn->handle);
1124 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1125 }
1126
Johan Hedberg79c6c702011-04-28 11:28:55 -07001127unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001128 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001129}
1130
Marcel Holtmann769be972008-07-14 20:13:49 +02001131static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1132{
1133 struct hci_cp_read_remote_features *cp;
1134 struct hci_conn *conn;
1135
1136 BT_DBG("%s status 0x%x", hdev->name, status);
1137
1138 if (!status)
1139 return;
1140
1141 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1142 if (!cp)
1143 return;
1144
1145 hci_dev_lock(hdev);
1146
1147 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1148 if (conn) {
1149 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001150 hci_proto_connect_cfm(conn, status);
1151 hci_conn_put(conn);
1152 }
1153 }
1154
1155 hci_dev_unlock(hdev);
1156}
1157
1158static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1159{
1160 struct hci_cp_read_remote_ext_features *cp;
1161 struct hci_conn *conn;
1162
1163 BT_DBG("%s status 0x%x", hdev->name, status);
1164
1165 if (!status)
1166 return;
1167
1168 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1169 if (!cp)
1170 return;
1171
1172 hci_dev_lock(hdev);
1173
1174 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1175 if (conn) {
1176 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001177 hci_proto_connect_cfm(conn, status);
1178 hci_conn_put(conn);
1179 }
1180 }
1181
1182 hci_dev_unlock(hdev);
1183}
1184
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001185static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1186{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001187 struct hci_cp_setup_sync_conn *cp;
1188 struct hci_conn *acl, *sco;
1189 __u16 handle;
1190
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001191 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001192
1193 if (!status)
1194 return;
1195
1196 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1197 if (!cp)
1198 return;
1199
1200 handle = __le16_to_cpu(cp->handle);
1201
1202 BT_DBG("%s handle %d", hdev->name, handle);
1203
1204 hci_dev_lock(hdev);
1205
1206 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001207 if (acl) {
1208 sco = acl->link;
1209 if (sco) {
1210 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001211
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001212 hci_proto_connect_cfm(sco, status);
1213 hci_conn_del(sco);
1214 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001215 }
1216
1217 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001218}
1219
1220static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1221{
1222 struct hci_cp_sniff_mode *cp;
1223 struct hci_conn *conn;
1224
1225 BT_DBG("%s status 0x%x", hdev->name, status);
1226
1227 if (!status)
1228 return;
1229
1230 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1231 if (!cp)
1232 return;
1233
1234 hci_dev_lock(hdev);
1235
1236 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001237 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001238 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1239
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001240 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1241 hci_sco_setup(conn, status);
1242 }
1243
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001244 hci_dev_unlock(hdev);
1245}
1246
1247static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1248{
1249 struct hci_cp_exit_sniff_mode *cp;
1250 struct hci_conn *conn;
1251
1252 BT_DBG("%s status 0x%x", hdev->name, status);
1253
1254 if (!status)
1255 return;
1256
1257 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1258 if (!cp)
1259 return;
1260
1261 hci_dev_lock(hdev);
1262
1263 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001264 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001265 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1266
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001267 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1268 hci_sco_setup(conn, status);
1269 }
1270
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001271 hci_dev_unlock(hdev);
1272}
1273
Ville Tervofcd89c02011-02-10 22:38:47 -03001274static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1275{
1276 struct hci_cp_le_create_conn *cp;
1277 struct hci_conn *conn;
1278
1279 BT_DBG("%s status 0x%x", hdev->name, status);
1280
1281 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1282 if (!cp)
1283 return;
1284
1285 hci_dev_lock(hdev);
1286
1287 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1288
1289 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1290 conn);
1291
1292 if (status) {
1293 if (conn && conn->state == BT_CONNECT) {
1294 conn->state = BT_CLOSED;
1295 hci_proto_connect_cfm(conn, status);
1296 hci_conn_del(conn);
1297 }
1298 } else {
1299 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001300 conn = hci_conn_add(hdev, LE_LINK, 0, &cp->peer_addr);
Andre Guedes149c0972011-05-31 14:20:54 -03001301 if (conn) {
1302 conn->dst_type = cp->peer_addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03001303 conn->out = 1;
Andre Guedes149c0972011-05-31 14:20:54 -03001304 } else {
Ville Tervofcd89c02011-02-10 22:38:47 -03001305 BT_ERR("No memory for new connection");
Andre Guedes149c0972011-05-31 14:20:54 -03001306 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001307 }
1308 }
1309
1310 hci_dev_unlock(hdev);
1311}
1312
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001313static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1314{
1315 BT_DBG("%s status 0x%x", hdev->name, status);
1316}
1317
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001318static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1319{
1320 __u8 status = *((__u8 *) skb->data);
1321
1322 BT_DBG("%s status %d", hdev->name, status);
1323
Johan Hedberg314b2382011-04-27 10:29:57 -04001324 if (test_bit(HCI_MGMT, &hdev->flags) &&
1325 test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1326 mgmt_discovering(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001327
Johan Hedberg23bb5762010-12-21 23:01:27 +02001328 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001329
1330 hci_conn_check_pending(hdev);
1331}
1332
Linus Torvalds1da177e2005-04-16 15:20:36 -07001333static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1334{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001335 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001336 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337 int num_rsp = *((__u8 *) skb->data);
1338
1339 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1340
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001341 if (!num_rsp)
1342 return;
1343
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001345
Johan Hedberg314b2382011-04-27 10:29:57 -04001346 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
1347
1348 if (test_bit(HCI_MGMT, &hdev->flags))
1349 mgmt_discovering(hdev->id, 1);
1350 }
1351
Johan Hedberge17acd42011-03-30 23:57:16 +03001352 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001353 bacpy(&data.bdaddr, &info->bdaddr);
1354 data.pscan_rep_mode = info->pscan_rep_mode;
1355 data.pscan_period_mode = info->pscan_period_mode;
1356 data.pscan_mode = info->pscan_mode;
1357 memcpy(data.dev_class, info->dev_class, 3);
1358 data.clock_offset = info->clock_offset;
1359 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001360 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001361 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03001362 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class, 0,
1363 NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001364 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001365
Linus Torvalds1da177e2005-04-16 15:20:36 -07001366 hci_dev_unlock(hdev);
1367}
1368
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001369static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001370{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001371 struct hci_ev_conn_complete *ev = (void *) skb->data;
1372 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001373
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001374 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001375
Linus Torvalds1da177e2005-04-16 15:20:36 -07001376 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001377
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001378 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001379 if (!conn) {
1380 if (ev->link_type != SCO_LINK)
1381 goto unlock;
1382
1383 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1384 if (!conn)
1385 goto unlock;
1386
1387 conn->type = SCO_LINK;
1388 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001389
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001390 if (!ev->status) {
1391 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001392
1393 if (conn->type == ACL_LINK) {
1394 conn->state = BT_CONFIG;
1395 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001396 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedbergf7520542011-01-20 12:34:39 +02001397 mgmt_connected(hdev->id, &ev->bdaddr);
Marcel Holtmann769be972008-07-14 20:13:49 +02001398 } else
1399 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001400
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001401 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001402 hci_conn_add_sysfs(conn);
1403
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001404 if (test_bit(HCI_AUTH, &hdev->flags))
1405 conn->link_mode |= HCI_LM_AUTH;
1406
1407 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1408 conn->link_mode |= HCI_LM_ENCRYPT;
1409
1410 /* Get remote features */
1411 if (conn->type == ACL_LINK) {
1412 struct hci_cp_read_remote_features cp;
1413 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001414 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1415 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001416 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001417
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001418 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001419 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001420 struct hci_cp_change_conn_ptype cp;
1421 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001422 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1423 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1424 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001425 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001426 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001427 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001428 if (conn->type == ACL_LINK)
1429 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1430 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001431
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001432 if (conn->type == ACL_LINK)
1433 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001434
Marcel Holtmann769be972008-07-14 20:13:49 +02001435 if (ev->status) {
1436 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001437 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001438 } else if (ev->link_type != ACL_LINK)
1439 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001440
1441unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001443
1444 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001445}
1446
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1448{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001449 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450 int mask = hdev->link_mode;
1451
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001452 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1453 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454
1455 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1456
Szymon Janc138d22e2011-02-17 16:44:23 +01001457 if ((mask & HCI_LM_ACCEPT) &&
1458 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001459 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001460 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001462
1463 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001464
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001465 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1466 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001467 memcpy(ie->data.dev_class, ev->dev_class, 3);
1468
Linus Torvalds1da177e2005-04-16 15:20:36 -07001469 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1470 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001471 /* pkt_type not yet used for incoming connections */
1472 conn = hci_conn_add(hdev, ev->link_type, 0, &ev->bdaddr);
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001473 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001474 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001475 hci_dev_unlock(hdev);
1476 return;
1477 }
1478 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001479
Linus Torvalds1da177e2005-04-16 15:20:36 -07001480 memcpy(conn->dev_class, ev->dev_class, 3);
1481 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001482
Linus Torvalds1da177e2005-04-16 15:20:36 -07001483 hci_dev_unlock(hdev);
1484
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001485 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1486 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001487
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001488 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001490 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1491 cp.role = 0x00; /* Become master */
1492 else
1493 cp.role = 0x01; /* Remain slave */
1494
1495 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1496 sizeof(cp), &cp);
1497 } else {
1498 struct hci_cp_accept_sync_conn_req cp;
1499
1500 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001501 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001502
1503 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1504 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1505 cp.max_latency = cpu_to_le16(0xffff);
1506 cp.content_format = cpu_to_le16(hdev->voice_setting);
1507 cp.retrans_effort = 0xff;
1508
1509 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1510 sizeof(cp), &cp);
1511 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001512 } else {
1513 /* Connection rejected */
1514 struct hci_cp_reject_conn_req cp;
1515
1516 bacpy(&cp.bdaddr, &ev->bdaddr);
1517 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001518 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001519 }
1520}
1521
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1523{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001524 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001525 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001526
1527 BT_DBG("%s status %d", hdev->name, ev->status);
1528
Johan Hedberg8962ee72011-01-20 12:40:27 +02001529 if (ev->status) {
1530 mgmt_disconnect_failed(hdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001531 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001532 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001533
1534 hci_dev_lock(hdev);
1535
Marcel Holtmann04837f62006-07-03 10:02:33 +02001536 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001537 if (!conn)
1538 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001539
Johan Hedbergf7520542011-01-20 12:34:39 +02001540 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001541
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03001542 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedbergf7520542011-01-20 12:34:39 +02001543 mgmt_disconnected(hdev->id, &conn->dst);
1544
1545 hci_proto_disconn_cfm(conn, ev->reason);
1546 hci_conn_del(conn);
1547
1548unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549 hci_dev_unlock(hdev);
1550}
1551
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001552static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1553{
1554 struct hci_ev_auth_complete *ev = (void *) skb->data;
1555 struct hci_conn *conn;
1556
1557 BT_DBG("%s status %d", hdev->name, ev->status);
1558
1559 hci_dev_lock(hdev);
1560
1561 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001562 if (!conn)
1563 goto unlock;
1564
1565 if (!ev->status) {
1566 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1567 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1568 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001569 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001570 conn->link_mode |= HCI_LM_AUTH;
1571 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001572 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001573 } else {
1574 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1575 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001576
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001577 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1578 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001579
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001580 if (conn->state == BT_CONFIG) {
1581 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1582 struct hci_cp_set_conn_encrypt cp;
1583 cp.handle = ev->handle;
1584 cp.encrypt = 0x01;
1585 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1586 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001587 } else {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001588 conn->state = BT_CONNECTED;
1589 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001590 hci_conn_put(conn);
1591 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001592 } else {
1593 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001594
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001595 hci_conn_hold(conn);
1596 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1597 hci_conn_put(conn);
1598 }
1599
1600 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1601 if (!ev->status) {
1602 struct hci_cp_set_conn_encrypt cp;
1603 cp.handle = ev->handle;
1604 cp.encrypt = 0x01;
1605 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1606 &cp);
1607 } else {
1608 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1609 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001610 }
1611 }
1612
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001613unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001614 hci_dev_unlock(hdev);
1615}
1616
1617static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1618{
Johan Hedberg127178d2010-11-18 22:22:29 +02001619 struct hci_ev_remote_name *ev = (void *) skb->data;
1620 struct hci_conn *conn;
1621
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001622 BT_DBG("%s", hdev->name);
1623
1624 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001625
1626 hci_dev_lock(hdev);
1627
Johan Hedberga88a9652011-03-30 13:18:12 +03001628 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
1629 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->name);
1630
Johan Hedberg127178d2010-11-18 22:22:29 +02001631 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg79c6c702011-04-28 11:28:55 -07001632 if (!conn)
1633 goto unlock;
1634
1635 if (!hci_outgoing_auth_needed(hdev, conn))
1636 goto unlock;
1637
1638 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001639 struct hci_cp_auth_requested cp;
1640 cp.handle = __cpu_to_le16(conn->handle);
1641 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1642 }
1643
Johan Hedberg79c6c702011-04-28 11:28:55 -07001644unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001645 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001646}
1647
1648static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1649{
1650 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1651 struct hci_conn *conn;
1652
1653 BT_DBG("%s status %d", hdev->name, ev->status);
1654
1655 hci_dev_lock(hdev);
1656
1657 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1658 if (conn) {
1659 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001660 if (ev->encrypt) {
1661 /* Encryption implies authentication */
1662 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001663 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomes64532ec2011-06-09 18:50:53 -03001664 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001665 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001666 conn->link_mode &= ~HCI_LM_ENCRYPT;
1667 }
1668
1669 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1670
Marcel Holtmannf8558552008-07-14 20:13:49 +02001671 if (conn->state == BT_CONFIG) {
1672 if (!ev->status)
1673 conn->state = BT_CONNECTED;
1674
1675 hci_proto_connect_cfm(conn, ev->status);
1676 hci_conn_put(conn);
1677 } else
1678 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001679 }
1680
1681 hci_dev_unlock(hdev);
1682}
1683
1684static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1685{
1686 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1687 struct hci_conn *conn;
1688
1689 BT_DBG("%s status %d", hdev->name, ev->status);
1690
1691 hci_dev_lock(hdev);
1692
1693 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1694 if (conn) {
1695 if (!ev->status)
1696 conn->link_mode |= HCI_LM_SECURE;
1697
1698 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1699
1700 hci_key_change_cfm(conn, ev->status);
1701 }
1702
1703 hci_dev_unlock(hdev);
1704}
1705
1706static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1707{
1708 struct hci_ev_remote_features *ev = (void *) skb->data;
1709 struct hci_conn *conn;
1710
1711 BT_DBG("%s status %d", hdev->name, ev->status);
1712
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001713 hci_dev_lock(hdev);
1714
1715 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02001716 if (!conn)
1717 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02001718
Johan Hedbergccd556f2010-11-10 17:11:51 +02001719 if (!ev->status)
1720 memcpy(conn->features, ev->features, 8);
1721
1722 if (conn->state != BT_CONFIG)
1723 goto unlock;
1724
1725 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1726 struct hci_cp_read_remote_ext_features cp;
1727 cp.handle = ev->handle;
1728 cp.page = 0x01;
1729 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02001730 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02001731 goto unlock;
1732 }
1733
Johan Hedberg127178d2010-11-18 22:22:29 +02001734 if (!ev->status) {
1735 struct hci_cp_remote_name_req cp;
1736 memset(&cp, 0, sizeof(cp));
1737 bacpy(&cp.bdaddr, &conn->dst);
1738 cp.pscan_rep_mode = 0x02;
1739 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1740 }
Johan Hedberg392599b2010-11-18 22:22:28 +02001741
Johan Hedberg127178d2010-11-18 22:22:29 +02001742 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02001743 conn->state = BT_CONNECTED;
1744 hci_proto_connect_cfm(conn, ev->status);
1745 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001746 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001747
Johan Hedbergccd556f2010-11-10 17:11:51 +02001748unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001749 hci_dev_unlock(hdev);
1750}
1751
1752static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1753{
1754 BT_DBG("%s", hdev->name);
1755}
1756
1757static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1758{
1759 BT_DBG("%s", hdev->name);
1760}
1761
1762static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1763{
1764 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1765 __u16 opcode;
1766
1767 skb_pull(skb, sizeof(*ev));
1768
1769 opcode = __le16_to_cpu(ev->opcode);
1770
1771 switch (opcode) {
1772 case HCI_OP_INQUIRY_CANCEL:
1773 hci_cc_inquiry_cancel(hdev, skb);
1774 break;
1775
1776 case HCI_OP_EXIT_PERIODIC_INQ:
1777 hci_cc_exit_periodic_inq(hdev, skb);
1778 break;
1779
1780 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1781 hci_cc_remote_name_req_cancel(hdev, skb);
1782 break;
1783
1784 case HCI_OP_ROLE_DISCOVERY:
1785 hci_cc_role_discovery(hdev, skb);
1786 break;
1787
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001788 case HCI_OP_READ_LINK_POLICY:
1789 hci_cc_read_link_policy(hdev, skb);
1790 break;
1791
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001792 case HCI_OP_WRITE_LINK_POLICY:
1793 hci_cc_write_link_policy(hdev, skb);
1794 break;
1795
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02001796 case HCI_OP_READ_DEF_LINK_POLICY:
1797 hci_cc_read_def_link_policy(hdev, skb);
1798 break;
1799
1800 case HCI_OP_WRITE_DEF_LINK_POLICY:
1801 hci_cc_write_def_link_policy(hdev, skb);
1802 break;
1803
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001804 case HCI_OP_RESET:
1805 hci_cc_reset(hdev, skb);
1806 break;
1807
1808 case HCI_OP_WRITE_LOCAL_NAME:
1809 hci_cc_write_local_name(hdev, skb);
1810 break;
1811
1812 case HCI_OP_READ_LOCAL_NAME:
1813 hci_cc_read_local_name(hdev, skb);
1814 break;
1815
1816 case HCI_OP_WRITE_AUTH_ENABLE:
1817 hci_cc_write_auth_enable(hdev, skb);
1818 break;
1819
1820 case HCI_OP_WRITE_ENCRYPT_MODE:
1821 hci_cc_write_encrypt_mode(hdev, skb);
1822 break;
1823
1824 case HCI_OP_WRITE_SCAN_ENABLE:
1825 hci_cc_write_scan_enable(hdev, skb);
1826 break;
1827
1828 case HCI_OP_READ_CLASS_OF_DEV:
1829 hci_cc_read_class_of_dev(hdev, skb);
1830 break;
1831
1832 case HCI_OP_WRITE_CLASS_OF_DEV:
1833 hci_cc_write_class_of_dev(hdev, skb);
1834 break;
1835
1836 case HCI_OP_READ_VOICE_SETTING:
1837 hci_cc_read_voice_setting(hdev, skb);
1838 break;
1839
1840 case HCI_OP_WRITE_VOICE_SETTING:
1841 hci_cc_write_voice_setting(hdev, skb);
1842 break;
1843
1844 case HCI_OP_HOST_BUFFER_SIZE:
1845 hci_cc_host_buffer_size(hdev, skb);
1846 break;
1847
Marcel Holtmann333140b2008-07-14 20:13:48 +02001848 case HCI_OP_READ_SSP_MODE:
1849 hci_cc_read_ssp_mode(hdev, skb);
1850 break;
1851
1852 case HCI_OP_WRITE_SSP_MODE:
1853 hci_cc_write_ssp_mode(hdev, skb);
1854 break;
1855
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001856 case HCI_OP_READ_LOCAL_VERSION:
1857 hci_cc_read_local_version(hdev, skb);
1858 break;
1859
1860 case HCI_OP_READ_LOCAL_COMMANDS:
1861 hci_cc_read_local_commands(hdev, skb);
1862 break;
1863
1864 case HCI_OP_READ_LOCAL_FEATURES:
1865 hci_cc_read_local_features(hdev, skb);
1866 break;
1867
Andre Guedesd5fa5132011-06-30 19:20:52 -03001868 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1869 hci_cc_read_local_ext_features(hdev, skb);
1870 break;
1871
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001872 case HCI_OP_READ_BUFFER_SIZE:
1873 hci_cc_read_buffer_size(hdev, skb);
1874 break;
1875
1876 case HCI_OP_READ_BD_ADDR:
1877 hci_cc_read_bd_addr(hdev, skb);
1878 break;
1879
Johan Hedberg23bb5762010-12-21 23:01:27 +02001880 case HCI_OP_WRITE_CA_TIMEOUT:
1881 hci_cc_write_ca_timeout(hdev, skb);
1882 break;
1883
Johan Hedbergb0916ea2011-01-10 13:44:55 +02001884 case HCI_OP_DELETE_STORED_LINK_KEY:
1885 hci_cc_delete_stored_link_key(hdev, skb);
1886 break;
1887
Johan Hedbergd5859e22011-01-25 01:19:58 +02001888 case HCI_OP_SET_EVENT_MASK:
1889 hci_cc_set_event_mask(hdev, skb);
1890 break;
1891
1892 case HCI_OP_WRITE_INQUIRY_MODE:
1893 hci_cc_write_inquiry_mode(hdev, skb);
1894 break;
1895
1896 case HCI_OP_READ_INQ_RSP_TX_POWER:
1897 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1898 break;
1899
1900 case HCI_OP_SET_EVENT_FLT:
1901 hci_cc_set_event_flt(hdev, skb);
1902 break;
1903
Johan Hedberg980e1a52011-01-22 06:10:07 +02001904 case HCI_OP_PIN_CODE_REPLY:
1905 hci_cc_pin_code_reply(hdev, skb);
1906 break;
1907
1908 case HCI_OP_PIN_CODE_NEG_REPLY:
1909 hci_cc_pin_code_neg_reply(hdev, skb);
1910 break;
1911
Szymon Jancc35938b2011-03-22 13:12:21 +01001912 case HCI_OP_READ_LOCAL_OOB_DATA:
1913 hci_cc_read_local_oob_data_reply(hdev, skb);
1914 break;
1915
Ville Tervo6ed58ec2011-02-10 22:38:48 -03001916 case HCI_OP_LE_READ_BUFFER_SIZE:
1917 hci_cc_le_read_buffer_size(hdev, skb);
1918 break;
1919
Johan Hedberga5c29682011-02-19 12:05:57 -03001920 case HCI_OP_USER_CONFIRM_REPLY:
1921 hci_cc_user_confirm_reply(hdev, skb);
1922 break;
1923
1924 case HCI_OP_USER_CONFIRM_NEG_REPLY:
1925 hci_cc_user_confirm_neg_reply(hdev, skb);
1926 break;
1927
Andre Guedes726e1332011-05-26 16:23:52 -03001928 case HCI_OP_LE_SET_SCAN_ENABLE:
1929 hci_cc_le_set_scan_enable(hdev, skb);
1930 break;
1931
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001932 case HCI_OP_LE_LTK_REPLY:
1933 hci_cc_le_ltk_reply(hdev, skb);
1934 break;
1935
1936 case HCI_OP_LE_LTK_NEG_REPLY:
1937 hci_cc_le_ltk_neg_reply(hdev, skb);
1938 break;
1939
Andre Guedese326af42011-06-30 19:20:53 -03001940 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
1941 hci_cc_write_le_host_supported(hdev, skb);
1942 break;
1943
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001944 default:
1945 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1946 break;
1947 }
1948
Ville Tervo6bd32322011-02-16 16:32:41 +02001949 if (ev->opcode != HCI_OP_NOP)
1950 del_timer(&hdev->cmd_timer);
1951
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001952 if (ev->ncmd) {
1953 atomic_set(&hdev->cmd_cnt, 1);
1954 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01001955 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001956 }
1957}
1958
1959static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1960{
1961 struct hci_ev_cmd_status *ev = (void *) skb->data;
1962 __u16 opcode;
1963
1964 skb_pull(skb, sizeof(*ev));
1965
1966 opcode = __le16_to_cpu(ev->opcode);
1967
1968 switch (opcode) {
1969 case HCI_OP_INQUIRY:
1970 hci_cs_inquiry(hdev, ev->status);
1971 break;
1972
1973 case HCI_OP_CREATE_CONN:
1974 hci_cs_create_conn(hdev, ev->status);
1975 break;
1976
1977 case HCI_OP_ADD_SCO:
1978 hci_cs_add_sco(hdev, ev->status);
1979 break;
1980
Marcel Holtmannf8558552008-07-14 20:13:49 +02001981 case HCI_OP_AUTH_REQUESTED:
1982 hci_cs_auth_requested(hdev, ev->status);
1983 break;
1984
1985 case HCI_OP_SET_CONN_ENCRYPT:
1986 hci_cs_set_conn_encrypt(hdev, ev->status);
1987 break;
1988
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001989 case HCI_OP_REMOTE_NAME_REQ:
1990 hci_cs_remote_name_req(hdev, ev->status);
1991 break;
1992
Marcel Holtmann769be972008-07-14 20:13:49 +02001993 case HCI_OP_READ_REMOTE_FEATURES:
1994 hci_cs_read_remote_features(hdev, ev->status);
1995 break;
1996
1997 case HCI_OP_READ_REMOTE_EXT_FEATURES:
1998 hci_cs_read_remote_ext_features(hdev, ev->status);
1999 break;
2000
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002001 case HCI_OP_SETUP_SYNC_CONN:
2002 hci_cs_setup_sync_conn(hdev, ev->status);
2003 break;
2004
2005 case HCI_OP_SNIFF_MODE:
2006 hci_cs_sniff_mode(hdev, ev->status);
2007 break;
2008
2009 case HCI_OP_EXIT_SNIFF_MODE:
2010 hci_cs_exit_sniff_mode(hdev, ev->status);
2011 break;
2012
Johan Hedberg8962ee72011-01-20 12:40:27 +02002013 case HCI_OP_DISCONNECT:
2014 if (ev->status != 0)
2015 mgmt_disconnect_failed(hdev->id);
2016 break;
2017
Ville Tervofcd89c02011-02-10 22:38:47 -03002018 case HCI_OP_LE_CREATE_CONN:
2019 hci_cs_le_create_conn(hdev, ev->status);
2020 break;
2021
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002022 case HCI_OP_LE_START_ENC:
2023 hci_cs_le_start_enc(hdev, ev->status);
2024 break;
2025
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002026 default:
2027 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2028 break;
2029 }
2030
Ville Tervo6bd32322011-02-16 16:32:41 +02002031 if (ev->opcode != HCI_OP_NOP)
2032 del_timer(&hdev->cmd_timer);
2033
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002034 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002035 atomic_set(&hdev->cmd_cnt, 1);
2036 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002037 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002038 }
2039}
2040
2041static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2042{
2043 struct hci_ev_role_change *ev = (void *) skb->data;
2044 struct hci_conn *conn;
2045
2046 BT_DBG("%s status %d", hdev->name, ev->status);
2047
2048 hci_dev_lock(hdev);
2049
2050 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2051 if (conn) {
2052 if (!ev->status) {
2053 if (ev->role)
2054 conn->link_mode &= ~HCI_LM_MASTER;
2055 else
2056 conn->link_mode |= HCI_LM_MASTER;
2057 }
2058
2059 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2060
2061 hci_role_switch_cfm(conn, ev->status, ev->role);
2062 }
2063
2064 hci_dev_unlock(hdev);
2065}
2066
Linus Torvalds1da177e2005-04-16 15:20:36 -07002067static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2068{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002069 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002070 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002071 int i;
2072
2073 skb_pull(skb, sizeof(*ev));
2074
2075 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2076
2077 if (skb->len < ev->num_hndl * 4) {
2078 BT_DBG("%s bad parameters", hdev->name);
2079 return;
2080 }
2081
2082 tasklet_disable(&hdev->tx_task);
2083
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002084 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002085 struct hci_conn *conn;
2086 __u16 handle, count;
2087
Harvey Harrison83985312008-05-02 16:25:46 -07002088 handle = get_unaligned_le16(ptr++);
2089 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002090
2091 conn = hci_conn_hash_lookup_handle(hdev, handle);
2092 if (conn) {
2093 conn->sent -= count;
2094
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002095 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002096 hdev->acl_cnt += count;
2097 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002098 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002099 } else if (conn->type == LE_LINK) {
2100 if (hdev->le_pkts) {
2101 hdev->le_cnt += count;
2102 if (hdev->le_cnt > hdev->le_pkts)
2103 hdev->le_cnt = hdev->le_pkts;
2104 } else {
2105 hdev->acl_cnt += count;
2106 if (hdev->acl_cnt > hdev->acl_pkts)
2107 hdev->acl_cnt = hdev->acl_pkts;
2108 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002109 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002110 hdev->sco_cnt += count;
2111 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002112 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002113 }
2114 }
2115 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002116
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002117 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002118
2119 tasklet_enable(&hdev->tx_task);
2120}
2121
Marcel Holtmann04837f62006-07-03 10:02:33 +02002122static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002123{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002124 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002125 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002126
2127 BT_DBG("%s status %d", hdev->name, ev->status);
2128
2129 hci_dev_lock(hdev);
2130
Marcel Holtmann04837f62006-07-03 10:02:33 +02002131 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2132 if (conn) {
2133 conn->mode = ev->mode;
2134 conn->interval = __le16_to_cpu(ev->interval);
2135
2136 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2137 if (conn->mode == HCI_CM_ACTIVE)
2138 conn->power_save = 1;
2139 else
2140 conn->power_save = 0;
2141 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002142
2143 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2144 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002145 }
2146
2147 hci_dev_unlock(hdev);
2148}
2149
Linus Torvalds1da177e2005-04-16 15:20:36 -07002150static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2151{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002152 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2153 struct hci_conn *conn;
2154
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002155 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002156
2157 hci_dev_lock(hdev);
2158
2159 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Marcel Holtmann3d7a9d12009-05-09 12:09:21 -07002160 if (conn && conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002161 hci_conn_hold(conn);
2162 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2163 hci_conn_put(conn);
2164 }
2165
Johan Hedberg03b555e2011-01-04 15:40:05 +02002166 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2167 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2168 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg582fbe92011-04-28 11:28:58 -07002169 else if (test_bit(HCI_MGMT, &hdev->flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002170 u8 secure;
2171
2172 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2173 secure = 1;
2174 else
2175 secure = 0;
2176
2177 mgmt_pin_code_request(hdev->id, &ev->bdaddr, secure);
2178 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002179
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002180 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002181}
2182
Linus Torvalds1da177e2005-04-16 15:20:36 -07002183static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2184{
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002185 struct hci_ev_link_key_req *ev = (void *) skb->data;
2186 struct hci_cp_link_key_reply cp;
2187 struct hci_conn *conn;
2188 struct link_key *key;
2189
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002190 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002191
2192 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2193 return;
2194
2195 hci_dev_lock(hdev);
2196
2197 key = hci_find_link_key(hdev, &ev->bdaddr);
2198 if (!key) {
2199 BT_DBG("%s link key not found for %s", hdev->name,
2200 batostr(&ev->bdaddr));
2201 goto not_found;
2202 }
2203
2204 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2205 batostr(&ev->bdaddr));
2206
Waldemar Rymarkiewiczb6020ba2011-04-28 12:07:53 +02002207 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2208 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002209 BT_DBG("%s ignoring debug key", hdev->name);
2210 goto not_found;
2211 }
2212
2213 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002214 if (conn) {
2215 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2216 conn->auth_type != 0xff &&
2217 (conn->auth_type & 0x01)) {
2218 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2219 goto not_found;
2220 }
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002221
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002222 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2223 conn->pending_sec_level == BT_SECURITY_HIGH) {
2224 BT_DBG("%s ignoring key unauthenticated for high \
2225 security", hdev->name);
2226 goto not_found;
2227 }
2228
2229 conn->key_type = key->type;
2230 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002231 }
2232
2233 bacpy(&cp.bdaddr, &ev->bdaddr);
2234 memcpy(cp.link_key, key->val, 16);
2235
2236 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2237
2238 hci_dev_unlock(hdev);
2239
2240 return;
2241
2242not_found:
2243 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2244 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002245}
2246
Linus Torvalds1da177e2005-04-16 15:20:36 -07002247static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2248{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002249 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2250 struct hci_conn *conn;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002251 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002252
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002253 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002254
2255 hci_dev_lock(hdev);
2256
2257 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2258 if (conn) {
2259 hci_conn_hold(conn);
2260 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002261 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002262
2263 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2264 conn->key_type = ev->key_type;
2265
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002266 hci_conn_put(conn);
2267 }
2268
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002269 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002270 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002271 ev->key_type, pin_len);
2272
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002273 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002274}
2275
Marcel Holtmann04837f62006-07-03 10:02:33 +02002276static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2277{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002278 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002279 struct hci_conn *conn;
2280
2281 BT_DBG("%s status %d", hdev->name, ev->status);
2282
2283 hci_dev_lock(hdev);
2284
2285 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002286 if (conn && !ev->status) {
2287 struct inquiry_entry *ie;
2288
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002289 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2290 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002291 ie->data.clock_offset = ev->clock_offset;
2292 ie->timestamp = jiffies;
2293 }
2294 }
2295
2296 hci_dev_unlock(hdev);
2297}
2298
Marcel Holtmanna8746412008-07-14 20:13:46 +02002299static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2300{
2301 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2302 struct hci_conn *conn;
2303
2304 BT_DBG("%s status %d", hdev->name, ev->status);
2305
2306 hci_dev_lock(hdev);
2307
2308 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2309 if (conn && !ev->status)
2310 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2311
2312 hci_dev_unlock(hdev);
2313}
2314
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002315static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2316{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002317 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002318 struct inquiry_entry *ie;
2319
2320 BT_DBG("%s", hdev->name);
2321
2322 hci_dev_lock(hdev);
2323
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002324 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2325 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002326 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2327 ie->timestamp = jiffies;
2328 }
2329
2330 hci_dev_unlock(hdev);
2331}
2332
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002333static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2334{
2335 struct inquiry_data data;
2336 int num_rsp = *((__u8 *) skb->data);
2337
2338 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2339
2340 if (!num_rsp)
2341 return;
2342
2343 hci_dev_lock(hdev);
2344
Johan Hedberg314b2382011-04-27 10:29:57 -04002345 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2346
2347 if (test_bit(HCI_MGMT, &hdev->flags))
2348 mgmt_discovering(hdev->id, 1);
2349 }
2350
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002351 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002352 struct inquiry_info_with_rssi_and_pscan_mode *info;
2353 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002354
Johan Hedberge17acd42011-03-30 23:57:16 +03002355 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002356 bacpy(&data.bdaddr, &info->bdaddr);
2357 data.pscan_rep_mode = info->pscan_rep_mode;
2358 data.pscan_period_mode = info->pscan_period_mode;
2359 data.pscan_mode = info->pscan_mode;
2360 memcpy(data.dev_class, info->dev_class, 3);
2361 data.clock_offset = info->clock_offset;
2362 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002363 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002364 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002365 mgmt_device_found(hdev->id, &info->bdaddr,
2366 info->dev_class, info->rssi,
2367 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002368 }
2369 } else {
2370 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2371
Johan Hedberge17acd42011-03-30 23:57:16 +03002372 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002373 bacpy(&data.bdaddr, &info->bdaddr);
2374 data.pscan_rep_mode = info->pscan_rep_mode;
2375 data.pscan_period_mode = info->pscan_period_mode;
2376 data.pscan_mode = 0x00;
2377 memcpy(data.dev_class, info->dev_class, 3);
2378 data.clock_offset = info->clock_offset;
2379 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002380 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002381 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002382 mgmt_device_found(hdev->id, &info->bdaddr,
2383 info->dev_class, info->rssi,
2384 NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002385 }
2386 }
2387
2388 hci_dev_unlock(hdev);
2389}
2390
2391static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2392{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002393 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2394 struct hci_conn *conn;
2395
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002396 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002397
Marcel Holtmann41a96212008-07-14 20:13:48 +02002398 hci_dev_lock(hdev);
2399
2400 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002401 if (!conn)
2402 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002403
Johan Hedbergccd556f2010-11-10 17:11:51 +02002404 if (!ev->status && ev->page == 0x01) {
2405 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002406
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002407 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2408 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002409 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002410
Johan Hedbergccd556f2010-11-10 17:11:51 +02002411 conn->ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002412 }
2413
Johan Hedbergccd556f2010-11-10 17:11:51 +02002414 if (conn->state != BT_CONFIG)
2415 goto unlock;
2416
Johan Hedberg127178d2010-11-18 22:22:29 +02002417 if (!ev->status) {
2418 struct hci_cp_remote_name_req cp;
2419 memset(&cp, 0, sizeof(cp));
2420 bacpy(&cp.bdaddr, &conn->dst);
2421 cp.pscan_rep_mode = 0x02;
2422 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2423 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002424
Johan Hedberg127178d2010-11-18 22:22:29 +02002425 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002426 conn->state = BT_CONNECTED;
2427 hci_proto_connect_cfm(conn, ev->status);
2428 hci_conn_put(conn);
2429 }
2430
2431unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002432 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002433}
2434
2435static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2436{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002437 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2438 struct hci_conn *conn;
2439
2440 BT_DBG("%s status %d", hdev->name, ev->status);
2441
2442 hci_dev_lock(hdev);
2443
2444 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002445 if (!conn) {
2446 if (ev->link_type == ESCO_LINK)
2447 goto unlock;
2448
2449 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2450 if (!conn)
2451 goto unlock;
2452
2453 conn->type = SCO_LINK;
2454 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002455
Marcel Holtmann732547f2009-04-19 19:14:14 +02002456 switch (ev->status) {
2457 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002458 conn->handle = __le16_to_cpu(ev->handle);
2459 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002460
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002461 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002462 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002463 break;
2464
Nick Pelly5c9b4de2009-09-22 15:19:46 -07002465 case 0x10: /* Connection Accept Timeout */
Stephen Coe705e5712010-02-16 11:29:44 -05002466 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002467 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002468 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002469 case 0x1f: /* Unspecified error */
2470 if (conn->out && conn->attempt < 2) {
2471 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2472 (hdev->esco_type & EDR_ESCO_MASK);
2473 hci_setup_sync(conn, conn->link->handle);
2474 goto unlock;
2475 }
2476 /* fall through */
2477
2478 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002479 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002480 break;
2481 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002482
2483 hci_proto_connect_cfm(conn, ev->status);
2484 if (ev->status)
2485 hci_conn_del(conn);
2486
2487unlock:
2488 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002489}
2490
2491static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2492{
2493 BT_DBG("%s", hdev->name);
2494}
2495
Marcel Holtmann04837f62006-07-03 10:02:33 +02002496static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2497{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002498 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002499
2500 BT_DBG("%s status %d", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002501}
2502
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002503static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2504{
2505 struct inquiry_data data;
2506 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2507 int num_rsp = *((__u8 *) skb->data);
2508
2509 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2510
2511 if (!num_rsp)
2512 return;
2513
Johan Hedberg314b2382011-04-27 10:29:57 -04002514 if (!test_and_set_bit(HCI_INQUIRY, &hdev->flags)) {
2515
2516 if (test_bit(HCI_MGMT, &hdev->flags))
2517 mgmt_discovering(hdev->id, 1);
2518 }
2519
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002520 hci_dev_lock(hdev);
2521
Johan Hedberge17acd42011-03-30 23:57:16 +03002522 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002523 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002524 data.pscan_rep_mode = info->pscan_rep_mode;
2525 data.pscan_period_mode = info->pscan_period_mode;
2526 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002527 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002528 data.clock_offset = info->clock_offset;
2529 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002530 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002531 hci_inquiry_cache_update(hdev, &data);
Johan Hedberge17acd42011-03-30 23:57:16 +03002532 mgmt_device_found(hdev->id, &info->bdaddr, info->dev_class,
2533 info->rssi, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002534 }
2535
2536 hci_dev_unlock(hdev);
2537}
2538
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002539static inline u8 hci_get_auth_req(struct hci_conn *conn)
2540{
2541 /* If remote requests dedicated bonding follow that lead */
2542 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2543 /* If both remote and local IO capabilities allow MITM
2544 * protection then require it, otherwise don't */
2545 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2546 return 0x02;
2547 else
2548 return 0x03;
2549 }
2550
2551 /* If remote requests no-bonding follow that lead */
2552 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02002553 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002554
2555 return conn->auth_type;
2556}
2557
Marcel Holtmann04936842008-07-14 20:13:48 +02002558static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2559{
2560 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2561 struct hci_conn *conn;
2562
2563 BT_DBG("%s", hdev->name);
2564
2565 hci_dev_lock(hdev);
2566
2567 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002568 if (!conn)
2569 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002570
Johan Hedberg03b555e2011-01-04 15:40:05 +02002571 hci_conn_hold(conn);
2572
2573 if (!test_bit(HCI_MGMT, &hdev->flags))
2574 goto unlock;
2575
2576 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2577 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002578 struct hci_cp_io_capability_reply cp;
2579
2580 bacpy(&cp.bdaddr, &ev->bdaddr);
2581 cp.capability = conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07002582 conn->auth_type = hci_get_auth_req(conn);
2583 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002584
Szymon Jancce85ee12011-03-22 13:12:23 +01002585 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2586 hci_find_remote_oob_data(hdev, &conn->dst))
2587 cp.oob_data = 0x01;
2588 else
2589 cp.oob_data = 0x00;
2590
Johan Hedberg17fa4b92011-01-25 13:28:33 +02002591 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2592 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02002593 } else {
2594 struct hci_cp_io_capability_neg_reply cp;
2595
2596 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedbergbe771592011-04-28 11:28:57 -07002597 cp.reason = 0x18; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02002598
2599 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2600 sizeof(cp), &cp);
2601 }
2602
2603unlock:
2604 hci_dev_unlock(hdev);
2605}
2606
2607static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2608{
2609 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2610 struct hci_conn *conn;
2611
2612 BT_DBG("%s", hdev->name);
2613
2614 hci_dev_lock(hdev);
2615
2616 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2617 if (!conn)
2618 goto unlock;
2619
Johan Hedberg03b555e2011-01-04 15:40:05 +02002620 conn->remote_cap = ev->capability;
2621 conn->remote_oob = ev->oob_data;
2622 conn->remote_auth = ev->authentication;
2623
2624unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002625 hci_dev_unlock(hdev);
2626}
2627
Johan Hedberga5c29682011-02-19 12:05:57 -03002628static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2629 struct sk_buff *skb)
2630{
2631 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002632 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07002633 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002634
2635 BT_DBG("%s", hdev->name);
2636
2637 hci_dev_lock(hdev);
2638
Johan Hedberg7a828902011-04-28 11:28:53 -07002639 if (!test_bit(HCI_MGMT, &hdev->flags))
2640 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03002641
Johan Hedberg7a828902011-04-28 11:28:53 -07002642 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2643 if (!conn)
2644 goto unlock;
2645
2646 loc_mitm = (conn->auth_type & 0x01);
2647 rem_mitm = (conn->remote_auth & 0x01);
2648
2649 /* If we require MITM but the remote device can't provide that
2650 * (it has NoInputNoOutput) then reject the confirmation
2651 * request. The only exception is when we're dedicated bonding
2652 * initiators (connect_cfm_cb set) since then we always have the MITM
2653 * bit set. */
2654 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2655 BT_DBG("Rejecting request: remote device can't provide MITM");
2656 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2657 sizeof(ev->bdaddr), &ev->bdaddr);
2658 goto unlock;
2659 }
2660
2661 /* If no side requires MITM protection; auto-accept */
2662 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2663 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002664
2665 /* If we're not the initiators request authorization to
2666 * proceed from user space (mgmt_user_confirm with
2667 * confirm_hint set to 1). */
2668 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2669 BT_DBG("Confirming auto-accept as acceptor");
2670 confirm_hint = 1;
2671 goto confirm;
2672 }
2673
Johan Hedberg9f616562011-04-28 11:28:54 -07002674 BT_DBG("Auto-accept of user confirmation with %ums delay",
2675 hdev->auto_accept_delay);
2676
2677 if (hdev->auto_accept_delay > 0) {
2678 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2679 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2680 goto unlock;
2681 }
2682
Johan Hedberg7a828902011-04-28 11:28:53 -07002683 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2684 sizeof(ev->bdaddr), &ev->bdaddr);
2685 goto unlock;
2686 }
2687
Johan Hedberg55bc1a32011-04-28 11:28:56 -07002688confirm:
2689 mgmt_user_confirm_request(hdev->id, &ev->bdaddr, ev->passkey,
2690 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07002691
2692unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03002693 hci_dev_unlock(hdev);
2694}
2695
Marcel Holtmann04936842008-07-14 20:13:48 +02002696static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2697{
2698 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2699 struct hci_conn *conn;
2700
2701 BT_DBG("%s", hdev->name);
2702
2703 hci_dev_lock(hdev);
2704
2705 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03002706 if (!conn)
2707 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02002708
Johan Hedberg2a611692011-02-19 12:06:00 -03002709 /* To avoid duplicate auth_failed events to user space we check
2710 * the HCI_CONN_AUTH_PEND flag which will be set if we
2711 * initiated the authentication. A traditional auth_complete
2712 * event gets always produced as initiator and is also mapped to
2713 * the mgmt_auth_failed event */
2714 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
2715 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
2716
2717 hci_conn_put(conn);
2718
2719unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02002720 hci_dev_unlock(hdev);
2721}
2722
Marcel Holtmann41a96212008-07-14 20:13:48 +02002723static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2724{
2725 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2726 struct inquiry_entry *ie;
2727
2728 BT_DBG("%s", hdev->name);
2729
2730 hci_dev_lock(hdev);
2731
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002732 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2733 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02002734 ie->data.ssp_mode = (ev->features[0] & 0x01);
2735
2736 hci_dev_unlock(hdev);
2737}
2738
Szymon Janc2763eda2011-03-22 13:12:22 +01002739static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2740 struct sk_buff *skb)
2741{
2742 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2743 struct oob_data *data;
2744
2745 BT_DBG("%s", hdev->name);
2746
2747 hci_dev_lock(hdev);
2748
Szymon Jance1ba1f12011-04-06 13:01:59 +02002749 if (!test_bit(HCI_MGMT, &hdev->flags))
2750 goto unlock;
2751
Szymon Janc2763eda2011-03-22 13:12:22 +01002752 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2753 if (data) {
2754 struct hci_cp_remote_oob_data_reply cp;
2755
2756 bacpy(&cp.bdaddr, &ev->bdaddr);
2757 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2758 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2759
2760 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2761 &cp);
2762 } else {
2763 struct hci_cp_remote_oob_data_neg_reply cp;
2764
2765 bacpy(&cp.bdaddr, &ev->bdaddr);
2766 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2767 &cp);
2768 }
2769
Szymon Jance1ba1f12011-04-06 13:01:59 +02002770unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01002771 hci_dev_unlock(hdev);
2772}
2773
Ville Tervofcd89c02011-02-10 22:38:47 -03002774static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2775{
2776 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2777 struct hci_conn *conn;
2778
2779 BT_DBG("%s status %d", hdev->name, ev->status);
2780
2781 hci_dev_lock(hdev);
2782
2783 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002784 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08002785 conn = hci_conn_add(hdev, LE_LINK, 0, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03002786 if (!conn) {
2787 BT_ERR("No memory for new connection");
2788 hci_dev_unlock(hdev);
2789 return;
2790 }
Andre Guedes149c0972011-05-31 14:20:54 -03002791
2792 conn->dst_type = ev->bdaddr_type;
Ville Tervob62f3282011-02-10 22:38:50 -03002793 }
Ville Tervofcd89c02011-02-10 22:38:47 -03002794
2795 if (ev->status) {
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002796 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03002797 hci_proto_connect_cfm(conn, ev->status);
2798 conn->state = BT_CLOSED;
2799 hci_conn_del(conn);
2800 goto unlock;
2801 }
2802
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03002803 mgmt_connected(hdev->id, &ev->bdaddr);
2804
Vinicius Costa Gomes403d2c82011-06-09 18:50:50 -03002805 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03002806 conn->handle = __le16_to_cpu(ev->handle);
2807 conn->state = BT_CONNECTED;
2808
2809 hci_conn_hold_device(conn);
2810 hci_conn_add_sysfs(conn);
2811
2812 hci_proto_connect_cfm(conn, ev->status);
2813
2814unlock:
2815 hci_dev_unlock(hdev);
2816}
2817
Andre Guedes5df108f2011-05-26 16:23:51 -03002818static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2819 struct sk_buff *skb)
2820{
2821 struct hci_ev_le_advertising_info *ev;
2822 u8 num_reports;
2823
2824 num_reports = skb->data[0];
2825 ev = (void *) &skb->data[1];
2826
2827 hci_dev_lock(hdev);
2828
2829 hci_add_adv_entry(hdev, ev);
2830
2831 while (--num_reports) {
2832 ev = (void *) (ev->data + ev->length + 1);
2833 hci_add_adv_entry(hdev, ev);
2834 }
2835
2836 hci_dev_unlock(hdev);
2837}
2838
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002839static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2840 struct sk_buff *skb)
2841{
2842 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2843 struct hci_cp_le_ltk_reply cp;
2844 struct hci_conn *conn;
2845
2846 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2847
2848 hci_dev_lock(hdev);
2849
2850 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2851
2852 memset(&cp, 0, sizeof(cp));
2853 cp.handle = cpu_to_le16(conn->handle);
2854 memcpy(cp.ltk, conn->ltk, sizeof(conn->ltk));
2855
2856 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2857
2858 hci_dev_unlock(hdev);
2859}
2860
Ville Tervofcd89c02011-02-10 22:38:47 -03002861static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2862{
2863 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2864
2865 skb_pull(skb, sizeof(*le_ev));
2866
2867 switch (le_ev->subevent) {
2868 case HCI_EV_LE_CONN_COMPLETE:
2869 hci_le_conn_complete_evt(hdev, skb);
2870 break;
2871
Andre Guedes5df108f2011-05-26 16:23:51 -03002872 case HCI_EV_LE_ADVERTISING_REPORT:
2873 hci_le_adv_report_evt(hdev, skb);
2874 break;
2875
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002876 case HCI_EV_LE_LTK_REQ:
2877 hci_le_ltk_request_evt(hdev, skb);
2878 break;
2879
Ville Tervofcd89c02011-02-10 22:38:47 -03002880 default:
2881 break;
2882 }
2883}
2884
Linus Torvalds1da177e2005-04-16 15:20:36 -07002885void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2886{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002887 struct hci_event_hdr *hdr = (void *) skb->data;
2888 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002889
2890 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2891
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002892 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002893 case HCI_EV_INQUIRY_COMPLETE:
2894 hci_inquiry_complete_evt(hdev, skb);
2895 break;
2896
2897 case HCI_EV_INQUIRY_RESULT:
2898 hci_inquiry_result_evt(hdev, skb);
2899 break;
2900
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002901 case HCI_EV_CONN_COMPLETE:
2902 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02002903 break;
2904
Linus Torvalds1da177e2005-04-16 15:20:36 -07002905 case HCI_EV_CONN_REQUEST:
2906 hci_conn_request_evt(hdev, skb);
2907 break;
2908
Linus Torvalds1da177e2005-04-16 15:20:36 -07002909 case HCI_EV_DISCONN_COMPLETE:
2910 hci_disconn_complete_evt(hdev, skb);
2911 break;
2912
Linus Torvalds1da177e2005-04-16 15:20:36 -07002913 case HCI_EV_AUTH_COMPLETE:
2914 hci_auth_complete_evt(hdev, skb);
2915 break;
2916
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002917 case HCI_EV_REMOTE_NAME:
2918 hci_remote_name_evt(hdev, skb);
2919 break;
2920
Linus Torvalds1da177e2005-04-16 15:20:36 -07002921 case HCI_EV_ENCRYPT_CHANGE:
2922 hci_encrypt_change_evt(hdev, skb);
2923 break;
2924
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002925 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
2926 hci_change_link_key_complete_evt(hdev, skb);
2927 break;
2928
2929 case HCI_EV_REMOTE_FEATURES:
2930 hci_remote_features_evt(hdev, skb);
2931 break;
2932
2933 case HCI_EV_REMOTE_VERSION:
2934 hci_remote_version_evt(hdev, skb);
2935 break;
2936
2937 case HCI_EV_QOS_SETUP_COMPLETE:
2938 hci_qos_setup_complete_evt(hdev, skb);
2939 break;
2940
2941 case HCI_EV_CMD_COMPLETE:
2942 hci_cmd_complete_evt(hdev, skb);
2943 break;
2944
2945 case HCI_EV_CMD_STATUS:
2946 hci_cmd_status_evt(hdev, skb);
2947 break;
2948
2949 case HCI_EV_ROLE_CHANGE:
2950 hci_role_change_evt(hdev, skb);
2951 break;
2952
2953 case HCI_EV_NUM_COMP_PKTS:
2954 hci_num_comp_pkts_evt(hdev, skb);
2955 break;
2956
2957 case HCI_EV_MODE_CHANGE:
2958 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002959 break;
2960
2961 case HCI_EV_PIN_CODE_REQ:
2962 hci_pin_code_request_evt(hdev, skb);
2963 break;
2964
2965 case HCI_EV_LINK_KEY_REQ:
2966 hci_link_key_request_evt(hdev, skb);
2967 break;
2968
2969 case HCI_EV_LINK_KEY_NOTIFY:
2970 hci_link_key_notify_evt(hdev, skb);
2971 break;
2972
2973 case HCI_EV_CLOCK_OFFSET:
2974 hci_clock_offset_evt(hdev, skb);
2975 break;
2976
Marcel Holtmanna8746412008-07-14 20:13:46 +02002977 case HCI_EV_PKT_TYPE_CHANGE:
2978 hci_pkt_type_change_evt(hdev, skb);
2979 break;
2980
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002981 case HCI_EV_PSCAN_REP_MODE:
2982 hci_pscan_rep_mode_evt(hdev, skb);
2983 break;
2984
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002985 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
2986 hci_inquiry_result_with_rssi_evt(hdev, skb);
2987 break;
2988
2989 case HCI_EV_REMOTE_EXT_FEATURES:
2990 hci_remote_ext_features_evt(hdev, skb);
2991 break;
2992
2993 case HCI_EV_SYNC_CONN_COMPLETE:
2994 hci_sync_conn_complete_evt(hdev, skb);
2995 break;
2996
2997 case HCI_EV_SYNC_CONN_CHANGED:
2998 hci_sync_conn_changed_evt(hdev, skb);
2999 break;
3000
Marcel Holtmann04837f62006-07-03 10:02:33 +02003001 case HCI_EV_SNIFF_SUBRATE:
3002 hci_sniff_subrate_evt(hdev, skb);
3003 break;
3004
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003005 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3006 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003007 break;
3008
Marcel Holtmann04936842008-07-14 20:13:48 +02003009 case HCI_EV_IO_CAPA_REQUEST:
3010 hci_io_capa_request_evt(hdev, skb);
3011 break;
3012
Johan Hedberg03b555e2011-01-04 15:40:05 +02003013 case HCI_EV_IO_CAPA_REPLY:
3014 hci_io_capa_reply_evt(hdev, skb);
3015 break;
3016
Johan Hedberga5c29682011-02-19 12:05:57 -03003017 case HCI_EV_USER_CONFIRM_REQUEST:
3018 hci_user_confirm_request_evt(hdev, skb);
3019 break;
3020
Marcel Holtmann04936842008-07-14 20:13:48 +02003021 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3022 hci_simple_pair_complete_evt(hdev, skb);
3023 break;
3024
Marcel Holtmann41a96212008-07-14 20:13:48 +02003025 case HCI_EV_REMOTE_HOST_FEATURES:
3026 hci_remote_host_features_evt(hdev, skb);
3027 break;
3028
Ville Tervofcd89c02011-02-10 22:38:47 -03003029 case HCI_EV_LE_META:
3030 hci_le_meta_evt(hdev, skb);
3031 break;
3032
Szymon Janc2763eda2011-03-22 13:12:22 +01003033 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3034 hci_remote_oob_data_request_evt(hdev, skb);
3035 break;
3036
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003037 default:
3038 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003039 break;
3040 }
3041
3042 kfree_skb(skb);
3043 hdev->stat.evt_rx++;
3044}
3045
3046/* Generate internal stack event */
3047void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3048{
3049 struct hci_event_hdr *hdr;
3050 struct hci_ev_stack_internal *ev;
3051 struct sk_buff *skb;
3052
3053 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3054 if (!skb)
3055 return;
3056
3057 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3058 hdr->evt = HCI_EV_STACK_INTERNAL;
3059 hdr->plen = sizeof(*ev) + dlen;
3060
3061 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3062 ev->type = type;
3063 memcpy(ev->data, data, dlen);
3064
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003065 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003066 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003067
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003068 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003069 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003070 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003071 kfree_skb(skb);
3072}