blob: e5f43ec517941d3acef18ff4eff2f59b50830dc7 [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
Srinivas Krovvidi32ba9352012-01-26 10:48:08 +05303 Copyright (c) 2000-2001, 2010-2012, 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
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070059 clear_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010060
Johan Hedberg23bb5762010-12-21 23:01:27 +020061 hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010062
Marcel Holtmanna9de9242007-10-20 13:33:56 +020063 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070064}
65
Marcel Holtmanna9de9242007-10-20 13:33:56 +020066static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070067{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020068 __u8 status = *((__u8 *) skb->data);
69
70 BT_DBG("%s status 0x%x", hdev->name, status);
71
72 if (status)
73 return;
74
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070075 clear_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020076
77 hci_conn_check_pending(hdev);
78}
79
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070080static void hci_cc_link_key_reply(struct hci_dev *hdev, struct sk_buff *skb)
81{
82 struct hci_rp_link_key_reply *rp = (void *) skb->data;
83 struct hci_conn *conn;
84 struct hci_cp_link_key_reply *cp;
85
86 BT_DBG("%s status 0x%x", hdev->name, rp->status);
87 if (rp->status)
88 return;
89
90 cp = hci_sent_cmd_data(hdev, HCI_OP_LINK_KEY_REPLY);
91 if (!cp)
92 return;
93
94 hci_dev_lock(hdev);
95 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
96 if (conn) {
97 hci_conn_hold(conn);
98 memcpy(conn->link_key, cp->link_key, sizeof(conn->link_key));
99 conn->key_type = 5;
100 hci_conn_put(conn);
101 }
102 hci_dev_unlock(hdev);
103}
104
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200105static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
106{
107 BT_DBG("%s", hdev->name);
108}
109
110static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
111{
112 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200115 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200117 if (rp->status)
118 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200120 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200122 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
123 if (conn) {
124 if (rp->role)
125 conn->link_mode &= ~HCI_LM_MASTER;
126 else
127 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200129
130 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131}
132
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200133static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
134{
135 struct hci_rp_read_link_policy *rp = (void *) skb->data;
136 struct hci_conn *conn;
137
138 BT_DBG("%s status 0x%x", hdev->name, rp->status);
139
140 if (rp->status)
141 return;
142
143 hci_dev_lock(hdev);
144
145 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
146 if (conn)
147 conn->link_policy = __le16_to_cpu(rp->policy);
148
149 hci_dev_unlock(hdev);
150}
151
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200152static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200154 struct hci_rp_write_link_policy *rp = (void *) skb->data;
155 struct hci_conn *conn;
156 void *sent;
157
158 BT_DBG("%s status 0x%x", hdev->name, rp->status);
159
160 if (rp->status)
161 return;
162
163 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
164 if (!sent)
165 return;
166
167 hci_dev_lock(hdev);
168
169 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200170 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700171 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200172
173 hci_dev_unlock(hdev);
174}
175
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200176static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
177{
178 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
179
180 BT_DBG("%s status 0x%x", hdev->name, rp->status);
181
182 if (rp->status)
183 return;
184
185 hdev->link_policy = __le16_to_cpu(rp->policy);
186}
187
188static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
189{
190 __u8 status = *((__u8 *) skb->data);
191 void *sent;
192
193 BT_DBG("%s status 0x%x", hdev->name, status);
194
195 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
196 if (!sent)
197 return;
198
199 if (!status)
200 hdev->link_policy = get_unaligned_le16(sent);
201
Johan Hedberg23bb5762010-12-21 23:01:27 +0200202 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200203}
204
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200205static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
206{
207 __u8 status = *((__u8 *) skb->data);
208
209 BT_DBG("%s status 0x%x", hdev->name, status);
210
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300211 clear_bit(HCI_RESET, &hdev->flags);
212
Johan Hedberg23bb5762010-12-21 23:01:27 +0200213 hci_req_complete(hdev, HCI_OP_RESET, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200214}
215
216static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
217{
218 __u8 status = *((__u8 *) skb->data);
219 void *sent;
220
221 BT_DBG("%s status 0x%x", hdev->name, status);
222
223 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
224 if (!sent)
225 return;
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800226 hci_dev_lock(hdev);
Royston Rodriguesc58c0c22011-10-24 12:54:13 +0530227 if (!status)
228 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
229
Johan Hedbergb312b1612011-03-16 14:29:37 +0200230 if (test_bit(HCI_MGMT, &hdev->flags))
231 mgmt_set_local_name_complete(hdev->id, sent, status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800232 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200233}
234
235static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
236{
237 struct hci_rp_read_local_name *rp = (void *) skb->data;
238
239 BT_DBG("%s status 0x%x", hdev->name, rp->status);
240
241 if (rp->status)
242 return;
243
Johan Hedberg1f6c6372011-03-16 14:29:35 +0200244 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200245}
246
247static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
248{
249 __u8 status = *((__u8 *) skb->data);
250 void *sent;
251
252 BT_DBG("%s status 0x%x", hdev->name, status);
253
254 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
255 if (!sent)
256 return;
257
258 if (!status) {
259 __u8 param = *((__u8 *) sent);
260
261 if (param == AUTH_ENABLED)
262 set_bit(HCI_AUTH, &hdev->flags);
263 else
264 clear_bit(HCI_AUTH, &hdev->flags);
265 }
266
Johan Hedberg23bb5762010-12-21 23:01:27 +0200267 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200268}
269
270static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
271{
272 __u8 status = *((__u8 *) skb->data);
273 void *sent;
274
275 BT_DBG("%s status 0x%x", hdev->name, status);
276
277 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
278 if (!sent)
279 return;
280
281 if (!status) {
282 __u8 param = *((__u8 *) sent);
283
284 if (param)
285 set_bit(HCI_ENCRYPT, &hdev->flags);
286 else
287 clear_bit(HCI_ENCRYPT, &hdev->flags);
288 }
289
Johan Hedberg23bb5762010-12-21 23:01:27 +0200290 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200291}
292
293static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
294{
295 __u8 status = *((__u8 *) skb->data);
296 void *sent;
297
298 BT_DBG("%s status 0x%x", hdev->name, status);
299
300 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
301 if (!sent)
302 return;
303
304 if (!status) {
305 __u8 param = *((__u8 *) sent);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200306 int old_pscan, old_iscan;
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800307 hci_dev_lock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200308
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200309 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
310 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200311
Johan Hedberg73f22f62010-12-29 16:00:25 +0200312 if (param & SCAN_INQUIRY) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200313 set_bit(HCI_ISCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200314 if (!old_iscan)
315 mgmt_discoverable(hdev->id, 1);
316 } else if (old_iscan)
Johan Hedberg73f22f62010-12-29 16:00:25 +0200317 mgmt_discoverable(hdev->id, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200318
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200319 if (param & SCAN_PAGE) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200320 set_bit(HCI_PSCAN, &hdev->flags);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +0200321 if (!old_pscan)
322 mgmt_connectable(hdev->id, 1);
323 } else if (old_pscan)
324 mgmt_connectable(hdev->id, 0);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800325 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200326 }
327
Johan Hedberg23bb5762010-12-21 23:01:27 +0200328 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200329}
330
331static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
332{
333 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
334
335 BT_DBG("%s status 0x%x", hdev->name, rp->status);
336
337 if (rp->status)
338 return;
339
340 memcpy(hdev->dev_class, rp->dev_class, 3);
341
342 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
343 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
344}
345
346static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
347{
348 __u8 status = *((__u8 *) skb->data);
349 void *sent;
350
351 BT_DBG("%s status 0x%x", hdev->name, status);
352
Marcel Holtmannf383f272008-07-14 20:13:47 +0200353 if (status)
354 return;
355
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200356 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
357 if (!sent)
358 return;
359
Marcel Holtmannf383f272008-07-14 20:13:47 +0200360 memcpy(hdev->dev_class, sent, 3);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200361}
362
363static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
364{
365 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200367
368 BT_DBG("%s status 0x%x", hdev->name, rp->status);
369
370 if (rp->status)
371 return;
372
373 setting = __le16_to_cpu(rp->voice_setting);
374
Marcel Holtmannf383f272008-07-14 20:13:47 +0200375 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200376 return;
377
378 hdev->voice_setting = setting;
379
380 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
381
382 if (hdev->notify) {
383 tasklet_disable(&hdev->tx_task);
384 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
385 tasklet_enable(&hdev->tx_task);
386 }
387}
388
389static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
390{
391 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200392 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393 void *sent;
394
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200395 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
Marcel Holtmannf383f272008-07-14 20:13:47 +0200397 if (status)
398 return;
399
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200400 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
401 if (!sent)
402 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Marcel Holtmannf383f272008-07-14 20:13:47 +0200404 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405
Marcel Holtmannf383f272008-07-14 20:13:47 +0200406 if (hdev->voice_setting == setting)
407 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408
Marcel Holtmannf383f272008-07-14 20:13:47 +0200409 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410
Marcel Holtmannf383f272008-07-14 20:13:47 +0200411 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
412
413 if (hdev->notify) {
414 tasklet_disable(&hdev->tx_task);
415 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
416 tasklet_enable(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417 }
418}
419
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200420static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200422 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200424 BT_DBG("%s status 0x%x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425
Johan Hedberg23bb5762010-12-21 23:01:27 +0200426 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427}
428
Sunny Kapdi320598f2012-07-30 14:52:56 -0700429static void hci_cc_le_clear_white_list(struct hci_dev *hdev,
430 struct sk_buff *skb)
431{
432 __u8 status = *((__u8 *) skb->data);
433
434 BT_DBG("%s status 0x%x", hdev->name, status);
435
436 hci_req_complete(hdev, HCI_OP_LE_CLEAR_WHITE_LIST, status);
437}
438
Marcel Holtmann333140b2008-07-14 20:13:48 +0200439static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
440{
441 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
442
443 BT_DBG("%s status 0x%x", hdev->name, rp->status);
444
445 if (rp->status)
446 return;
447
448 hdev->ssp_mode = rp->mode;
449}
450
451static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
452{
453 __u8 status = *((__u8 *) skb->data);
454 void *sent;
455
456 BT_DBG("%s status 0x%x", hdev->name, status);
457
458 if (status)
459 return;
460
461 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
462 if (!sent)
463 return;
464
465 hdev->ssp_mode = *((__u8 *) sent);
466}
467
Johan Hedbergd5859e22011-01-25 01:19:58 +0200468static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
469{
470 if (hdev->features[6] & LMP_EXT_INQ)
471 return 2;
472
473 if (hdev->features[3] & LMP_RSSI_INQ)
474 return 1;
475
476 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
477 hdev->lmp_subver == 0x0757)
478 return 1;
479
480 if (hdev->manufacturer == 15) {
481 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
482 return 1;
483 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
484 return 1;
485 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
486 return 1;
487 }
488
489 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
490 hdev->lmp_subver == 0x1805)
491 return 1;
492
493 return 0;
494}
495
496static void hci_setup_inquiry_mode(struct hci_dev *hdev)
497{
498 u8 mode;
499
500 mode = hci_get_inquiry_mode(hdev);
501
502 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
503}
504
505static void hci_setup_event_mask(struct hci_dev *hdev)
506{
507 /* The second byte is 0xff instead of 0x9f (two reserved bits
508 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
509 * command otherwise */
510 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
511
Brian Gixa68668b2011-08-11 15:49:36 -0700512 BT_DBG("");
513
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700514 /* Events for 1.2 and newer controllers */
515 if (hdev->lmp_ver > 1) {
516 events[4] |= 0x01; /* Flow Specification Complete */
517 events[4] |= 0x02; /* Inquiry Result with RSSI */
518 events[4] |= 0x04; /* Read Remote Extended Features Complete */
519 events[5] |= 0x08; /* Synchronous Connection Complete */
520 events[5] |= 0x10; /* Synchronous Connection Changed */
521 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200522
523 if (hdev->features[3] & LMP_RSSI_INQ)
524 events[4] |= 0x04; /* Inquiry Result with RSSI */
525
526 if (hdev->features[5] & LMP_SNIFF_SUBR)
527 events[5] |= 0x20; /* Sniff Subrating */
528
529 if (hdev->features[5] & LMP_PAUSE_ENC)
530 events[5] |= 0x80; /* Encryption Key Refresh Complete */
531
532 if (hdev->features[6] & LMP_EXT_INQ)
533 events[5] |= 0x40; /* Extended Inquiry Result */
534
535 if (hdev->features[6] & LMP_NO_FLUSH)
536 events[7] |= 0x01; /* Enhanced Flush Complete */
537
538 if (hdev->features[7] & LMP_LSTO)
539 events[6] |= 0x80; /* Link Supervision Timeout Changed */
540
541 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
542 events[6] |= 0x01; /* IO Capability Request */
543 events[6] |= 0x02; /* IO Capability Response */
544 events[6] |= 0x04; /* User Confirmation Request */
545 events[6] |= 0x08; /* User Passkey Request */
546 events[6] |= 0x10; /* Remote OOB Data Request */
547 events[6] |= 0x20; /* Simple Pairing Complete */
548 events[7] |= 0x04; /* User Passkey Notification */
549 events[7] |= 0x08; /* Keypress Notification */
550 events[7] |= 0x10; /* Remote Host Supported
551 * Features Notification */
552 }
553
554 if (hdev->features[4] & LMP_LE)
555 events[7] |= 0x20; /* LE Meta-Event */
556
557 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
558}
559
560static void hci_setup(struct hci_dev *hdev)
561{
Johan Hedbergd5859e22011-01-25 01:19:58 +0200562 if (hdev->lmp_ver > 1)
563 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
564
565 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
566 u8 mode = 0x01;
567 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
568 }
569
570 if (hdev->features[3] & LMP_RSSI_INQ)
571 hci_setup_inquiry_mode(hdev);
572
573 if (hdev->features[7] & LMP_INQ_TX_PWR)
574 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
575}
576
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200577static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
578{
579 struct hci_rp_read_local_version *rp = (void *) skb->data;
580
581 BT_DBG("%s status 0x%x", hdev->name, rp->status);
582
583 if (rp->status)
584 return;
585
586 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200587 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200588 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200589 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200590 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200591
592 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
593 hdev->manufacturer,
594 hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200595
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700596 if (hdev->dev_type == HCI_BREDR && test_bit(HCI_INIT, &hdev->flags))
Johan Hedbergd5859e22011-01-25 01:19:58 +0200597 hci_setup(hdev);
598}
599
600static void hci_setup_link_policy(struct hci_dev *hdev)
601{
602 u16 link_policy = 0;
603
604 if (hdev->features[0] & LMP_RSWITCH)
605 link_policy |= HCI_LP_RSWITCH;
606 if (hdev->features[0] & LMP_HOLD)
607 link_policy |= HCI_LP_HOLD;
608 if (hdev->features[0] & LMP_SNIFF)
609 link_policy |= HCI_LP_SNIFF;
610 if (hdev->features[1] & LMP_PARK)
611 link_policy |= HCI_LP_PARK;
612
613 link_policy = cpu_to_le16(link_policy);
614 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
615 sizeof(link_policy), &link_policy);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200616}
617
618static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
619{
620 struct hci_rp_read_local_commands *rp = (void *) skb->data;
621
622 BT_DBG("%s status 0x%x", hdev->name, rp->status);
623
624 if (rp->status)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200625 goto done;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200626
627 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Johan Hedbergd5859e22011-01-25 01:19:58 +0200628
629 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
630 hci_setup_link_policy(hdev);
631
632done:
633 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200634}
635
636static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
637{
638 struct hci_rp_read_local_features *rp = (void *) skb->data;
639
640 BT_DBG("%s status 0x%x", hdev->name, rp->status);
641
642 if (rp->status)
643 return;
644
645 memcpy(hdev->features, rp->features, 8);
646
Brian Gixa68668b2011-08-11 15:49:36 -0700647 if (hdev->dev_type == HCI_BREDR && test_bit(HCI_INIT, &hdev->flags)) {
648 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
649 u8 mode = 0x01;
650 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE,
651 sizeof(mode), &mode);
652 }
653
654 if (hdev->features[3] & LMP_RSSI_INQ)
655 hci_setup_inquiry_mode(hdev);
656
657 if (hdev->features[7] & LMP_INQ_TX_PWR)
658 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER,
659 0, NULL);
660
661 hci_setup_event_mask(hdev);
662 }
663
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200664 /* Adjust default settings according to features
665 * supported by device. */
666
667 if (hdev->features[0] & LMP_3SLOT)
668 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
669
670 if (hdev->features[0] & LMP_5SLOT)
671 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
672
673 if (hdev->features[1] & LMP_HV2) {
674 hdev->pkt_type |= (HCI_HV2);
675 hdev->esco_type |= (ESCO_HV2);
676 }
677
678 if (hdev->features[1] & LMP_HV3) {
679 hdev->pkt_type |= (HCI_HV3);
680 hdev->esco_type |= (ESCO_HV3);
681 }
682
683 if (hdev->features[3] & LMP_ESCO)
684 hdev->esco_type |= (ESCO_EV3);
685
686 if (hdev->features[4] & LMP_EV4)
687 hdev->esco_type |= (ESCO_EV4);
688
689 if (hdev->features[4] & LMP_EV5)
690 hdev->esco_type |= (ESCO_EV5);
691
Marcel Holtmannefc76882009-02-06 09:13:37 +0100692 if (hdev->features[5] & LMP_EDR_ESCO_2M)
693 hdev->esco_type |= (ESCO_2EV3);
694
695 if (hdev->features[5] & LMP_EDR_ESCO_3M)
696 hdev->esco_type |= (ESCO_3EV3);
697
698 if (hdev->features[5] & LMP_EDR_3S_ESCO)
699 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
700
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200701 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
702 hdev->features[0], hdev->features[1],
703 hdev->features[2], hdev->features[3],
704 hdev->features[4], hdev->features[5],
705 hdev->features[6], hdev->features[7]);
706}
707
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700708static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
709 struct sk_buff *skb)
Andre Guedesd5fa5132011-06-30 19:20:52 -0300710{
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700711 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
Andre Guedesd5fa5132011-06-30 19:20:52 -0300712
713 BT_DBG("%s status 0x%x", hdev->name, rp->status);
714
715 if (rp->status)
716 return;
717
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700718 hdev->flow_ctl_mode = rp->mode;
Andre Guedesd5fa5132011-06-30 19:20:52 -0300719}
720
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200721static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
722{
723 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
724
725 BT_DBG("%s status 0x%x", hdev->name, rp->status);
726
727 if (rp->status)
728 return;
729
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700730 if (hdev->flow_ctl_mode == HCI_PACKET_BASED_FLOW_CTL_MODE) {
731 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
732 hdev->sco_mtu = rp->sco_mtu;
733 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
734 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
735 hdev->acl_cnt = hdev->acl_pkts;
736 hdev->sco_cnt = hdev->sco_pkts;
737 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200738
739 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
740 hdev->sco_mtu = 64;
741 hdev->sco_pkts = 8;
742 }
743
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200744
745 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
746 hdev->acl_mtu, hdev->acl_pkts,
747 hdev->sco_mtu, hdev->sco_pkts);
748}
749
750static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
751{
752 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
753
754 BT_DBG("%s status 0x%x", hdev->name, rp->status);
755
756 if (!rp->status)
757 bacpy(&hdev->bdaddr, &rp->bdaddr);
758
Johan Hedberg23bb5762010-12-21 23:01:27 +0200759 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
760}
761
762static void hci_cc_write_ca_timeout(struct hci_dev *hdev, 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_WRITE_CA_TIMEOUT, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200769}
770
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700771static void hci_cc_read_data_block_size(struct hci_dev *hdev,
772 struct sk_buff *skb)
773{
774 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
775
776 BT_DBG("%s status 0x%x", hdev->name, rp->status);
777
778 if (rp->status)
779 return;
780
781 if (hdev->flow_ctl_mode == HCI_BLOCK_BASED_FLOW_CTL_MODE) {
782 hdev->acl_mtu = __le16_to_cpu(rp->max_acl_len);
783 hdev->sco_mtu = 0;
784 hdev->data_block_len = __le16_to_cpu(rp->data_block_len);
785 /* acl_pkts indicates the number of blocks */
786 hdev->acl_pkts = __le16_to_cpu(rp->num_blocks);
787 hdev->sco_pkts = 0;
788 hdev->acl_cnt = hdev->acl_pkts;
789 hdev->sco_cnt = 0;
790 }
791
792 BT_DBG("%s acl mtu %d:%d, data block len %d", hdev->name,
793 hdev->acl_mtu, hdev->acl_cnt, hdev->data_block_len);
794}
795
796static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
797 struct sk_buff *skb)
798{
799 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
800
801 BT_DBG("%s status 0x%x", hdev->name, rp->status);
802
803 if (rp->status)
804 return;
805
806 hdev->amp_status = rp->amp_status;
807 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
808 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
809 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
810 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
811 hdev->amp_type = rp->amp_type;
812 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
813 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
814 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
815 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
816
817 hci_req_complete(hdev, HCI_OP_READ_LOCAL_AMP_INFO, rp->status);
818}
819
Johan Hedbergb0916ea2011-01-10 13:44:55 +0200820static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
821 struct sk_buff *skb)
822{
823 __u8 status = *((__u8 *) skb->data);
824
825 BT_DBG("%s status 0x%x", hdev->name, status);
826
827 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
828}
829
Johan Hedbergd5859e22011-01-25 01:19:58 +0200830static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
831{
832 __u8 status = *((__u8 *) skb->data);
833
834 BT_DBG("%s status 0x%x", hdev->name, status);
835
836 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
837}
838
839static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
840 struct sk_buff *skb)
841{
842 __u8 status = *((__u8 *) skb->data);
843
844 BT_DBG("%s status 0x%x", hdev->name, status);
845
846 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
847}
848
849static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
850 struct sk_buff *skb)
851{
852 __u8 status = *((__u8 *) skb->data);
853
854 BT_DBG("%s status 0x%x", hdev->name, status);
855
856 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
857}
858
859static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
860{
861 __u8 status = *((__u8 *) skb->data);
862
863 BT_DBG("%s status 0x%x", hdev->name, status);
864
865 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
866}
867
Johan Hedberg980e1a52011-01-22 06:10:07 +0200868static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
869{
870 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
871 struct hci_cp_pin_code_reply *cp;
872 struct hci_conn *conn;
873
874 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800875 hci_dev_lock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200876
877 if (test_bit(HCI_MGMT, &hdev->flags))
878 mgmt_pin_code_reply_complete(hdev->id, &rp->bdaddr, rp->status);
879
880 if (rp->status != 0)
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800881 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200882
883 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
884 if (!cp)
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800885 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200886
887 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
888 if (conn)
889 conn->pin_length = cp->pin_len;
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800890unlock:
891 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200892}
893
894static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
895{
896 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
897
898 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800899 hci_dev_lock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200900
901 if (test_bit(HCI_MGMT, &hdev->flags))
902 mgmt_pin_code_neg_reply_complete(hdev->id, &rp->bdaddr,
903 rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800904 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200905}
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300906static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
907 struct sk_buff *skb)
908{
909 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
910
911 BT_DBG("%s status 0x%x", hdev->name, rp->status);
912
913 if (rp->status)
914 return;
915
916 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
917 hdev->le_pkts = rp->le_max_pkt;
918
919 hdev->le_cnt = hdev->le_pkts;
920
921 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
922
923 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
924}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200925
Sunny Kapdi320598f2012-07-30 14:52:56 -0700926static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
927 struct sk_buff *skb)
928{
929 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
930
931 BT_DBG("%s status 0x%x", hdev->name, rp->status);
932
933 if (rp->status)
934 return;
935
936 hdev->le_white_list_size = rp->size;
937
938 BT_DBG("%s le white list %d", hdev->name, hdev->le_white_list_size);
939
940 hci_req_complete(hdev, HCI_OP_LE_READ_WHITE_LIST_SIZE, rp->status);
941}
942
Johan Hedberga5c29682011-02-19 12:05:57 -0300943static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
944{
945 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
946
947 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800948 hci_dev_lock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300949
950 if (test_bit(HCI_MGMT, &hdev->flags))
951 mgmt_user_confirm_reply_complete(hdev->id, &rp->bdaddr,
952 rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800953 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300954}
955
956static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
957 struct sk_buff *skb)
958{
959 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
960
961 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800962 hci_dev_lock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300963
964 if (test_bit(HCI_MGMT, &hdev->flags))
965 mgmt_user_confirm_neg_reply_complete(hdev->id, &rp->bdaddr,
966 rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800967 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300968}
969
Archana Ramachandran26a752b2011-12-20 11:27:40 -0800970static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
971{
972 struct hci_conn *conn;
973 struct hci_rp_read_rssi *rp = (void *) skb->data;
974
975 BT_DBG("%s status 0x%x", hdev->name, rp->status);
976
977 BT_DBG("%s rssi : %d handle : %d", hdev->name, rp->rssi, rp->handle);
978
979 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
980 if (conn)
981 mgmt_read_rssi_complete(hdev->id, rp->rssi, &conn->dst,
982 __le16_to_cpu(rp->handle), rp->status);
983}
984
Szymon Jancc35938b2011-03-22 13:12:21 +0100985static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
986 struct sk_buff *skb)
987{
988 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
989
990 BT_DBG("%s status 0x%x", hdev->name, rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800991 hci_dev_lock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +0100992
993 mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
994 rp->randomizer, rp->status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -0800995 hci_dev_unlock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +0100996}
997
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -0300998static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
999{
1000 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
1001
1002 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1003
1004 if (rp->status)
1005 return;
1006
1007 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
1008}
1009
1010static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
1011{
1012 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
1013
1014 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1015
1016 if (rp->status)
1017 return;
1018
1019 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
1020}
1021
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001022static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
1023 struct sk_buff *skb)
Andre Guedese326af42011-06-30 19:20:53 -03001024{
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001025 void *sent;
1026 __u8 param_scan_enable;
Andre Guedese326af42011-06-30 19:20:53 -03001027 __u8 status = *((__u8 *) skb->data);
1028
Andre Guedese326af42011-06-30 19:20:53 -03001029 if (status)
1030 return;
1031
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001032 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
1033 if (!sent)
1034 return;
1035
1036 param_scan_enable = *((__u8 *) sent);
1037 if (param_scan_enable == 0x01) {
1038 del_timer(&hdev->adv_timer);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001039 } else if (param_scan_enable == 0x00) {
1040 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
1041 }
Andre Guedese326af42011-06-30 19:20:53 -03001042}
1043
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001044static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
1045{
1046 BT_DBG("%s status 0x%x", hdev->name, status);
1047
1048 if (status) {
Johan Hedberg23bb5762010-12-21 23:01:27 +02001049 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Johan Hedberg314b2382011-04-27 10:29:57 -04001050
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001051 hci_conn_check_pending(hdev);
Brian Gixa68668b2011-08-11 15:49:36 -07001052 } else {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001053 set_bit(HCI_INQUIRY, &hdev->flags);
Subramanian Srinivasana727a492011-11-30 13:06:07 -08001054 hci_dev_lock(hdev);
Brian Gixa68668b2011-08-11 15:49:36 -07001055 if (test_bit(HCI_MGMT, &hdev->flags))
1056 mgmt_inquiry_started(hdev->id);
Subramanian Srinivasana727a492011-11-30 13:06:07 -08001057 hci_dev_unlock(hdev);
Brian Gixa68668b2011-08-11 15:49:36 -07001058 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001059}
1060
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
1062{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001063 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001065
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001066 BT_DBG("%s status 0x%x", hdev->name, status);
1067
1068 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001069 if (!cp)
1070 return;
1071
1072 hci_dev_lock(hdev);
1073
1074 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1075
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001076 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001077
1078 if (status) {
1079 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001080 if (status != 0x0c || conn->attempt > 2) {
1081 conn->state = BT_CLOSED;
1082 hci_proto_connect_cfm(conn, status);
1083 hci_conn_del(conn);
1084 } else
1085 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001086 }
1087 } else {
1088 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001089 conn = hci_conn_add(hdev, ACL_LINK, 0, &cp->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001090 if (conn) {
1091 conn->out = 1;
1092 conn->link_mode |= HCI_LM_MASTER;
1093 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001094 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001095 }
1096 }
1097
1098 hci_dev_unlock(hdev);
1099}
1100
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001101static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001102{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001103 struct hci_cp_add_sco *cp;
1104 struct hci_conn *acl, *sco;
1105 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001106
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001107 BT_DBG("%s status 0x%x", hdev->name, status);
1108
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001109 if (!status)
1110 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001112 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1113 if (!cp)
1114 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001116 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001117
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001118 BT_DBG("%s handle %d", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001119
1120 hci_dev_lock(hdev);
1121
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001122 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001123 if (acl) {
1124 sco = acl->link;
1125 if (sco) {
1126 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001127
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001128 hci_proto_connect_cfm(sco, status);
1129 hci_conn_del(sco);
1130 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001131 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001132
1133 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001134}
1135
Marcel Holtmannf8558552008-07-14 20:13:49 +02001136static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1137{
1138 struct hci_cp_auth_requested *cp;
1139 struct hci_conn *conn;
1140
1141 BT_DBG("%s status 0x%x", hdev->name, status);
1142
Marcel Holtmannf8558552008-07-14 20:13:49 +02001143 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1144 if (!cp)
1145 return;
1146
1147 hci_dev_lock(hdev);
1148
1149 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1150 if (conn) {
Prabhakaran Mc7953ca72012-03-06 20:43:46 +05301151 if (status) {
1152 mgmt_auth_failed(hdev->id, &conn->dst, status);
1153 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1154
1155 if (conn->state == BT_CONFIG) {
1156 conn->state = BT_CONNECTED;
1157 hci_proto_connect_cfm(conn, status);
1158 hci_conn_put(conn);
1159 } else {
1160 hci_auth_cfm(conn, status);
1161 hci_conn_hold(conn);
1162 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1163 hci_conn_put(conn);
1164 }
1165
1166 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1167 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1168 hci_encrypt_cfm(conn, status, 0x00);
1169 }
Marcel Holtmannf8558552008-07-14 20:13:49 +02001170 }
Srinivas Krovvidi9ff51452011-09-27 19:25:02 +05301171 conn->auth_initiator = 1;
Marcel Holtmannf8558552008-07-14 20:13:49 +02001172 }
1173
1174 hci_dev_unlock(hdev);
1175}
1176
1177static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1178{
1179 struct hci_cp_set_conn_encrypt *cp;
1180 struct hci_conn *conn;
1181
1182 BT_DBG("%s status 0x%x", hdev->name, status);
1183
1184 if (!status)
1185 return;
1186
1187 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1188 if (!cp)
1189 return;
1190
1191 hci_dev_lock(hdev);
1192
1193 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1194 if (conn) {
1195 if (conn->state == BT_CONFIG) {
1196 hci_proto_connect_cfm(conn, status);
1197 hci_conn_put(conn);
1198 }
1199 }
1200
1201 hci_dev_unlock(hdev);
1202}
1203
Johan Hedberg127178d2010-11-18 22:22:29 +02001204static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Szymon Janc138d22e2011-02-17 16:44:23 +01001205 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001206{
Johan Hedberg392599b2010-11-18 22:22:28 +02001207 if (conn->state != BT_CONFIG || !conn->out)
1208 return 0;
1209
Johan Hedberg765c2a92011-01-19 12:06:52 +05301210 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001211 return 0;
1212
1213 /* Only request authentication for SSP connections or non-SSP
Prabhakaran Mc6001a712011-09-06 11:56:25 +05301214 * devices with sec_level >= BT_SECURITY_MEDIUM*/
1215 BT_DBG("Pending sec level is %d", conn->pending_sec_level);
Johan Hedberg392599b2010-11-18 22:22:28 +02001216 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
Prabhakaran Mc6001a712011-09-06 11:56:25 +05301217 conn->pending_sec_level < BT_SECURITY_MEDIUM)
Johan Hedberg392599b2010-11-18 22:22:28 +02001218 return 0;
1219
Johan Hedberg392599b2010-11-18 22:22:28 +02001220 return 1;
1221}
1222
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001223static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1224{
Johan Hedberg127178d2010-11-18 22:22:29 +02001225 struct hci_cp_remote_name_req *cp;
1226 struct hci_conn *conn;
1227
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001228 BT_DBG("%s status 0x%x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001229
1230 /* If successful wait for the name req complete event before
1231 * checking for the need to do authentication */
1232 if (!status)
1233 return;
1234
1235 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1236 if (!cp)
1237 return;
1238
1239 hci_dev_lock(hdev);
1240
1241 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001242 if (conn && hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001243 struct hci_cp_auth_requested cp;
1244 cp.handle = __cpu_to_le16(conn->handle);
1245 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1246 }
1247
1248 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001249}
1250
Marcel Holtmann769be972008-07-14 20:13:49 +02001251static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1252{
1253 struct hci_cp_read_remote_features *cp;
1254 struct hci_conn *conn;
1255
1256 BT_DBG("%s status 0x%x", hdev->name, status);
1257
1258 if (!status)
1259 return;
1260
1261 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1262 if (!cp)
1263 return;
1264
1265 hci_dev_lock(hdev);
1266
1267 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1268 if (conn) {
1269 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001270 hci_proto_connect_cfm(conn, status);
1271 hci_conn_put(conn);
1272 }
1273 }
1274
1275 hci_dev_unlock(hdev);
1276}
1277
1278static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1279{
1280 struct hci_cp_read_remote_ext_features *cp;
1281 struct hci_conn *conn;
1282
1283 BT_DBG("%s status 0x%x", hdev->name, status);
1284
1285 if (!status)
1286 return;
1287
1288 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1289 if (!cp)
1290 return;
1291
1292 hci_dev_lock(hdev);
1293
1294 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1295 if (conn) {
1296 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001297 hci_proto_connect_cfm(conn, status);
1298 hci_conn_put(conn);
1299 }
1300 }
1301
1302 hci_dev_unlock(hdev);
1303}
1304
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001305static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1306{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001307 struct hci_cp_setup_sync_conn *cp;
1308 struct hci_conn *acl, *sco;
1309 __u16 handle;
1310
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001311 BT_DBG("%s status 0x%x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001312
1313 if (!status)
1314 return;
1315
1316 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1317 if (!cp)
1318 return;
1319
1320 handle = __le16_to_cpu(cp->handle);
1321
1322 BT_DBG("%s handle %d", hdev->name, handle);
1323
1324 hci_dev_lock(hdev);
1325
1326 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001327 if (acl) {
1328 sco = acl->link;
1329 if (sco) {
1330 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001331
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001332 hci_proto_connect_cfm(sco, status);
1333 hci_conn_del(sco);
1334 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001335 }
1336
1337 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001338}
1339
1340static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1341{
1342 struct hci_cp_sniff_mode *cp;
1343 struct hci_conn *conn;
1344
1345 BT_DBG("%s status 0x%x", hdev->name, status);
1346
1347 if (!status)
1348 return;
1349
1350 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1351 if (!cp)
1352 return;
1353
1354 hci_dev_lock(hdev);
1355
1356 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001357 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001358 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1359
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001360 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1361 hci_sco_setup(conn, status);
1362 }
1363
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001364 hci_dev_unlock(hdev);
1365}
1366
1367static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1368{
1369 struct hci_cp_exit_sniff_mode *cp;
1370 struct hci_conn *conn;
1371
1372 BT_DBG("%s status 0x%x", hdev->name, status);
1373
1374 if (!status)
1375 return;
1376
1377 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1378 if (!cp)
1379 return;
1380
1381 hci_dev_lock(hdev);
1382
1383 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001384 if (conn) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001385 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1386
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001387 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1388 hci_sco_setup(conn, status);
1389 }
1390
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001391 hci_dev_unlock(hdev);
1392}
1393
Ville Tervofcd89c02011-02-10 22:38:47 -03001394static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1395{
1396 struct hci_cp_le_create_conn *cp;
1397 struct hci_conn *conn;
Brian Gixa94b6122012-02-23 16:07:10 -08001398 unsigned long exp = msecs_to_jiffies(5000);
Ville Tervofcd89c02011-02-10 22:38:47 -03001399
1400 BT_DBG("%s status 0x%x", hdev->name, status);
1401
1402 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1403 if (!cp)
1404 return;
1405
1406 hci_dev_lock(hdev);
1407
1408 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1409
1410 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1411 conn);
1412
1413 if (status) {
1414 if (conn && conn->state == BT_CONNECT) {
1415 conn->state = BT_CLOSED;
1416 hci_proto_connect_cfm(conn, status);
1417 hci_conn_del(conn);
1418 }
1419 } else {
1420 if (!conn) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001421 conn = hci_le_conn_add(hdev, &cp->peer_addr,
1422 cp->peer_addr_type);
1423 if (conn)
Ville Tervofcd89c02011-02-10 22:38:47 -03001424 conn->out = 1;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001425 else
Ville Tervofcd89c02011-02-10 22:38:47 -03001426 BT_ERR("No memory for new connection");
Brian Gixa94b6122012-02-23 16:07:10 -08001427 } else
1428 exp = msecs_to_jiffies(conn->conn_timeout * 1000);
Brian Gix114f3a62011-09-27 14:02:20 -07001429
Brian Gixa94b6122012-02-23 16:07:10 -08001430 if (conn && exp)
1431 mod_timer(&conn->disc_timer, jiffies + exp);
Ville Tervofcd89c02011-02-10 22:38:47 -03001432 }
1433
1434 hci_dev_unlock(hdev);
1435}
1436
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001437static void hci_cs_accept_logical_link(struct hci_dev *hdev, __u8 status)
1438{
1439 struct hci_cp_create_logical_link *ap;
1440 struct hci_chan *chan;
1441
1442 BT_DBG("%s status 0x%x", hdev->name, status);
1443
1444 ap = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_LOGICAL_LINK);
1445 if (!ap)
1446 return;
1447
1448 hci_dev_lock(hdev);
1449
1450 chan = hci_chan_list_lookup_id(hdev, ap->phy_handle);
1451
1452 BT_DBG("%s chan %p", hdev->name, chan);
1453
1454 if (status) {
1455 if (chan && chan->state == BT_CONNECT) {
1456 chan->state = BT_CLOSED;
1457 hci_proto_create_cfm(chan, status);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001458 }
Mat Martineau9f8d4672011-12-14 12:10:46 -08001459 } else if (chan) {
1460 chan->state = BT_CONNECT2;
1461 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001462
1463 hci_dev_unlock(hdev);
1464}
1465
1466static void hci_cs_create_logical_link(struct hci_dev *hdev, __u8 status)
1467{
1468 struct hci_cp_create_logical_link *cp;
1469 struct hci_chan *chan;
1470
1471 BT_DBG("%s status 0x%x", hdev->name, status);
1472
1473 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_LOGICAL_LINK);
1474 if (!cp)
1475 return;
1476
1477 hci_dev_lock(hdev);
1478
1479 chan = hci_chan_list_lookup_id(hdev, cp->phy_handle);
1480
1481 BT_DBG("%s chan %p", hdev->name, chan);
1482
1483 if (status) {
1484 if (chan && chan->state == BT_CONNECT) {
1485 chan->state = BT_CLOSED;
1486 hci_proto_create_cfm(chan, status);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001487 }
1488 } else if (chan)
1489 chan->state = BT_CONNECT2;
1490
1491 hci_dev_unlock(hdev);
1492}
1493
1494static void hci_cs_flow_spec_modify(struct hci_dev *hdev, __u8 status)
1495{
1496 struct hci_cp_flow_spec_modify *cp;
1497 struct hci_chan *chan;
1498
1499 BT_DBG("%s status 0x%x", hdev->name, status);
1500
1501 cp = hci_sent_cmd_data(hdev, HCI_OP_FLOW_SPEC_MODIFY);
1502 if (!cp)
1503 return;
1504
1505 hci_dev_lock(hdev);
1506
1507 chan = hci_chan_list_lookup_handle(hdev, cp->log_handle);
1508 if (chan) {
1509 if (status)
1510 hci_proto_modify_cfm(chan, status);
1511 else {
1512 chan->tx_fs = cp->tx_fs;
1513 chan->rx_fs = cp->rx_fs;
1514 }
1515 }
1516
1517 hci_dev_unlock(hdev);
1518}
1519
1520static void hci_cs_disconn_logical_link(struct hci_dev *hdev, __u8 status)
1521{
1522 struct hci_cp_disconn_logical_link *cp;
1523 struct hci_chan *chan;
1524
1525 if (!status)
1526 return;
1527
1528 BT_DBG("%s status 0x%x", hdev->name, status);
1529
1530 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONN_LOGICAL_LINK);
1531 if (!cp)
1532 return;
1533
1534 hci_dev_lock(hdev);
1535
1536 chan = hci_chan_list_lookup_handle(hdev, cp->log_handle);
1537 if (chan)
1538 hci_chan_del(chan);
1539
1540 hci_dev_unlock(hdev);
1541}
1542
1543static void hci_cs_disconn_physical_link(struct hci_dev *hdev, __u8 status)
1544{
1545 struct hci_cp_disconn_phys_link *cp;
1546 struct hci_conn *conn;
1547
1548 if (!status)
1549 return;
1550
1551 BT_DBG("%s status 0x%x", hdev->name, status);
1552
1553 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONN_PHYS_LINK);
1554 if (!cp)
1555 return;
1556
1557 hci_dev_lock(hdev);
1558
1559 conn = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1560 if (conn) {
1561 conn->state = BT_CLOSED;
1562 hci_conn_del(conn);
1563 }
1564
1565 hci_dev_unlock(hdev);
1566}
1567
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03001568static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1569{
1570 BT_DBG("%s status 0x%x", hdev->name, status);
1571}
1572
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001573static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1574{
1575 __u8 status = *((__u8 *) skb->data);
1576
1577 BT_DBG("%s status %d", hdev->name, status);
1578
Royston Rodrigues1670f382012-02-28 21:39:10 +05301579 if (!hdev->disco_state)
Brian Gixa68668b2011-08-11 15:49:36 -07001580 clear_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001581
Johan Hedberg23bb5762010-12-21 23:01:27 +02001582 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -08001583 hci_dev_lock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001584
Brian Gixa68668b2011-08-11 15:49:36 -07001585 if (test_bit(HCI_MGMT, &hdev->flags))
1586 mgmt_inquiry_complete_evt(hdev->id, status);
Subramanian Srinivasana727a492011-11-30 13:06:07 -08001587 hci_dev_unlock(hdev);
Brian Gixa68668b2011-08-11 15:49:36 -07001588
1589 if (!lmp_le_capable(hdev))
1590 hci_conn_check_pending(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001591}
1592
Linus Torvalds1da177e2005-04-16 15:20:36 -07001593static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1594{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001595 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001596 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001597 int num_rsp = *((__u8 *) skb->data);
1598
1599 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1600
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001601 if (!num_rsp)
1602 return;
1603
Linus Torvalds1da177e2005-04-16 15:20:36 -07001604 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001605
Johan Hedberge17acd42011-03-30 23:57:16 +03001606 for (; num_rsp; num_rsp--, info++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001607 bacpy(&data.bdaddr, &info->bdaddr);
1608 data.pscan_rep_mode = info->pscan_rep_mode;
1609 data.pscan_period_mode = info->pscan_period_mode;
1610 data.pscan_mode = info->pscan_mode;
1611 memcpy(data.dev_class, info->dev_class, 3);
1612 data.clock_offset = info->clock_offset;
1613 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001614 data.ssp_mode = 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615 hci_inquiry_cache_update(hdev, &data);
Brian Gixa68668b2011-08-11 15:49:36 -07001616 mgmt_device_found(hdev->id, &info->bdaddr, 0, 0,
1617 info->dev_class, 0, 0, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001618 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001619
Linus Torvalds1da177e2005-04-16 15:20:36 -07001620 hci_dev_unlock(hdev);
1621}
1622
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001623static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001624{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001625 struct hci_ev_conn_complete *ev = (void *) skb->data;
1626 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001628 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001629
Linus Torvalds1da177e2005-04-16 15:20:36 -07001630 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001631
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001632 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001633 if (!conn) {
1634 if (ev->link_type != SCO_LINK)
1635 goto unlock;
1636
1637 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1638 if (!conn)
1639 goto unlock;
1640
1641 conn->type = SCO_LINK;
1642 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001643
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001644 if (!ev->status) {
1645 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001646
1647 if (conn->type == ACL_LINK) {
1648 conn->state = BT_CONFIG;
1649 hci_conn_hold(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001650 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Brian Gix2e2f50d2011-09-13 12:36:04 -07001651 mgmt_connected(hdev->id, &ev->bdaddr, 0);
Brian Gixa68668b2011-08-11 15:49:36 -07001652 } else if (conn->type == LE_LINK) {
1653 conn->state = BT_CONNECTED;
1654 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Brian Gix2e2f50d2011-09-13 12:36:04 -07001655 mgmt_connected(hdev->id, &ev->bdaddr, 1);
Marcel Holtmann769be972008-07-14 20:13:49 +02001656 } else
1657 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001658
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001659 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001660 hci_conn_add_sysfs(conn);
1661
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001662 if (test_bit(HCI_AUTH, &hdev->flags))
1663 conn->link_mode |= HCI_LM_AUTH;
1664
1665 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1666 conn->link_mode |= HCI_LM_ENCRYPT;
1667
Srinivas Krovvidid352b262012-01-12 19:46:26 +05301668 /* Get remote version */
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001669 if (conn->type == ACL_LINK) {
Srinivas Krovvidid352b262012-01-12 19:46:26 +05301670 struct hci_cp_read_remote_version cp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001671 cp.handle = ev->handle;
Srinivas Krovvidid352b262012-01-12 19:46:26 +05301672 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_VERSION,
1673 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001674 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001675
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001676 /* Set packet type for incoming connection */
Marcel Holtmanna8746412008-07-14 20:13:46 +02001677 if (!conn->out && hdev->hci_ver < 3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001678 struct hci_cp_change_conn_ptype cp;
1679 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001680 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1681 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1682 sizeof(cp), &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001683 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001684 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001685 conn->state = BT_CLOSED;
Brian Gixa68668b2011-08-11 15:49:36 -07001686 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Johan Hedberg17d5c042011-01-22 06:09:08 +02001687 mgmt_connect_failed(hdev->id, &ev->bdaddr, ev->status);
1688 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001689
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001690 if (conn->type == ACL_LINK)
1691 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001692
Marcel Holtmann769be972008-07-14 20:13:49 +02001693 if (ev->status) {
1694 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001695 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001696 } else if (ev->link_type != ACL_LINK)
1697 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001698
1699unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001700 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001701
1702 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001703}
1704
hyungseoung.yoodbb18fb2011-11-18 13:57:01 +09001705static inline bool is_sco_active(struct hci_dev *hdev)
1706{
1707 if (hci_conn_hash_lookup_state(hdev, SCO_LINK, BT_CONNECTED) ||
1708 (hci_conn_hash_lookup_state(hdev, ESCO_LINK,
1709 BT_CONNECTED)))
1710 return true;
1711 return false;
1712}
1713
Linus Torvalds1da177e2005-04-16 15:20:36 -07001714static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1715{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001716 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001717 int mask = hdev->link_mode;
1718
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001719 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1720 batostr(&ev->bdaddr), ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721
1722 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1723
Szymon Janc138d22e2011-02-17 16:44:23 +01001724 if ((mask & HCI_LM_ACCEPT) &&
1725 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001726 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001727 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001728 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001729
1730 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001731
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001732 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1733 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001734 memcpy(ie->data.dev_class, ev->dev_class, 3);
1735
Linus Torvalds1da177e2005-04-16 15:20:36 -07001736 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1737 if (!conn) {
Nick Pellybbcda3b2010-02-11 11:54:28 -08001738 /* pkt_type not yet used for incoming connections */
1739 conn = hci_conn_add(hdev, ev->link_type, 0, &ev->bdaddr);
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001740 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001741 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001742 hci_dev_unlock(hdev);
1743 return;
1744 }
1745 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001746
Linus Torvalds1da177e2005-04-16 15:20:36 -07001747 memcpy(conn->dev_class, ev->dev_class, 3);
Srinivas Krovvidi0916aed2011-12-20 12:06:34 +05301748 /* For incoming connection update remote class to userspace */
1749 mgmt_remote_class(hdev->id, &ev->bdaddr, ev->dev_class);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001750 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001751
Linus Torvalds1da177e2005-04-16 15:20:36 -07001752 hci_dev_unlock(hdev);
1753
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001754 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1755 struct hci_cp_accept_conn_req cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001756
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001757 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001758
hyungseoung.yoodbb18fb2011-11-18 13:57:01 +09001759 if (lmp_rswitch_capable(hdev) && ((mask & HCI_LM_MASTER)
1760 || is_sco_active(hdev)))
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001761 cp.role = 0x00; /* Become master */
1762 else
1763 cp.role = 0x01; /* Remain slave */
1764
1765 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1766 sizeof(cp), &cp);
1767 } else {
1768 struct hci_cp_accept_sync_conn_req cp;
1769
1770 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001771 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001772
1773 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1774 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001775 cp.max_latency = cpu_to_le16(0x000A);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001776 cp.content_format = cpu_to_le16(hdev->voice_setting);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001777 cp.retrans_effort = 0x01;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001778
1779 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1780 sizeof(cp), &cp);
1781 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001782 } else {
1783 /* Connection rejected */
1784 struct hci_cp_reject_conn_req cp;
1785
1786 bacpy(&cp.bdaddr, &ev->bdaddr);
1787 cp.reason = 0x0f;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001788 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001789 }
1790}
1791
Linus Torvalds1da177e2005-04-16 15:20:36 -07001792static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1793{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001794 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001795 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001796
Archana Ramachandranb2f194d2012-08-14 12:03:01 -07001797 BT_DBG("%s status %d reason %d", hdev->name, ev->status, ev->reason);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001798
Johan Hedberg8962ee72011-01-20 12:40:27 +02001799 if (ev->status) {
Subramanian Srinivasana727a492011-11-30 13:06:07 -08001800 hci_dev_lock(hdev);
Johan Hedberg8962ee72011-01-20 12:40:27 +02001801 mgmt_disconnect_failed(hdev->id);
Subramanian Srinivasana727a492011-11-30 13:06:07 -08001802 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001803 return;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001804 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001805
1806 hci_dev_lock(hdev);
1807
Marcel Holtmann04837f62006-07-03 10:02:33 +02001808 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001809 if (!conn)
1810 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001811
Johan Hedbergf7520542011-01-20 12:34:39 +02001812 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001813
Brian Gixa68668b2011-08-11 15:49:36 -07001814 if (conn->type == ACL_LINK || conn->type == LE_LINK)
Archana Ramachandranb2f194d2012-08-14 12:03:01 -07001815 mgmt_disconnected(hdev->id, &conn->dst, ev->reason);
Johan Hedbergf7520542011-01-20 12:34:39 +02001816
Brian Gixe9ceb522011-09-22 10:46:35 -07001817 if (conn->type == LE_LINK)
1818 del_timer(&conn->smp_timer);
1819
Mat Martineau3b9239a2012-02-16 11:54:30 -08001820 hci_proto_disconn_cfm(conn, ev->reason, 0);
Johan Hedbergf7520542011-01-20 12:34:39 +02001821 hci_conn_del(conn);
1822
1823unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001824 hci_dev_unlock(hdev);
1825}
1826
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001827static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1828{
1829 struct hci_ev_auth_complete *ev = (void *) skb->data;
1830 struct hci_conn *conn;
1831
1832 BT_DBG("%s status %d", hdev->name, ev->status);
1833
1834 hci_dev_lock(hdev);
1835
1836 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001837 if (conn) {
1838 if (ev->status == 0x06 && hdev->ssp_mode > 0 &&
1839 conn->ssp_mode > 0) {
1840 struct hci_cp_auth_requested cp;
Prabhakaran Mcb04401d2011-09-20 17:37:55 +05301841 hci_remove_link_key(hdev, &conn->dst);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001842 cp.handle = cpu_to_le16(conn->handle);
Royston Rodrigues45df0f92012-05-30 10:26:42 +05301843 /*Initiates dedicated bonding as pin or key is missing
1844 on remote device*/
1845 /*In case if remote device is ssp supported,
1846 reduce the security level to MEDIUM if it is HIGH*/
1847 if (conn->ssp_mode && conn->auth_initiator &&
1848 conn->io_capability != 0x03) {
1849 conn->pending_sec_level = BT_SECURITY_HIGH;
1850 conn->auth_type = HCI_AT_DEDICATED_BONDING_MITM;
1851 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001852 hci_send_cmd(conn->hdev, HCI_OP_AUTH_REQUESTED,
1853 sizeof(cp), &cp);
1854 hci_dev_unlock(hdev);
1855 BT_INFO("Pin or key missing");
1856 return;
1857 }
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001858
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001859 if (!ev->status) {
Waldemar Rymarkiewicz54444292011-05-31 15:49:26 +02001860 conn->link_mode |= HCI_LM_AUTH;
1861 conn->sec_level = conn->pending_sec_level;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001862 } else {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001863 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
1864 conn->sec_level = BT_SECURITY_LOW;
1865 }
1866
1867 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1868
1869 if (conn->state == BT_CONFIG) {
1870 if (!ev->status && hdev->ssp_mode > 0 &&
1871 conn->ssp_mode > 0) {
1872 struct hci_cp_set_conn_encrypt cp;
1873 cp.handle = ev->handle;
1874 cp.encrypt = 0x01;
1875 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT,
1876 sizeof(cp), &cp);
1877 } else {
1878 conn->state = BT_CONNECTED;
1879 hci_proto_connect_cfm(conn, ev->status);
1880 hci_conn_put(conn);
1881 }
1882 } else {
1883 hci_auth_cfm(conn, ev->status);
1884
1885 hci_conn_hold(conn);
1886 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001887 hci_conn_put(conn);
1888 }
1889
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001890 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1891 if (!ev->status) {
Prabhakaran Mc48584712012-04-20 15:47:58 +05301892 if (conn->link_mode & HCI_LM_ENCRYPT) {
1893 /* Encryption implies authentication */
1894 conn->link_mode |= HCI_LM_AUTH;
1895 conn->link_mode |= HCI_LM_ENCRYPT;
1896 conn->sec_level =
1897 conn->pending_sec_level;
1898 clear_bit(HCI_CONN_ENCRYPT_PEND,
1899 &conn->pend);
1900 hci_encrypt_cfm(conn, ev->status, 1);
1901
1902 if (test_bit(HCI_MGMT, &hdev->flags))
1903 mgmt_encrypt_change(hdev->id,
1904 &conn->dst,
1905 ev->status);
1906
1907 } else {
1908 struct hci_cp_set_conn_encrypt cp;
1909 cp.handle = ev->handle;
1910 cp.encrypt = 0x01;
1911 hci_send_cmd(hdev,
1912 HCI_OP_SET_CONN_ENCRYPT,
1913 sizeof(cp), &cp);
1914 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001915 } else {
1916 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1917 hci_encrypt_cfm(conn, ev->status, 0x00);
1918 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001919 }
1920 }
1921
1922 hci_dev_unlock(hdev);
1923}
1924
1925static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1926{
Johan Hedberg127178d2010-11-18 22:22:29 +02001927 struct hci_ev_remote_name *ev = (void *) skb->data;
1928 struct hci_conn *conn;
1929
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001930 BT_DBG("%s", hdev->name);
1931
1932 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001933
1934 hci_dev_lock(hdev);
1935
Brian Gixa68668b2011-08-11 15:49:36 -07001936 if (test_bit(HCI_MGMT, &hdev->flags))
1937 mgmt_remote_name(hdev->id, &ev->bdaddr, ev->status, ev->name);
Johan Hedberga88a9652011-03-30 13:18:12 +03001938
Johan Hedberg127178d2010-11-18 22:22:29 +02001939 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001940 if (conn && hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001941 struct hci_cp_auth_requested cp;
1942 cp.handle = __cpu_to_le16(conn->handle);
1943 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1944 }
1945
1946 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001947}
1948
1949static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1950{
1951 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1952 struct hci_conn *conn;
1953
1954 BT_DBG("%s status %d", hdev->name, ev->status);
1955
1956 hci_dev_lock(hdev);
1957
1958 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1959 if (conn) {
1960 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001961 if (ev->encrypt) {
1962 /* Encryption implies authentication */
1963 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001964 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomes64532ec2011-06-09 18:50:53 -03001965 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001966 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001967 conn->link_mode &= ~HCI_LM_ENCRYPT;
1968 }
1969
1970 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1971
Marcel Holtmannf8558552008-07-14 20:13:49 +02001972 if (conn->state == BT_CONFIG) {
1973 if (!ev->status)
1974 conn->state = BT_CONNECTED;
1975
1976 hci_proto_connect_cfm(conn, ev->status);
1977 hci_conn_put(conn);
Prabhakaran Mcafface82012-04-10 11:38:35 +05301978 } else {
1979 /*
1980 * If the remote device does not support
1981 * Pause Encryption, usually during the
1982 * roleSwitch we see Encryption disable
1983 * for short duration. Allow remote device
1984 * to disable encryption
1985 * for short duration in this case.
1986 */
1987 if ((ev->encrypt == 0) && (ev->status == 0) &&
1988 ((conn->features[5] & LMP_PAUSE_ENC) == 0)) {
1989 mod_timer(&conn->encrypt_pause_timer,
1990 jiffies + msecs_to_jiffies(500));
1991 BT_INFO("enc pause timer, enc_pend_flag set");
1992 } else {
1993 del_timer(&conn->encrypt_pause_timer);
1994 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
1995 }
1996 }
Prabhakaran Mc46230fa2011-11-30 18:11:21 +05301997
1998 if (test_bit(HCI_MGMT, &hdev->flags))
1999 mgmt_encrypt_change(hdev->id, &conn->dst, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002000 }
2001
2002 hci_dev_unlock(hdev);
2003}
2004
2005static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2006{
2007 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2008 struct hci_conn *conn;
2009
2010 BT_DBG("%s status %d", hdev->name, ev->status);
2011
2012 hci_dev_lock(hdev);
2013
2014 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2015 if (conn) {
2016 if (!ev->status)
2017 conn->link_mode |= HCI_LM_SECURE;
2018
2019 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
2020
2021 hci_key_change_cfm(conn, ev->status);
2022 }
2023
2024 hci_dev_unlock(hdev);
2025}
2026
2027static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2028{
2029 struct hci_ev_remote_features *ev = (void *) skb->data;
2030 struct hci_conn *conn;
2031
2032 BT_DBG("%s status %d", hdev->name, ev->status);
2033
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002034 hci_dev_lock(hdev);
2035
2036 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002037 if (!conn)
2038 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002039
Sunny Kapdif3caf882012-02-25 19:27:09 -08002040 if (!ev->status) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002041 memcpy(conn->features, ev->features, 8);
Sunny Kapdif3caf882012-02-25 19:27:09 -08002042 mgmt_remote_features(hdev->id, &conn->dst, ev->features);
2043 }
Johan Hedbergccd556f2010-11-10 17:11:51 +02002044
2045 if (conn->state != BT_CONFIG)
2046 goto unlock;
2047
2048 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2049 struct hci_cp_read_remote_ext_features cp;
2050 cp.handle = ev->handle;
2051 cp.page = 0x01;
2052 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Marcel Holtmann769be972008-07-14 20:13:49 +02002053 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002054 goto unlock;
Prabhakaran Mc9f08bfd2012-03-26 18:18:17 +05302055 } else if (!(lmp_ssp_capable(conn)) && conn->auth_initiator &&
2056 (conn->pending_sec_level == BT_SECURITY_HIGH)) {
2057 conn->pending_sec_level = BT_SECURITY_MEDIUM;
Johan Hedberg392599b2010-11-18 22:22:28 +02002058 }
2059
Johan Hedberg127178d2010-11-18 22:22:29 +02002060 if (!ev->status) {
2061 struct hci_cp_remote_name_req cp;
2062 memset(&cp, 0, sizeof(cp));
2063 bacpy(&cp.bdaddr, &conn->dst);
2064 cp.pscan_rep_mode = 0x02;
2065 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2066 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002067
Johan Hedberg127178d2010-11-18 22:22:29 +02002068 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002069 conn->state = BT_CONNECTED;
2070 hci_proto_connect_cfm(conn, ev->status);
2071 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002072 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002073
Johan Hedbergccd556f2010-11-10 17:11:51 +02002074unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002075 hci_dev_unlock(hdev);
2076}
2077
2078static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
2079{
Srinivas Krovvidid352b262012-01-12 19:46:26 +05302080 struct hci_ev_remote_version *ev = (void *) skb->data;
2081 struct hci_cp_read_remote_features cp;
2082 struct hci_conn *conn;
2083 BT_DBG("%s status %d", hdev->name, ev->status);
2084
2085 hci_dev_lock(hdev);
2086 cp.handle = ev->handle;
2087 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
2088 sizeof(cp), &cp);
2089
2090 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2091 if (!conn)
2092 goto unlock;
2093 if (!ev->status)
2094 mgmt_remote_version(hdev->id, &conn->dst, ev->lmp_ver,
2095 ev->manufacturer, ev->lmp_subver);
2096unlock:
2097 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002098}
2099
2100static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2101{
2102 BT_DBG("%s", hdev->name);
2103}
2104
2105static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2106{
2107 struct hci_ev_cmd_complete *ev = (void *) skb->data;
2108 __u16 opcode;
2109
2110 skb_pull(skb, sizeof(*ev));
2111
2112 opcode = __le16_to_cpu(ev->opcode);
2113
Bhasker Neti6f4ceb12012-06-26 16:48:18 +05302114 if (test_bit(HCI_RESET, &hdev->flags) && (opcode != HCI_OP_RESET))
2115 return;
2116
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002117 switch (opcode) {
2118 case HCI_OP_INQUIRY_CANCEL:
2119 hci_cc_inquiry_cancel(hdev, skb);
2120 break;
2121
2122 case HCI_OP_EXIT_PERIODIC_INQ:
2123 hci_cc_exit_periodic_inq(hdev, skb);
2124 break;
2125
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002126 case HCI_OP_LINK_KEY_REPLY:
2127 hci_cc_link_key_reply(hdev, skb);
2128 break;
2129
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002130 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2131 hci_cc_remote_name_req_cancel(hdev, skb);
2132 break;
2133
2134 case HCI_OP_ROLE_DISCOVERY:
2135 hci_cc_role_discovery(hdev, skb);
2136 break;
2137
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002138 case HCI_OP_READ_LINK_POLICY:
2139 hci_cc_read_link_policy(hdev, skb);
2140 break;
2141
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002142 case HCI_OP_WRITE_LINK_POLICY:
2143 hci_cc_write_link_policy(hdev, skb);
2144 break;
2145
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002146 case HCI_OP_READ_DEF_LINK_POLICY:
2147 hci_cc_read_def_link_policy(hdev, skb);
2148 break;
2149
2150 case HCI_OP_WRITE_DEF_LINK_POLICY:
2151 hci_cc_write_def_link_policy(hdev, skb);
2152 break;
2153
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002154 case HCI_OP_RESET:
2155 hci_cc_reset(hdev, skb);
2156 break;
2157
2158 case HCI_OP_WRITE_LOCAL_NAME:
2159 hci_cc_write_local_name(hdev, skb);
2160 break;
2161
2162 case HCI_OP_READ_LOCAL_NAME:
2163 hci_cc_read_local_name(hdev, skb);
2164 break;
2165
2166 case HCI_OP_WRITE_AUTH_ENABLE:
2167 hci_cc_write_auth_enable(hdev, skb);
2168 break;
2169
2170 case HCI_OP_WRITE_ENCRYPT_MODE:
2171 hci_cc_write_encrypt_mode(hdev, skb);
2172 break;
2173
2174 case HCI_OP_WRITE_SCAN_ENABLE:
2175 hci_cc_write_scan_enable(hdev, skb);
2176 break;
2177
2178 case HCI_OP_READ_CLASS_OF_DEV:
2179 hci_cc_read_class_of_dev(hdev, skb);
2180 break;
2181
2182 case HCI_OP_WRITE_CLASS_OF_DEV:
2183 hci_cc_write_class_of_dev(hdev, skb);
2184 break;
2185
2186 case HCI_OP_READ_VOICE_SETTING:
2187 hci_cc_read_voice_setting(hdev, skb);
2188 break;
2189
2190 case HCI_OP_WRITE_VOICE_SETTING:
2191 hci_cc_write_voice_setting(hdev, skb);
2192 break;
2193
2194 case HCI_OP_HOST_BUFFER_SIZE:
2195 hci_cc_host_buffer_size(hdev, skb);
2196 break;
2197
Marcel Holtmann333140b2008-07-14 20:13:48 +02002198 case HCI_OP_READ_SSP_MODE:
2199 hci_cc_read_ssp_mode(hdev, skb);
2200 break;
2201
2202 case HCI_OP_WRITE_SSP_MODE:
2203 hci_cc_write_ssp_mode(hdev, skb);
2204 break;
2205
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002206 case HCI_OP_READ_LOCAL_VERSION:
2207 hci_cc_read_local_version(hdev, skb);
2208 break;
2209
2210 case HCI_OP_READ_LOCAL_COMMANDS:
2211 hci_cc_read_local_commands(hdev, skb);
2212 break;
2213
2214 case HCI_OP_READ_LOCAL_FEATURES:
2215 hci_cc_read_local_features(hdev, skb);
2216 break;
2217
2218 case HCI_OP_READ_BUFFER_SIZE:
2219 hci_cc_read_buffer_size(hdev, skb);
2220 break;
2221
2222 case HCI_OP_READ_BD_ADDR:
2223 hci_cc_read_bd_addr(hdev, skb);
2224 break;
2225
Johan Hedberg23bb5762010-12-21 23:01:27 +02002226 case HCI_OP_WRITE_CA_TIMEOUT:
2227 hci_cc_write_ca_timeout(hdev, skb);
2228 break;
2229
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002230 case HCI_OP_READ_FLOW_CONTROL_MODE:
2231 hci_cc_read_flow_control_mode(hdev, skb);
2232 break;
2233
2234 case HCI_OP_READ_DATA_BLOCK_SIZE:
2235 hci_cc_read_data_block_size(hdev, skb);
2236 break;
2237
2238 case HCI_OP_READ_LOCAL_AMP_INFO:
2239 hci_cc_read_local_amp_info(hdev, skb);
2240 break;
2241
2242 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2243 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2244 hci_amp_cmd_complete(hdev, opcode, skb);
2245 break;
2246
Johan Hedbergb0916ea2011-01-10 13:44:55 +02002247 case HCI_OP_DELETE_STORED_LINK_KEY:
2248 hci_cc_delete_stored_link_key(hdev, skb);
2249 break;
2250
Johan Hedbergd5859e22011-01-25 01:19:58 +02002251 case HCI_OP_SET_EVENT_MASK:
2252 hci_cc_set_event_mask(hdev, skb);
2253 break;
2254
2255 case HCI_OP_WRITE_INQUIRY_MODE:
2256 hci_cc_write_inquiry_mode(hdev, skb);
2257 break;
2258
2259 case HCI_OP_READ_INQ_RSP_TX_POWER:
2260 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2261 break;
2262
2263 case HCI_OP_SET_EVENT_FLT:
2264 hci_cc_set_event_flt(hdev, skb);
2265 break;
2266
Johan Hedberg980e1a52011-01-22 06:10:07 +02002267 case HCI_OP_PIN_CODE_REPLY:
2268 hci_cc_pin_code_reply(hdev, skb);
2269 break;
2270
2271 case HCI_OP_PIN_CODE_NEG_REPLY:
2272 hci_cc_pin_code_neg_reply(hdev, skb);
2273 break;
2274
Szymon Jancc35938b2011-03-22 13:12:21 +01002275 case HCI_OP_READ_LOCAL_OOB_DATA:
2276 hci_cc_read_local_oob_data_reply(hdev, skb);
2277 break;
2278
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002279 case HCI_OP_LE_READ_BUFFER_SIZE:
2280 hci_cc_le_read_buffer_size(hdev, skb);
2281 break;
2282
Sunny Kapdi320598f2012-07-30 14:52:56 -07002283 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2284 hci_cc_le_read_white_list_size(hdev, skb);
2285 break;
2286
2287 case HCI_OP_LE_CLEAR_WHITE_LIST:
2288 hci_cc_le_clear_white_list(hdev, skb);
2289 break;
2290
Archana Ramachandran26a752b2011-12-20 11:27:40 -08002291 case HCI_OP_READ_RSSI:
2292 hci_cc_read_rssi(hdev, skb);
2293 break;
2294
Johan Hedberga5c29682011-02-19 12:05:57 -03002295 case HCI_OP_USER_CONFIRM_REPLY:
2296 hci_cc_user_confirm_reply(hdev, skb);
2297 break;
2298
2299 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2300 hci_cc_user_confirm_neg_reply(hdev, skb);
2301 break;
2302
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002303 case HCI_OP_LE_LTK_REPLY:
2304 hci_cc_le_ltk_reply(hdev, skb);
2305 break;
2306
2307 case HCI_OP_LE_LTK_NEG_REPLY:
2308 hci_cc_le_ltk_neg_reply(hdev, skb);
2309 break;
2310
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002311 case HCI_OP_LE_SET_SCAN_ENABLE:
2312 hci_cc_le_set_scan_enable(hdev, skb);
Andre Guedese326af42011-06-30 19:20:53 -03002313 break;
2314
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002315 default:
2316 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2317 break;
2318 }
2319
Ville Tervo6bd32322011-02-16 16:32:41 +02002320 if (ev->opcode != HCI_OP_NOP)
2321 del_timer(&hdev->cmd_timer);
2322
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002323 if (ev->ncmd) {
2324 atomic_set(&hdev->cmd_cnt, 1);
2325 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002326 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002327 }
2328}
2329
2330static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
2331{
2332 struct hci_ev_cmd_status *ev = (void *) skb->data;
2333 __u16 opcode;
2334
2335 skb_pull(skb, sizeof(*ev));
2336
2337 opcode = __le16_to_cpu(ev->opcode);
2338
2339 switch (opcode) {
2340 case HCI_OP_INQUIRY:
2341 hci_cs_inquiry(hdev, ev->status);
2342 break;
2343
2344 case HCI_OP_CREATE_CONN:
2345 hci_cs_create_conn(hdev, ev->status);
2346 break;
2347
2348 case HCI_OP_ADD_SCO:
2349 hci_cs_add_sco(hdev, ev->status);
2350 break;
2351
Marcel Holtmannf8558552008-07-14 20:13:49 +02002352 case HCI_OP_AUTH_REQUESTED:
2353 hci_cs_auth_requested(hdev, ev->status);
2354 break;
2355
2356 case HCI_OP_SET_CONN_ENCRYPT:
2357 hci_cs_set_conn_encrypt(hdev, ev->status);
2358 break;
2359
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002360 case HCI_OP_REMOTE_NAME_REQ:
2361 hci_cs_remote_name_req(hdev, ev->status);
2362 break;
2363
Marcel Holtmann769be972008-07-14 20:13:49 +02002364 case HCI_OP_READ_REMOTE_FEATURES:
2365 hci_cs_read_remote_features(hdev, ev->status);
2366 break;
2367
2368 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2369 hci_cs_read_remote_ext_features(hdev, ev->status);
2370 break;
2371
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002372 case HCI_OP_SETUP_SYNC_CONN:
2373 hci_cs_setup_sync_conn(hdev, ev->status);
2374 break;
2375
2376 case HCI_OP_SNIFF_MODE:
2377 hci_cs_sniff_mode(hdev, ev->status);
2378 break;
2379
2380 case HCI_OP_EXIT_SNIFF_MODE:
2381 hci_cs_exit_sniff_mode(hdev, ev->status);
2382 break;
2383
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002384 case HCI_OP_CREATE_LOGICAL_LINK:
2385 hci_cs_create_logical_link(hdev, ev->status);
2386 break;
2387
2388 case HCI_OP_ACCEPT_LOGICAL_LINK:
2389 hci_cs_accept_logical_link(hdev, ev->status);
2390 break;
2391
2392 case HCI_OP_DISCONN_LOGICAL_LINK:
2393 hci_cs_disconn_logical_link(hdev, ev->status);
2394 break;
2395
2396 case HCI_OP_FLOW_SPEC_MODIFY:
2397 hci_cs_flow_spec_modify(hdev, ev->status);
2398 break;
2399
2400 case HCI_OP_CREATE_PHYS_LINK:
2401 case HCI_OP_ACCEPT_PHYS_LINK:
2402 hci_amp_cmd_status(hdev, opcode, ev->status);
2403 break;
2404
2405 case HCI_OP_DISCONN_PHYS_LINK:
2406 hci_cs_disconn_physical_link(hdev, ev->status);
2407
Johan Hedberg8962ee72011-01-20 12:40:27 +02002408 case HCI_OP_DISCONNECT:
2409 if (ev->status != 0)
2410 mgmt_disconnect_failed(hdev->id);
2411 break;
2412
Ville Tervofcd89c02011-02-10 22:38:47 -03002413 case HCI_OP_LE_CREATE_CONN:
2414 hci_cs_le_create_conn(hdev, ev->status);
2415 break;
2416
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03002417 case HCI_OP_LE_START_ENC:
2418 hci_cs_le_start_enc(hdev, ev->status);
2419 break;
2420
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002421 default:
2422 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2423 break;
2424 }
2425
Ville Tervo6bd32322011-02-16 16:32:41 +02002426 if (ev->opcode != HCI_OP_NOP)
2427 del_timer(&hdev->cmd_timer);
2428
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002429 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002430 atomic_set(&hdev->cmd_cnt, 1);
2431 if (!skb_queue_empty(&hdev->cmd_q))
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002432 tasklet_schedule(&hdev->cmd_task);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002433 }
2434}
2435
2436static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2437{
2438 struct hci_ev_role_change *ev = (void *) skb->data;
2439 struct hci_conn *conn;
2440
2441 BT_DBG("%s status %d", hdev->name, ev->status);
2442
2443 hci_dev_lock(hdev);
2444
2445 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2446 if (conn) {
2447 if (!ev->status) {
2448 if (ev->role)
2449 conn->link_mode &= ~HCI_LM_MASTER;
2450 else
2451 conn->link_mode |= HCI_LM_MASTER;
2452 }
2453
2454 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2455
2456 hci_role_switch_cfm(conn, ev->status, ev->role);
2457 }
2458
2459 hci_dev_unlock(hdev);
2460}
2461
Linus Torvalds1da177e2005-04-16 15:20:36 -07002462static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2463{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002464 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002465 __le16 *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002466 int i;
2467
2468 skb_pull(skb, sizeof(*ev));
2469
2470 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2471
2472 if (skb->len < ev->num_hndl * 4) {
2473 BT_DBG("%s bad parameters", hdev->name);
2474 return;
2475 }
2476
2477 tasklet_disable(&hdev->tx_task);
2478
Marcel Holtmann1ebb9252005-11-08 09:57:21 -08002479 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002480 struct hci_conn *conn = NULL;
2481 struct hci_chan *chan;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002482 __u16 handle, count;
2483
Harvey Harrison83985312008-05-02 16:25:46 -07002484 handle = get_unaligned_le16(ptr++);
2485 count = get_unaligned_le16(ptr++);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002486
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002487 if (hdev->dev_type == HCI_BREDR)
2488 conn = hci_conn_hash_lookup_handle(hdev, handle);
2489 else {
2490 chan = hci_chan_list_lookup_handle(hdev, handle);
2491 if (chan)
2492 conn = chan->conn;
2493 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002494 if (conn) {
2495 conn->sent -= count;
2496
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002497 if (conn->type == ACL_LINK) {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002498 hdev->acl_cnt += count;
2499 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002500 hdev->acl_cnt = hdev->acl_pkts;
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002501 } else if (conn->type == LE_LINK) {
2502 if (hdev->le_pkts) {
2503 hdev->le_cnt += count;
2504 if (hdev->le_cnt > hdev->le_pkts)
2505 hdev->le_cnt = hdev->le_pkts;
2506 } else {
2507 hdev->acl_cnt += count;
2508 if (hdev->acl_cnt > hdev->acl_pkts)
2509 hdev->acl_cnt = hdev->acl_pkts;
2510 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002511 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002512 hdev->sco_cnt += count;
2513 if (hdev->sco_cnt > hdev->sco_pkts)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02002514 hdev->sco_cnt = hdev->sco_pkts;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002515 }
2516 }
2517 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002518
Marcel Holtmannc78ae282009-11-18 01:02:54 +01002519 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002520
2521 tasklet_enable(&hdev->tx_task);
2522}
2523
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002524static inline void hci_num_comp_blocks_evt(struct hci_dev *hdev,
2525 struct sk_buff *skb)
2526{
2527 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2528 __le16 *ptr;
2529 int i;
2530
2531 skb_pull(skb, sizeof(*ev));
2532
2533 BT_DBG("%s total_num_blocks %d num_hndl %d",
2534 hdev->name, ev->total_num_blocks, ev->num_hndl);
2535
2536 if (skb->len < ev->num_hndl * 6) {
2537 BT_DBG("%s bad parameters", hdev->name);
2538 return;
2539 }
2540
2541 tasklet_disable(&hdev->tx_task);
2542
2543 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
2544 struct hci_conn *conn = NULL;
2545 struct hci_chan *chan;
2546 __u16 handle, block_count;
2547
2548 handle = get_unaligned_le16(ptr++);
2549
2550 /* Skip packet count */
2551 ptr++;
2552 block_count = get_unaligned_le16(ptr++);
2553
2554 BT_DBG("%s handle %d count %d", hdev->name, handle,
2555 block_count);
2556
2557 if (hdev->dev_type == HCI_BREDR)
2558 conn = hci_conn_hash_lookup_handle(hdev, handle);
2559 else {
2560 chan = hci_chan_list_lookup_handle(hdev, handle);
2561 if (chan)
2562 conn = chan->conn;
2563 }
2564 if (conn) {
2565 BT_DBG("%s conn %p sent %d", hdev->name,
2566 conn, conn->sent);
2567
2568 conn->sent -= block_count;
2569
2570 if (conn->type == ACL_LINK) {
2571 hdev->acl_cnt += block_count;
2572 if (hdev->acl_cnt > hdev->acl_pkts)
2573 hdev->acl_cnt = hdev->acl_pkts;
2574 } else {
2575 /* We should not find ourselves here */
2576 BT_DBG("Unexpected event for SCO connection");
2577 }
2578 }
2579 }
2580
2581 tasklet_schedule(&hdev->tx_task);
2582
2583 tasklet_enable(&hdev->tx_task);
2584}
2585
Marcel Holtmann04837f62006-07-03 10:02:33 +02002586static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002587{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002588 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002589 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002590
2591 BT_DBG("%s status %d", hdev->name, ev->status);
2592
2593 hci_dev_lock(hdev);
2594
Marcel Holtmann04837f62006-07-03 10:02:33 +02002595 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2596 if (conn) {
2597 conn->mode = ev->mode;
2598 conn->interval = __le16_to_cpu(ev->interval);
2599
2600 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2601 if (conn->mode == HCI_CM_ACTIVE)
2602 conn->power_save = 1;
2603 else
2604 conn->power_save = 0;
2605 }
Rahul Kashyapb44f9e22012-05-03 16:45:17 +05302606 if (conn->mode == HCI_CM_SNIFF)
2607 if (wake_lock_active(&conn->idle_lock))
2608 wake_unlock(&conn->idle_lock);
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002609
2610 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2611 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002612 }
2613
2614 hci_dev_unlock(hdev);
2615}
2616
Linus Torvalds1da177e2005-04-16 15:20:36 -07002617static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2618{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002619 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2620 struct hci_conn *conn;
2621
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002622 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002623
2624 hci_dev_lock(hdev);
2625
2626 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Marcel Holtmann3d7a9d12009-05-09 12:09:21 -07002627 if (conn && conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002628 hci_conn_hold(conn);
2629 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2630 hci_conn_put(conn);
Srinivas Krovvidi32ba9352012-01-26 10:48:08 +05302631 hci_conn_enter_active_mode(conn, 0);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002632 }
2633
Johan Hedberg03b555e2011-01-04 15:40:05 +02002634 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2635 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2636 sizeof(ev->bdaddr), &ev->bdaddr);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002637
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002638 if (test_bit(HCI_MGMT, &hdev->flags))
2639 mgmt_pin_code_request(hdev->id, &ev->bdaddr);
Johan Hedberg980e1a52011-01-22 06:10:07 +02002640
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002641 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002642}
2643
Linus Torvalds1da177e2005-04-16 15:20:36 -07002644static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2645{
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002646 struct hci_ev_link_key_req *ev = (void *) skb->data;
2647 struct hci_cp_link_key_reply cp;
2648 struct hci_conn *conn;
2649 struct link_key *key;
2650
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002651 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002652
2653 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2654 return;
2655
2656 hci_dev_lock(hdev);
2657
2658 key = hci_find_link_key(hdev, &ev->bdaddr);
2659 if (!key) {
2660 BT_DBG("%s link key not found for %s", hdev->name,
2661 batostr(&ev->bdaddr));
2662 goto not_found;
2663 }
2664
Brian Gixcf956772011-10-20 15:18:51 -07002665 BT_DBG("%s found key type %u for %s", hdev->name, key->key_type,
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002666 batostr(&ev->bdaddr));
2667
Brian Gixcf956772011-10-20 15:18:51 -07002668 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) && key->key_type == 0x03) {
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002669 BT_DBG("%s ignoring debug key", hdev->name);
2670 goto not_found;
2671 }
2672
2673 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2674
Prabhakaran Mc6001a712011-09-06 11:56:25 +05302675 if (conn) {
2676 BT_DBG("Conn pending sec level is %d, ssp is %d, key len is %d",
2677 conn->pending_sec_level, conn->ssp_mode, key->pin_len);
2678 }
2679 if (conn && (conn->ssp_mode == 0) &&
2680 (conn->pending_sec_level == BT_SECURITY_HIGH) &&
2681 (key->pin_len != 16)) {
2682 BT_DBG("Security is high ignoring this key");
2683 goto not_found;
2684 }
2685
Brian Gixcf956772011-10-20 15:18:51 -07002686 if (key->key_type == 0x04 && conn && conn->auth_type != 0xff &&
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002687 (conn->auth_type & 0x01)) {
2688 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2689 goto not_found;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002690 }
2691
2692 bacpy(&cp.bdaddr, &ev->bdaddr);
2693 memcpy(cp.link_key, key->val, 16);
2694
2695 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2696
2697 hci_dev_unlock(hdev);
2698
2699 return;
2700
2701not_found:
2702 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2703 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002704}
2705
Linus Torvalds1da177e2005-04-16 15:20:36 -07002706static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2707{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002708 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2709 struct hci_conn *conn;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002710 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002711
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002712 BT_DBG("%s type %d", hdev->name, ev->key_type);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002713
2714 hci_dev_lock(hdev);
2715
2716 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2717 if (conn) {
2718 hci_conn_hold(conn);
2719 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002720
2721 memcpy(conn->link_key, ev->link_key, 16);
2722 conn->key_type = ev->key_type;
2723 hci_disconnect_amp(conn, 0x06);
2724
Prabhakaran Mc48584712012-04-20 15:47:58 +05302725 conn->link_mode &= ~HCI_LM_ENCRYPT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002726 pin_len = conn->pin_length;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002727 hci_conn_put(conn);
Srinivas Krovvidi32ba9352012-01-26 10:48:08 +05302728 hci_conn_enter_active_mode(conn, 0);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002729 }
2730
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002731 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002732 hci_add_link_key(hdev, 1, &ev->bdaddr, ev->link_key,
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002733 ev->key_type, pin_len);
2734
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002735 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002736}
2737
Marcel Holtmann04837f62006-07-03 10:02:33 +02002738static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2739{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002740 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002741 struct hci_conn *conn;
2742
2743 BT_DBG("%s status %d", hdev->name, ev->status);
2744
2745 hci_dev_lock(hdev);
2746
2747 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002748 if (conn && !ev->status) {
2749 struct inquiry_entry *ie;
2750
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002751 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2752 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002753 ie->data.clock_offset = ev->clock_offset;
2754 ie->timestamp = jiffies;
2755 }
2756 }
2757
2758 hci_dev_unlock(hdev);
2759}
2760
Marcel Holtmanna8746412008-07-14 20:13:46 +02002761static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2762{
2763 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2764 struct hci_conn *conn;
2765
2766 BT_DBG("%s status %d", hdev->name, ev->status);
2767
2768 hci_dev_lock(hdev);
2769
2770 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2771 if (conn && !ev->status)
2772 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2773
2774 hci_dev_unlock(hdev);
2775}
2776
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002777static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2778{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002779 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002780 struct inquiry_entry *ie;
2781
2782 BT_DBG("%s", hdev->name);
2783
2784 hci_dev_lock(hdev);
2785
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002786 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2787 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002788 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2789 ie->timestamp = jiffies;
2790 }
2791
2792 hci_dev_unlock(hdev);
2793}
2794
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002795static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2796{
2797 struct inquiry_data data;
2798 int num_rsp = *((__u8 *) skb->data);
2799
2800 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2801
2802 if (!num_rsp)
2803 return;
2804
2805 hci_dev_lock(hdev);
2806
2807 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002808 struct inquiry_info_with_rssi_and_pscan_mode *info;
2809 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002810
Johan Hedberge17acd42011-03-30 23:57:16 +03002811 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002812 bacpy(&data.bdaddr, &info->bdaddr);
2813 data.pscan_rep_mode = info->pscan_rep_mode;
2814 data.pscan_period_mode = info->pscan_period_mode;
2815 data.pscan_mode = info->pscan_mode;
2816 memcpy(data.dev_class, info->dev_class, 3);
2817 data.clock_offset = info->clock_offset;
2818 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002819 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002820 hci_inquiry_cache_update(hdev, &data);
Brian Gixa68668b2011-08-11 15:49:36 -07002821 mgmt_device_found(hdev->id, &info->bdaddr, 0, 0,
Johan Hedberge17acd42011-03-30 23:57:16 +03002822 info->dev_class, info->rssi,
Brian Gixa68668b2011-08-11 15:49:36 -07002823 0, NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002824 }
2825 } else {
2826 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2827
Johan Hedberge17acd42011-03-30 23:57:16 +03002828 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002829 bacpy(&data.bdaddr, &info->bdaddr);
2830 data.pscan_rep_mode = info->pscan_rep_mode;
2831 data.pscan_period_mode = info->pscan_period_mode;
2832 data.pscan_mode = 0x00;
2833 memcpy(data.dev_class, info->dev_class, 3);
2834 data.clock_offset = info->clock_offset;
2835 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002836 data.ssp_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002837 hci_inquiry_cache_update(hdev, &data);
Brian Gixa68668b2011-08-11 15:49:36 -07002838 mgmt_device_found(hdev->id, &info->bdaddr, 0, 0,
Johan Hedberge17acd42011-03-30 23:57:16 +03002839 info->dev_class, info->rssi,
Brian Gixa68668b2011-08-11 15:49:36 -07002840 0, NULL);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002841 }
2842 }
2843
2844 hci_dev_unlock(hdev);
2845}
2846
2847static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2848{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002849 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2850 struct hci_conn *conn;
2851
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002852 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002853
Marcel Holtmann41a96212008-07-14 20:13:48 +02002854 hci_dev_lock(hdev);
2855
2856 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002857 if (!conn)
2858 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002859
Johan Hedbergccd556f2010-11-10 17:11:51 +02002860 if (!ev->status && ev->page == 0x01) {
2861 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002862
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002863 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2864 if (ie)
Johan Hedbergccd556f2010-11-10 17:11:51 +02002865 ie->data.ssp_mode = (ev->features[0] & 0x01);
Marcel Holtmann769be972008-07-14 20:13:49 +02002866
Johan Hedbergccd556f2010-11-10 17:11:51 +02002867 conn->ssp_mode = (ev->features[0] & 0x01);
Bhakthavatsala Raghavendra6edb4f12011-11-04 16:07:41 +05302868 /*In case if remote device ssp supported/2.0 device
2869 reduce the security level to MEDIUM if it is HIGH*/
Prabhakaran Mc453651c2012-03-02 11:55:59 +05302870 if (!conn->ssp_mode && conn->auth_initiator &&
Bhakthavatsala Raghavendra6edb4f12011-11-04 16:07:41 +05302871 (conn->pending_sec_level == BT_SECURITY_HIGH))
2872 conn->pending_sec_level = BT_SECURITY_MEDIUM;
Prabhakaran Mc76a83552012-04-09 14:43:18 +05302873
2874 if (conn->ssp_mode && conn->auth_initiator &&
2875 conn->io_capability != 0x03) {
2876 conn->pending_sec_level = BT_SECURITY_HIGH;
2877 conn->auth_type = HCI_AT_DEDICATED_BONDING_MITM;
2878 }
Marcel Holtmann41a96212008-07-14 20:13:48 +02002879 }
2880
Johan Hedbergccd556f2010-11-10 17:11:51 +02002881 if (conn->state != BT_CONFIG)
2882 goto unlock;
2883
Johan Hedberg127178d2010-11-18 22:22:29 +02002884 if (!ev->status) {
2885 struct hci_cp_remote_name_req cp;
2886 memset(&cp, 0, sizeof(cp));
2887 bacpy(&cp.bdaddr, &conn->dst);
2888 cp.pscan_rep_mode = 0x02;
2889 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2890 }
Johan Hedberg392599b2010-11-18 22:22:28 +02002891
Johan Hedberg127178d2010-11-18 22:22:29 +02002892 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002893 conn->state = BT_CONNECTED;
2894 hci_proto_connect_cfm(conn, ev->status);
2895 hci_conn_put(conn);
2896 }
2897
2898unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002899 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002900}
2901
2902static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2903{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002904 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2905 struct hci_conn *conn;
2906
2907 BT_DBG("%s status %d", hdev->name, ev->status);
2908
2909 hci_dev_lock(hdev);
2910
2911 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002912 if (!conn) {
2913 if (ev->link_type == ESCO_LINK)
2914 goto unlock;
2915
2916 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2917 if (!conn)
2918 goto unlock;
2919
2920 conn->type = SCO_LINK;
2921 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002922
Marcel Holtmann732547f2009-04-19 19:14:14 +02002923 switch (ev->status) {
2924 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002925 conn->handle = __le16_to_cpu(ev->handle);
2926 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002927
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002928 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002929 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002930 break;
2931
Stephen Coe705e5712010-02-16 11:29:44 -05002932 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002933 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002934 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002935 case 0x1f: /* Unspecified error */
2936 if (conn->out && conn->attempt < 2) {
Kun Han Kim15b911f2011-07-08 09:30:28 -07002937 if (!conn->hdev->is_wbs)
2938 conn->pkt_type =
2939 (hdev->esco_type & SCO_ESCO_MASK) |
Marcel Holtmann732547f2009-04-19 19:14:14 +02002940 (hdev->esco_type & EDR_ESCO_MASK);
2941 hci_setup_sync(conn, conn->link->handle);
2942 goto unlock;
2943 }
2944 /* fall through */
2945
2946 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002947 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002948 break;
2949 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002950
2951 hci_proto_connect_cfm(conn, ev->status);
2952 if (ev->status)
2953 hci_conn_del(conn);
2954
2955unlock:
2956 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002957}
2958
2959static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2960{
2961 BT_DBG("%s", hdev->name);
2962}
2963
Marcel Holtmann04837f62006-07-03 10:02:33 +02002964static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2965{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002966 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
Srinivas Krovvidia7c3d7e2012-08-06 15:31:55 +05302967 struct hci_conn *conn =
2968 hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Marcel Holtmann04837f62006-07-03 10:02:33 +02002969
2970 BT_DBG("%s status %d", hdev->name, ev->status);
Srinivas Krovvidia7c3d7e2012-08-06 15:31:55 +05302971 if (conn && (ev->max_rx_latency > hdev->sniff_max_interval)) {
2972 BT_ERR("value of rx_latency:%d", ev->max_rx_latency);
2973 hci_dev_lock(hdev);
2974 hci_conn_enter_active_mode(conn, 1);
2975 hci_dev_unlock(hdev);
2976 }
Marcel Holtmann04837f62006-07-03 10:02:33 +02002977}
2978
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002979static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
2980{
2981 struct inquiry_data data;
2982 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2983 int num_rsp = *((__u8 *) skb->data);
2984
2985 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2986
2987 if (!num_rsp)
2988 return;
2989
2990 hci_dev_lock(hdev);
2991
Johan Hedberge17acd42011-03-30 23:57:16 +03002992 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002993 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002994 data.pscan_rep_mode = info->pscan_rep_mode;
2995 data.pscan_period_mode = info->pscan_period_mode;
2996 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002997 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002998 data.clock_offset = info->clock_offset;
2999 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003000 data.ssp_mode = 0x01;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003001 hci_inquiry_cache_update(hdev, &data);
Brian Gixa68668b2011-08-11 15:49:36 -07003002 mgmt_device_found(hdev->id, &info->bdaddr, 0, 0,
3003 info->dev_class, info->rssi,
3004 HCI_MAX_EIR_LENGTH, info->data);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003005 }
3006
3007 hci_dev_unlock(hdev);
3008}
3009
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003010static inline u8 hci_get_auth_req(struct hci_conn *conn)
3011{
Brian Gixa68668b2011-08-11 15:49:36 -07003012 BT_DBG("%p", conn);
3013
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003014 /* If remote requests dedicated bonding follow that lead */
3015 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
3016 /* If both remote and local IO capabilities allow MITM
3017 * protection then require it, otherwise don't */
Brian Gixa68668b2011-08-11 15:49:36 -07003018 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003019 return 0x02;
Brian Gixa68668b2011-08-11 15:49:36 -07003020 } else {
3021 conn->auth_type |= 0x01;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003022 return 0x03;
Brian Gixa68668b2011-08-11 15:49:36 -07003023 }
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003024 }
3025
3026 /* If remote requests no-bonding follow that lead */
Brian Gixa68668b2011-08-11 15:49:36 -07003027 if (conn->remote_auth <= 0x01)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003028 return 0x00;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003029
3030 return conn->auth_type;
3031}
3032
Marcel Holtmann04936842008-07-14 20:13:48 +02003033static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
3034{
3035 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3036 struct hci_conn *conn;
3037
3038 BT_DBG("%s", hdev->name);
3039
3040 hci_dev_lock(hdev);
3041
3042 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003043 if (!conn)
3044 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003045
Johan Hedberg03b555e2011-01-04 15:40:05 +02003046 hci_conn_hold(conn);
3047
3048 if (!test_bit(HCI_MGMT, &hdev->flags))
3049 goto unlock;
3050
3051 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
3052 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003053 struct hci_cp_io_capability_reply cp;
Brian Gixa68668b2011-08-11 15:49:36 -07003054 u8 io_cap = conn->io_capability;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003055
Brian Gixa68668b2011-08-11 15:49:36 -07003056 /* ACL-SSP does not support IO CAP 0x04 */
3057 cp.capability = (io_cap == 0x04) ? 0x01 : io_cap;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003058 bacpy(&cp.bdaddr, &ev->bdaddr);
Brian Gixa68668b2011-08-11 15:49:36 -07003059 if (conn->auth_initiator)
3060 cp.authentication = conn->auth_type;
3061 else
3062 cp.authentication = hci_get_auth_req(conn);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003063
Szymon Jancce85ee12011-03-22 13:12:23 +01003064 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
3065 hci_find_remote_oob_data(hdev, &conn->dst))
3066 cp.oob_data = 0x01;
3067 else
3068 cp.oob_data = 0x00;
3069
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003070 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
3071 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003072 } else {
3073 struct hci_cp_io_capability_neg_reply cp;
3074
3075 bacpy(&cp.bdaddr, &ev->bdaddr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003076 cp.reason = 0x16; /* Pairing not allowed */
Johan Hedberg03b555e2011-01-04 15:40:05 +02003077
3078 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
3079 sizeof(cp), &cp);
3080 }
3081
3082unlock:
3083 hci_dev_unlock(hdev);
3084}
3085
3086static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
3087{
3088 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3089 struct hci_conn *conn;
3090
3091 BT_DBG("%s", hdev->name);
3092
3093 hci_dev_lock(hdev);
3094
3095 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3096 if (!conn)
3097 goto unlock;
3098
Johan Hedberg03b555e2011-01-04 15:40:05 +02003099 conn->remote_cap = ev->capability;
3100 conn->remote_oob = ev->oob_data;
3101 conn->remote_auth = ev->authentication;
3102
3103unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003104 hci_dev_unlock(hdev);
3105}
3106
Brian Gixa68668b2011-08-11 15:49:36 -07003107static inline void hci_user_ssp_confirmation_evt(struct hci_dev *hdev,
3108 u8 event, struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003109{
3110 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
3111
3112 BT_DBG("%s", hdev->name);
3113
3114 hci_dev_lock(hdev);
3115
Brian Gixa68668b2011-08-11 15:49:36 -07003116 if (test_bit(HCI_MGMT, &hdev->flags)) {
3117 if (event == HCI_EV_USER_PASSKEY_REQUEST)
3118 mgmt_user_confirm_request(hdev->id, event,
3119 &ev->bdaddr, 0);
3120 else
3121 mgmt_user_confirm_request(hdev->id, event,
3122 &ev->bdaddr, ev->passkey);
3123 }
Johan Hedberga5c29682011-02-19 12:05:57 -03003124
3125 hci_dev_unlock(hdev);
3126}
3127
Marcel Holtmann04936842008-07-14 20:13:48 +02003128static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3129{
3130 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3131 struct hci_conn *conn;
3132
3133 BT_DBG("%s", hdev->name);
3134
3135 hci_dev_lock(hdev);
3136
3137 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003138 if (!conn)
3139 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003140
Johan Hedberg2a611692011-02-19 12:06:00 -03003141 /* To avoid duplicate auth_failed events to user space we check
3142 * the HCI_CONN_AUTH_PEND flag which will be set if we
3143 * initiated the authentication. A traditional auth_complete
3144 * event gets always produced as initiator and is also mapped to
3145 * the mgmt_auth_failed event */
3146 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
3147 mgmt_auth_failed(hdev->id, &conn->dst, ev->status);
3148
3149 hci_conn_put(conn);
3150
3151unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003152 hci_dev_unlock(hdev);
3153}
3154
Marcel Holtmann41a96212008-07-14 20:13:48 +02003155static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
3156{
3157 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3158 struct inquiry_entry *ie;
3159
3160 BT_DBG("%s", hdev->name);
3161
3162 hci_dev_lock(hdev);
3163
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003164 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3165 if (ie)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003166 ie->data.ssp_mode = (ev->features[0] & 0x01);
3167
3168 hci_dev_unlock(hdev);
3169}
3170
Szymon Janc2763eda2011-03-22 13:12:22 +01003171static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3172 struct sk_buff *skb)
3173{
3174 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3175 struct oob_data *data;
3176
3177 BT_DBG("%s", hdev->name);
3178
3179 hci_dev_lock(hdev);
3180
Szymon Jance1ba1f12011-04-06 13:01:59 +02003181 if (!test_bit(HCI_MGMT, &hdev->flags))
3182 goto unlock;
3183
Szymon Janc2763eda2011-03-22 13:12:22 +01003184 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3185 if (data) {
3186 struct hci_cp_remote_oob_data_reply cp;
3187
3188 bacpy(&cp.bdaddr, &ev->bdaddr);
3189 memcpy(cp.hash, data->hash, sizeof(cp.hash));
3190 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
3191
3192 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
3193 &cp);
3194 } else {
3195 struct hci_cp_remote_oob_data_neg_reply cp;
3196
3197 bacpy(&cp.bdaddr, &ev->bdaddr);
3198 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
3199 &cp);
3200 }
3201
Szymon Jance1ba1f12011-04-06 13:01:59 +02003202unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003203 hci_dev_unlock(hdev);
3204}
3205
Ville Tervofcd89c02011-02-10 22:38:47 -03003206static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3207{
3208 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3209 struct hci_conn *conn;
Sunny Kapdi320598f2012-07-30 14:52:56 -07003210 u8 white_list;
Ville Tervofcd89c02011-02-10 22:38:47 -03003211
3212 BT_DBG("%s status %d", hdev->name, ev->status);
3213
3214 hci_dev_lock(hdev);
3215
Sunny Kapdi320598f2012-07-30 14:52:56 -07003216 /* Ignore event for LE cancel create conn whitelist */
3217 if (ev->status && !bacmp(&ev->bdaddr, BDADDR_ANY))
3218 goto unlock;
3219
3220 if (hci_conn_hash_lookup_ba(hdev, LE_LINK, BDADDR_ANY))
3221 white_list = 1;
3222 else
3223 white_list = 0;
3224
3225 BT_DBG("w_list %d", white_list);
3226
Ville Tervofcd89c02011-02-10 22:38:47 -03003227 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
Ville Tervob62f3282011-02-10 22:38:50 -03003228 if (!conn) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003229 conn = hci_le_conn_add(hdev, &ev->bdaddr, ev->bdaddr_type);
Ville Tervob62f3282011-02-10 22:38:50 -03003230 if (!conn) {
3231 BT_ERR("No memory for new connection");
3232 hci_dev_unlock(hdev);
3233 return;
3234 }
3235 }
Ville Tervofcd89c02011-02-10 22:38:47 -03003236
3237 if (ev->status) {
3238 hci_proto_connect_cfm(conn, ev->status);
3239 conn->state = BT_CLOSED;
3240 hci_conn_del(conn);
3241 goto unlock;
3242 }
3243
Vinicius Costa Gomes403d2c82011-06-09 18:50:50 -03003244 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03003245 conn->handle = __le16_to_cpu(ev->handle);
3246 conn->state = BT_CONNECTED;
Brian Gixa68668b2011-08-11 15:49:36 -07003247 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Brian Gix2e2f50d2011-09-13 12:36:04 -07003248 mgmt_connected(hdev->id, &ev->bdaddr, 1);
Sunny Kapdia42b5022012-07-05 22:48:31 -07003249 mgmt_le_conn_params(hdev->id, &ev->bdaddr,
3250 __le16_to_cpu(ev->interval),
3251 __le16_to_cpu(ev->latency),
3252 __le16_to_cpu(ev->supervision_timeout));
Ville Tervofcd89c02011-02-10 22:38:47 -03003253
Brian Gix6d5fb8a2011-09-09 14:53:04 -07003254 hci_conn_hold(conn);
Ville Tervofcd89c02011-02-10 22:38:47 -03003255 hci_conn_hold_device(conn);
3256 hci_conn_add_sysfs(conn);
3257
Sunny Kapdi320598f2012-07-30 14:52:56 -07003258 if (!white_list)
3259 hci_proto_connect_cfm(conn, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003260
3261unlock:
3262 hci_dev_unlock(hdev);
3263}
3264
Sunny Kapdia42b5022012-07-05 22:48:31 -07003265static inline void hci_le_conn_update_complete_evt(struct hci_dev *hdev,
3266 struct sk_buff *skb)
3267{
3268 struct hci_ev_le_conn_update_complete *ev = (void *) skb->data;
3269 struct hci_conn *conn;
3270
3271 BT_DBG("%s status %d", hdev->name, ev->status);
3272
3273 hci_dev_lock(hdev);
3274
3275 conn = hci_conn_hash_lookup_handle(hdev,
3276 __le16_to_cpu(ev->handle));
3277 if (conn == NULL) {
3278 BT_ERR("Unknown connection update");
3279 goto unlock;
3280 }
3281
3282 if (ev->status) {
3283 BT_ERR("Connection update unsuccessful");
3284 goto unlock;
3285 }
3286
3287 mgmt_le_conn_params(hdev->id, &conn->dst,
3288 __le16_to_cpu(ev->interval),
3289 __le16_to_cpu(ev->latency),
3290 __le16_to_cpu(ev->supervision_timeout));
3291
3292unlock:
3293 hci_dev_unlock(hdev);
3294}
3295
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003296static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
3297 struct sk_buff *skb)
3298{
3299 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
3300 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03003301 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003302 struct hci_conn *conn;
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03003303 struct link_key *ltk;
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003304
3305 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
3306
3307 hci_dev_lock(hdev);
3308
3309 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03003310 if (conn == NULL)
3311 goto not_found;
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003312
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03003313 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
3314 if (ltk == NULL)
3315 goto not_found;
3316
3317 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003318 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomes1fa2de32011-07-08 18:31:45 -03003319 conn->pin_length = ltk->pin_len;
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003320
3321 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
3322
3323 hci_dev_unlock(hdev);
Vinicius Costa Gomes60e56472011-07-07 18:59:37 -03003324
3325 return;
3326
3327not_found:
3328 neg.handle = ev->handle;
3329 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
3330 hci_dev_unlock(hdev);
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003331}
3332
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003333static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
3334 struct sk_buff *skb)
3335{
3336 struct hci_ev_le_advertising_info *ev;
3337 u8 num_reports;
3338
3339 num_reports = skb->data[0];
3340 ev = (void *) &skb->data[1];
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003341
Brian Gix3dd70172011-09-16 21:38:54 -07003342 hci_dev_lock(hdev);
3343
Brian Gixa68668b2011-08-11 15:49:36 -07003344 while (num_reports--) {
3345 mgmt_device_found(hdev->id, &ev->bdaddr, ev->bdaddr_type,
3346 1, NULL, 0, ev->length, ev->data);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003347 hci_add_adv_entry(hdev, ev);
Brian Gixa68668b2011-08-11 15:49:36 -07003348 ev = (void *) (ev->data + ev->length + 1);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003349 }
Brian Gix3dd70172011-09-16 21:38:54 -07003350
3351 hci_dev_unlock(hdev);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003352}
3353
Ville Tervofcd89c02011-02-10 22:38:47 -03003354static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
3355{
3356 struct hci_ev_le_meta *le_ev = (void *) skb->data;
3357
3358 skb_pull(skb, sizeof(*le_ev));
3359
3360 switch (le_ev->subevent) {
3361 case HCI_EV_LE_CONN_COMPLETE:
3362 hci_le_conn_complete_evt(hdev, skb);
3363 break;
3364
Sunny Kapdia42b5022012-07-05 22:48:31 -07003365 case HCI_EV_LE_CONN_UPDATE_COMPLETE:
3366 hci_le_conn_update_complete_evt(hdev, skb);
3367 break;
3368
Vinicius Costa Gomes735038c2011-06-09 18:50:47 -03003369 case HCI_EV_LE_LTK_REQ:
3370 hci_le_ltk_request_evt(hdev, skb);
3371 break;
3372
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003373 case HCI_EV_LE_ADVERTISING_REPORT:
3374 hci_le_adv_report_evt(hdev, skb);
3375 break;
3376
Ville Tervofcd89c02011-02-10 22:38:47 -03003377 default:
3378 break;
3379 }
3380}
3381
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003382static inline void hci_phy_link_complete(struct hci_dev *hdev,
3383 struct sk_buff *skb)
3384{
3385 struct hci_ev_phys_link_complete *ev = (void *) skb->data;
3386 struct hci_conn *conn;
3387
3388 BT_DBG("%s handle %d status %d", hdev->name, ev->phy_handle,
3389 ev->status);
3390
3391 hci_dev_lock(hdev);
3392
3393 if (ev->status == 0) {
3394 conn = hci_conn_add(hdev, ACL_LINK, 0, BDADDR_ANY);
3395 if (conn) {
3396 conn->handle = ev->phy_handle;
3397 conn->state = BT_CONNECTED;
3398
3399 hci_conn_hold(conn);
3400 conn->disc_timeout = HCI_DISCONN_TIMEOUT/2;
3401 hci_conn_put(conn);
3402
3403 hci_conn_hold_device(conn);
3404 hci_conn_add_sysfs(conn);
3405 } else
3406 BT_ERR("No memory for new connection");
3407 }
3408
3409 hci_dev_unlock(hdev);
3410}
3411
3412static inline void hci_log_link_complete(struct hci_dev *hdev,
3413 struct sk_buff *skb)
3414{
3415 struct hci_ev_log_link_complete *ev = (void *) skb->data;
3416 struct hci_chan *chan;
3417
3418 BT_DBG("%s handle %d status %d", hdev->name,
3419 __le16_to_cpu(ev->log_handle), ev->status);
3420
3421 hci_dev_lock(hdev);
3422
3423 chan = hci_chan_list_lookup_id(hdev, ev->phy_handle);
3424
Mat Martineau9f8d4672011-12-14 12:10:46 -08003425 if (chan) {
3426 if (ev->status == 0) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003427 chan->ll_handle = __le16_to_cpu(ev->log_handle);
3428 chan->state = BT_CONNECTED;
Mat Martineau9f8d4672011-12-14 12:10:46 -08003429 } else {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003430 chan->state = BT_CLOSED;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003431 }
Mat Martineau9f8d4672011-12-14 12:10:46 -08003432
3433 hci_proto_create_cfm(chan, ev->status);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003434 }
3435
3436 hci_dev_unlock(hdev);
3437}
3438
3439static inline void hci_flow_spec_modify_complete(struct hci_dev *hdev,
3440 struct sk_buff *skb)
3441{
3442 struct hci_ev_flow_spec_modify_complete *ev = (void *) skb->data;
3443 struct hci_chan *chan;
3444
3445 BT_DBG("%s handle %d status %d", hdev->name,
3446 __le16_to_cpu(ev->log_handle), ev->status);
3447
3448 hci_dev_lock(hdev);
3449
3450 chan = hci_chan_list_lookup_handle(hdev, ev->log_handle);
3451 if (chan)
3452 hci_proto_modify_cfm(chan, ev->status);
3453
3454 hci_dev_unlock(hdev);
3455}
3456
3457static inline void hci_disconn_log_link_complete_evt(struct hci_dev *hdev,
3458 struct sk_buff *skb)
3459{
3460 struct hci_ev_disconn_log_link_complete *ev = (void *) skb->data;
3461 struct hci_chan *chan;
3462
3463 BT_DBG("%s handle %d status %d", hdev->name,
3464 __le16_to_cpu(ev->log_handle), ev->status);
3465
3466 if (ev->status)
3467 return;
3468
3469 hci_dev_lock(hdev);
3470
3471 chan = hci_chan_list_lookup_handle(hdev, __le16_to_cpu(ev->log_handle));
Mat Martineau9f8d4672011-12-14 12:10:46 -08003472 if (chan)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003473 hci_proto_destroy_cfm(chan, ev->reason);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003474
3475 hci_dev_unlock(hdev);
3476}
3477
3478static inline void hci_disconn_phy_link_complete_evt(struct hci_dev *hdev,
3479 struct sk_buff *skb)
3480{
3481 struct hci_ev_disconn_phys_link_complete *ev = (void *) skb->data;
3482 struct hci_conn *conn;
3483
3484 BT_DBG("%s status %d", hdev->name, ev->status);
3485
3486 if (ev->status)
3487 return;
3488
3489 hci_dev_lock(hdev);
3490
3491 conn = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3492 if (conn) {
3493 conn->state = BT_CLOSED;
3494
Mat Martineau3b9239a2012-02-16 11:54:30 -08003495 hci_proto_disconn_cfm(conn, ev->reason, 0);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003496 hci_conn_del(conn);
3497 }
3498
3499 hci_dev_unlock(hdev);
3500}
3501
Linus Torvalds1da177e2005-04-16 15:20:36 -07003502void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
3503{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003504 struct hci_event_hdr *hdr = (void *) skb->data;
3505 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003506
Brian Gixdfdd9362011-08-18 09:58:02 -07003507 BT_DBG("");
3508
Linus Torvalds1da177e2005-04-16 15:20:36 -07003509 skb_pull(skb, HCI_EVENT_HDR_SIZE);
3510
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003511 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003512 case HCI_EV_INQUIRY_COMPLETE:
3513 hci_inquiry_complete_evt(hdev, skb);
3514 break;
3515
3516 case HCI_EV_INQUIRY_RESULT:
3517 hci_inquiry_result_evt(hdev, skb);
3518 break;
3519
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003520 case HCI_EV_CONN_COMPLETE:
3521 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02003522 break;
3523
Linus Torvalds1da177e2005-04-16 15:20:36 -07003524 case HCI_EV_CONN_REQUEST:
3525 hci_conn_request_evt(hdev, skb);
3526 break;
3527
Linus Torvalds1da177e2005-04-16 15:20:36 -07003528 case HCI_EV_DISCONN_COMPLETE:
3529 hci_disconn_complete_evt(hdev, skb);
3530 break;
3531
Linus Torvalds1da177e2005-04-16 15:20:36 -07003532 case HCI_EV_AUTH_COMPLETE:
3533 hci_auth_complete_evt(hdev, skb);
3534 break;
3535
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003536 case HCI_EV_REMOTE_NAME:
3537 hci_remote_name_evt(hdev, skb);
3538 break;
3539
Linus Torvalds1da177e2005-04-16 15:20:36 -07003540 case HCI_EV_ENCRYPT_CHANGE:
3541 hci_encrypt_change_evt(hdev, skb);
3542 break;
3543
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003544 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3545 hci_change_link_key_complete_evt(hdev, skb);
3546 break;
3547
3548 case HCI_EV_REMOTE_FEATURES:
3549 hci_remote_features_evt(hdev, skb);
3550 break;
3551
3552 case HCI_EV_REMOTE_VERSION:
3553 hci_remote_version_evt(hdev, skb);
3554 break;
3555
3556 case HCI_EV_QOS_SETUP_COMPLETE:
3557 hci_qos_setup_complete_evt(hdev, skb);
3558 break;
3559
3560 case HCI_EV_CMD_COMPLETE:
3561 hci_cmd_complete_evt(hdev, skb);
3562 break;
3563
3564 case HCI_EV_CMD_STATUS:
3565 hci_cmd_status_evt(hdev, skb);
3566 break;
3567
3568 case HCI_EV_ROLE_CHANGE:
3569 hci_role_change_evt(hdev, skb);
3570 break;
3571
3572 case HCI_EV_NUM_COMP_PKTS:
3573 hci_num_comp_pkts_evt(hdev, skb);
3574 break;
3575
3576 case HCI_EV_MODE_CHANGE:
3577 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003578 break;
3579
3580 case HCI_EV_PIN_CODE_REQ:
3581 hci_pin_code_request_evt(hdev, skb);
3582 break;
3583
3584 case HCI_EV_LINK_KEY_REQ:
3585 hci_link_key_request_evt(hdev, skb);
3586 break;
3587
3588 case HCI_EV_LINK_KEY_NOTIFY:
3589 hci_link_key_notify_evt(hdev, skb);
3590 break;
3591
3592 case HCI_EV_CLOCK_OFFSET:
3593 hci_clock_offset_evt(hdev, skb);
3594 break;
3595
Marcel Holtmanna8746412008-07-14 20:13:46 +02003596 case HCI_EV_PKT_TYPE_CHANGE:
3597 hci_pkt_type_change_evt(hdev, skb);
3598 break;
3599
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003600 case HCI_EV_PSCAN_REP_MODE:
3601 hci_pscan_rep_mode_evt(hdev, skb);
3602 break;
3603
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003604 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3605 hci_inquiry_result_with_rssi_evt(hdev, skb);
3606 break;
3607
3608 case HCI_EV_REMOTE_EXT_FEATURES:
3609 hci_remote_ext_features_evt(hdev, skb);
3610 break;
3611
3612 case HCI_EV_SYNC_CONN_COMPLETE:
3613 hci_sync_conn_complete_evt(hdev, skb);
3614 break;
3615
3616 case HCI_EV_SYNC_CONN_CHANGED:
3617 hci_sync_conn_changed_evt(hdev, skb);
3618 break;
3619
Marcel Holtmann04837f62006-07-03 10:02:33 +02003620 case HCI_EV_SNIFF_SUBRATE:
3621 hci_sniff_subrate_evt(hdev, skb);
3622 break;
3623
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003624 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3625 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003626 break;
3627
Marcel Holtmann04936842008-07-14 20:13:48 +02003628 case HCI_EV_IO_CAPA_REQUEST:
3629 hci_io_capa_request_evt(hdev, skb);
3630 break;
3631
Johan Hedberg03b555e2011-01-04 15:40:05 +02003632 case HCI_EV_IO_CAPA_REPLY:
3633 hci_io_capa_reply_evt(hdev, skb);
3634 break;
3635
Brian Gixa68668b2011-08-11 15:49:36 -07003636 case HCI_EV_USER_PASSKEY_REQUEST:
3637 case HCI_EV_USER_PASSKEY_NOTIFICATION:
Johan Hedberga5c29682011-02-19 12:05:57 -03003638 case HCI_EV_USER_CONFIRM_REQUEST:
Brian Gixa68668b2011-08-11 15:49:36 -07003639 hci_user_ssp_confirmation_evt(hdev, event, skb);
Johan Hedberga5c29682011-02-19 12:05:57 -03003640 break;
3641
Marcel Holtmann04936842008-07-14 20:13:48 +02003642 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3643 hci_simple_pair_complete_evt(hdev, skb);
3644 break;
3645
Marcel Holtmann41a96212008-07-14 20:13:48 +02003646 case HCI_EV_REMOTE_HOST_FEATURES:
3647 hci_remote_host_features_evt(hdev, skb);
3648 break;
3649
Ville Tervofcd89c02011-02-10 22:38:47 -03003650 case HCI_EV_LE_META:
3651 hci_le_meta_evt(hdev, skb);
3652 break;
3653
Szymon Janc2763eda2011-03-22 13:12:22 +01003654 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3655 hci_remote_oob_data_request_evt(hdev, skb);
3656 break;
3657
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003658 case HCI_EV_PHYS_LINK_COMPLETE:
3659 hci_phy_link_complete(hdev, skb);
3660 hci_amp_event_packet(hdev, event, skb);
3661 break;
3662
3663 case HCI_EV_LOG_LINK_COMPLETE:
3664 hci_log_link_complete(hdev, skb);
3665 break;
3666
3667 case HCI_EV_FLOW_SPEC_MODIFY_COMPLETE:
3668 hci_flow_spec_modify_complete(hdev, skb);
3669 break;
3670
3671 case HCI_EV_DISCONN_LOG_LINK_COMPLETE:
3672 hci_disconn_log_link_complete_evt(hdev, skb);
3673 break;
3674
3675 case HCI_EV_DISCONN_PHYS_LINK_COMPLETE:
3676 hci_disconn_phy_link_complete_evt(hdev, skb);
3677 hci_amp_event_packet(hdev, event, skb);
3678 break;
3679
3680 case HCI_EV_NUM_COMP_BLOCKS:
3681 hci_num_comp_blocks_evt(hdev, skb);
3682 break;
3683
3684 case HCI_EV_CHANNEL_SELECTED:
3685 hci_amp_event_packet(hdev, event, skb);
3686 break;
3687
3688 case HCI_EV_AMP_STATUS_CHANGE:
3689 hci_amp_event_packet(hdev, event, skb);
3690 break;
3691
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003692 default:
3693 BT_DBG("%s event 0x%x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003694 break;
3695 }
3696
3697 kfree_skb(skb);
3698 hdev->stat.evt_rx++;
3699}
3700
3701/* Generate internal stack event */
3702void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3703{
3704 struct hci_event_hdr *hdr;
3705 struct hci_ev_stack_internal *ev;
3706 struct sk_buff *skb;
3707
3708 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3709 if (!skb)
3710 return;
3711
3712 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3713 hdr->evt = HCI_EV_STACK_INTERNAL;
3714 hdr->plen = sizeof(*ev) + dlen;
3715
3716 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3717 ev->type = type;
3718 memcpy(ev->data, data, dlen);
3719
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003720 bt_cb(skb)->incoming = 1;
Patrick McHardya61bbcf2005-08-14 17:24:31 -07003721 __net_timestamp(skb);
Marcel Holtmann576c7d82005-08-06 12:36:54 +02003722
Marcel Holtmann0d48d932005-08-09 20:30:28 -07003723 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003724 skb->dev = (void *) hdev;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003725 hci_send_to_sock(hdev, skb, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003726 kfree_skb(skb);
3727}