blob: 0a2b128d2cc9a9629d81623e5f51c25bcf2b24c2 [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI event handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <asm/unaligned.h>
28
29#include <net/bluetooth/bluetooth.h>
30#include <net/bluetooth/hci_core.h>
Mikel Astizf0d6a0e2012-08-09 09:52:30 +020031#include <net/bluetooth/mgmt.h>
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +030032#include <net/bluetooth/a2mp.h>
Andrei Emeltchenko903e4542012-09-27 17:26:09 +030033#include <net/bluetooth/amp.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
Linus Torvalds1da177e2005-04-16 15:20:36 -070035/* Handle HCI Event packets */
36
Marcel Holtmanna9de9242007-10-20 13:33:56 +020037static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070038{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020039 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070040
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030041 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
Andre Guedese6d465c2011-11-09 17:14:26 -030043 if (status) {
44 hci_dev_lock(hdev);
45 mgmt_stop_discovery_failed(hdev, status);
46 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020047 return;
Andre Guedese6d465c2011-11-09 17:14:26 -030048 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070049
Andre Guedes89352e72011-11-04 14:16:53 -030050 clear_bit(HCI_INQUIRY, &hdev->flags);
Andre Guedes3e13fa12013-03-27 20:04:56 -030051 smp_mb__after_clear_bit(); /* wake_up_bit advises about this barrier */
52 wake_up_bit(&hdev->flags, HCI_INQUIRY);
Andre Guedes89352e72011-11-04 14:16:53 -030053
Johan Hedberg56e5cb82011-11-08 20:40:16 +020054 hci_dev_lock(hdev);
Johan Hedbergff9ef572012-01-04 14:23:45 +020055 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Johan Hedberg56e5cb82011-11-08 20:40:16 +020056 hci_dev_unlock(hdev);
Marcel Holtmann6bd57412006-11-18 22:14:22 +010057
Marcel Holtmanna9de9242007-10-20 13:33:56 +020058 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070059}
60
Andre Guedes4d934832012-03-21 00:03:35 -030061static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
62{
63 __u8 status = *((__u8 *) skb->data);
64
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030065 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesae854a72012-03-21 00:03:36 -030066
67 if (status)
68 return;
69
70 set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
Andre Guedes4d934832012-03-21 00:03:35 -030071}
72
Marcel Holtmanna9de9242007-10-20 13:33:56 +020073static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070074{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020075 __u8 status = *((__u8 *) skb->data);
76
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030077 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020078
79 if (status)
80 return;
81
Andre Guedesae854a72012-03-21 00:03:36 -030082 clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
83
Marcel Holtmanna9de9242007-10-20 13:33:56 +020084 hci_conn_check_pending(hdev);
85}
86
Gustavo Padovan807deac2012-05-17 00:36:24 -030087static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
88 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020089{
90 BT_DBG("%s", hdev->name);
91}
92
93static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
94{
95 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070096 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070097
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030098 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070099
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200100 if (rp->status)
101 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200103 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200105 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
106 if (conn) {
107 if (rp->role)
108 conn->link_mode &= ~HCI_LM_MASTER;
109 else
110 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200112
113 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114}
115
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200116static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
117{
118 struct hci_rp_read_link_policy *rp = (void *) skb->data;
119 struct hci_conn *conn;
120
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300121 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200122
123 if (rp->status)
124 return;
125
126 hci_dev_lock(hdev);
127
128 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
129 if (conn)
130 conn->link_policy = __le16_to_cpu(rp->policy);
131
132 hci_dev_unlock(hdev);
133}
134
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200135static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200137 struct hci_rp_write_link_policy *rp = (void *) skb->data;
138 struct hci_conn *conn;
139 void *sent;
140
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300141 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200142
143 if (rp->status)
144 return;
145
146 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
147 if (!sent)
148 return;
149
150 hci_dev_lock(hdev);
151
152 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200153 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700154 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200155
156 hci_dev_unlock(hdev);
157}
158
Gustavo Padovan807deac2012-05-17 00:36:24 -0300159static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
160 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200161{
162 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
163
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300164 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200165
166 if (rp->status)
167 return;
168
169 hdev->link_policy = __le16_to_cpu(rp->policy);
170}
171
Gustavo Padovan807deac2012-05-17 00:36:24 -0300172static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
173 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200174{
175 __u8 status = *((__u8 *) skb->data);
176 void *sent;
177
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300178 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200179
180 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
181 if (!sent)
182 return;
183
184 if (!status)
185 hdev->link_policy = get_unaligned_le16(sent);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200186}
187
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200188static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
189{
190 __u8 status = *((__u8 *) skb->data);
191
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300192 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200193
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300194 clear_bit(HCI_RESET, &hdev->flags);
195
Johan Hedberga297e972012-02-21 17:55:47 +0200196 /* Reset all non-persistent flags */
Johan Hedberg2cc6fb02013-03-15 17:06:57 -0500197 hdev->dev_flags &= ~HCI_PERSISTENT_MASK;
Andre Guedes69775ff2012-02-23 16:50:05 +0200198
199 hdev->discovery.state = DISCOVERY_STOPPED;
Johan Hedbergbbaf4442012-11-08 01:22:59 +0100200 hdev->inq_tx_power = HCI_TX_POWER_INVALID;
201 hdev->adv_tx_power = HCI_TX_POWER_INVALID;
Johan Hedberg3f0f5242012-11-08 01:23:00 +0100202
203 memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
204 hdev->adv_data_len = 0;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200205}
206
207static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
208{
209 __u8 status = *((__u8 *) skb->data);
210 void *sent;
211
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300212 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200213
214 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
215 if (!sent)
216 return;
217
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200218 hci_dev_lock(hdev);
219
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200220 if (test_bit(HCI_MGMT, &hdev->dev_flags))
221 mgmt_set_local_name_complete(hdev, sent, status);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +0200222 else if (!status)
223 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200224
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200225 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200226}
227
228static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
229{
230 struct hci_rp_read_local_name *rp = (void *) skb->data;
231
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300232 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200233
234 if (rp->status)
235 return;
236
Johan Hedbergdb99b5f2012-02-22 20:14:22 +0200237 if (test_bit(HCI_SETUP, &hdev->dev_flags))
238 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200239}
240
241static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
242{
243 __u8 status = *((__u8 *) skb->data);
244 void *sent;
245
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300246 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200247
248 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
249 if (!sent)
250 return;
251
252 if (!status) {
253 __u8 param = *((__u8 *) sent);
254
255 if (param == AUTH_ENABLED)
256 set_bit(HCI_AUTH, &hdev->flags);
257 else
258 clear_bit(HCI_AUTH, &hdev->flags);
259 }
260
Johan Hedberg33ef95e2012-02-16 23:56:27 +0200261 if (test_bit(HCI_MGMT, &hdev->dev_flags))
262 mgmt_auth_enable_complete(hdev, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200263}
264
265static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
266{
267 __u8 status = *((__u8 *) skb->data);
268 void *sent;
269
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300270 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200271
272 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
273 if (!sent)
274 return;
275
276 if (!status) {
277 __u8 param = *((__u8 *) sent);
278
279 if (param)
280 set_bit(HCI_ENCRYPT, &hdev->flags);
281 else
282 clear_bit(HCI_ENCRYPT, &hdev->flags);
283 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200284}
285
286static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
287{
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200288 __u8 param, status = *((__u8 *) skb->data);
289 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200290 void *sent;
291
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300292 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200293
294 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
295 if (!sent)
296 return;
297
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200298 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200299
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200300 hci_dev_lock(hdev);
301
Mikel Astizfa1bd912012-08-09 09:52:29 +0200302 if (status) {
Johan Hedberg744cf192011-11-08 20:40:14 +0200303 mgmt_write_scan_failed(hdev, param, status);
Johan Hedberg2d7cee52011-11-07 22:16:03 +0200304 hdev->discov_timeout = 0;
305 goto done;
306 }
307
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200308 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
309 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200310
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200311 if (param & SCAN_INQUIRY) {
312 set_bit(HCI_ISCAN, &hdev->flags);
313 if (!old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200314 mgmt_discoverable(hdev, 1);
Johan Hedberg16ab91a2011-11-07 22:16:02 +0200315 if (hdev->discov_timeout > 0) {
316 int to = msecs_to_jiffies(hdev->discov_timeout * 1000);
317 queue_delayed_work(hdev->workqueue, &hdev->discov_off,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300318 to);
Johan Hedberg16ab91a2011-11-07 22:16:02 +0200319 }
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200320 } else if (old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200321 mgmt_discoverable(hdev, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200322
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200323 if (param & SCAN_PAGE) {
324 set_bit(HCI_PSCAN, &hdev->flags);
325 if (!old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200326 mgmt_connectable(hdev, 1);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200327 } else if (old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200328 mgmt_connectable(hdev, 0);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200329
330done:
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200331 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200332}
333
334static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
335{
336 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
337
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300338 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200339
340 if (rp->status)
341 return;
342
343 memcpy(hdev->dev_class, rp->dev_class, 3);
344
345 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300346 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200347}
348
349static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
350{
351 __u8 status = *((__u8 *) skb->data);
352 void *sent;
353
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300354 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200355
356 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
357 if (!sent)
358 return;
359
Marcel Holtmann7f9a9032012-02-22 18:38:01 +0100360 hci_dev_lock(hdev);
361
362 if (status == 0)
363 memcpy(hdev->dev_class, sent, 3);
364
365 if (test_bit(HCI_MGMT, &hdev->dev_flags))
366 mgmt_set_class_of_dev_complete(hdev, sent, status);
367
368 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200369}
370
371static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
372{
373 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200375
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300376 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200377
378 if (rp->status)
379 return;
380
381 setting = __le16_to_cpu(rp->voice_setting);
382
Marcel Holtmannf383f272008-07-14 20:13:47 +0200383 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200384 return;
385
386 hdev->voice_setting = setting;
387
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300388 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200389
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200390 if (hdev->notify)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200391 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200392}
393
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300394static void hci_cc_write_voice_setting(struct hci_dev *hdev,
395 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200396{
397 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200398 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 void *sent;
400
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300401 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402
Marcel Holtmannf383f272008-07-14 20:13:47 +0200403 if (status)
404 return;
405
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200406 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
407 if (!sent)
408 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409
Marcel Holtmannf383f272008-07-14 20:13:47 +0200410 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411
Marcel Holtmannf383f272008-07-14 20:13:47 +0200412 if (hdev->voice_setting == setting)
413 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414
Marcel Holtmannf383f272008-07-14 20:13:47 +0200415 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300417 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200418
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200419 if (hdev->notify)
Marcel Holtmannf383f272008-07-14 20:13:47 +0200420 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421}
422
Marcel Holtmann333140b2008-07-14 20:13:48 +0200423static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
424{
425 __u8 status = *((__u8 *) skb->data);
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300426 struct hci_cp_write_ssp_mode *sent;
Marcel Holtmann333140b2008-07-14 20:13:48 +0200427
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300428 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann333140b2008-07-14 20:13:48 +0200429
Marcel Holtmann333140b2008-07-14 20:13:48 +0200430 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
431 if (!sent)
432 return;
433
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300434 if (!status) {
435 if (sent->mode)
436 hdev->host_features[0] |= LMP_HOST_SSP;
437 else
438 hdev->host_features[0] &= ~LMP_HOST_SSP;
439 }
440
Johan Hedberged2c4ee2012-02-17 00:56:28 +0200441 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300442 mgmt_ssp_enable_complete(hdev, sent->mode, status);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200443 else if (!status) {
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300444 if (sent->mode)
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200445 set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
446 else
447 clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
448 }
Marcel Holtmann333140b2008-07-14 20:13:48 +0200449}
450
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200451static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
452{
453 struct hci_rp_read_local_version *rp = (void *) skb->data;
454
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300455 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200456
457 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200458 return;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200459
460 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200461 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200462 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200463 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200464 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200465
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300466 BT_DBG("%s manufacturer 0x%4.4x hci ver %d:%d", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300467 hdev->manufacturer, hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200468}
469
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300470static void hci_cc_read_local_commands(struct hci_dev *hdev,
471 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200472{
473 struct hci_rp_read_local_commands *rp = (void *) skb->data;
474
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300475 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200476
Johan Hedberg2177bab2013-03-05 20:37:43 +0200477 if (!rp->status)
478 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200479}
480
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300481static void hci_cc_read_local_features(struct hci_dev *hdev,
482 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200483{
484 struct hci_rp_read_local_features *rp = (void *) skb->data;
485
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300486 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200487
488 if (rp->status)
489 return;
490
491 memcpy(hdev->features, rp->features, 8);
492
493 /* Adjust default settings according to features
494 * supported by device. */
495
496 if (hdev->features[0] & LMP_3SLOT)
497 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
498
499 if (hdev->features[0] & LMP_5SLOT)
500 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
501
502 if (hdev->features[1] & LMP_HV2) {
503 hdev->pkt_type |= (HCI_HV2);
504 hdev->esco_type |= (ESCO_HV2);
505 }
506
507 if (hdev->features[1] & LMP_HV3) {
508 hdev->pkt_type |= (HCI_HV3);
509 hdev->esco_type |= (ESCO_HV3);
510 }
511
Andre Guedes45db810f2012-07-24 15:03:49 -0300512 if (lmp_esco_capable(hdev))
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200513 hdev->esco_type |= (ESCO_EV3);
514
515 if (hdev->features[4] & LMP_EV4)
516 hdev->esco_type |= (ESCO_EV4);
517
518 if (hdev->features[4] & LMP_EV5)
519 hdev->esco_type |= (ESCO_EV5);
520
Marcel Holtmannefc76882009-02-06 09:13:37 +0100521 if (hdev->features[5] & LMP_EDR_ESCO_2M)
522 hdev->esco_type |= (ESCO_2EV3);
523
524 if (hdev->features[5] & LMP_EDR_ESCO_3M)
525 hdev->esco_type |= (ESCO_3EV3);
526
527 if (hdev->features[5] & LMP_EDR_3S_ESCO)
528 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
529
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200530 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300531 hdev->features[0], hdev->features[1],
532 hdev->features[2], hdev->features[3],
533 hdev->features[4], hdev->features[5],
534 hdev->features[6], hdev->features[7]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200535}
536
Andre Guedes971e3a42011-06-30 19:20:52 -0300537static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300538 struct sk_buff *skb)
Andre Guedes971e3a42011-06-30 19:20:52 -0300539{
540 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
541
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300542 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andre Guedes971e3a42011-06-30 19:20:52 -0300543
544 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200545 return;
Andre Guedes971e3a42011-06-30 19:20:52 -0300546
Andre Guedesb5b32b62011-12-30 10:34:04 -0300547 switch (rp->page) {
548 case 0:
549 memcpy(hdev->features, rp->features, 8);
550 break;
551 case 1:
552 memcpy(hdev->host_features, rp->features, 8);
553 break;
554 }
Andre Guedes971e3a42011-06-30 19:20:52 -0300555}
556
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200557static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300558 struct sk_buff *skb)
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200559{
560 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
561
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300562 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200563
Johan Hedberg42c6b122013-03-05 20:37:49 +0200564 if (!rp->status)
565 hdev->flow_ctl_mode = rp->mode;
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200566}
567
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200568static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
569{
570 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
571
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300572 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200573
574 if (rp->status)
575 return;
576
577 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
578 hdev->sco_mtu = rp->sco_mtu;
579 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
580 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
581
582 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
583 hdev->sco_mtu = 64;
584 hdev->sco_pkts = 8;
585 }
586
587 hdev->acl_cnt = hdev->acl_pkts;
588 hdev->sco_cnt = hdev->sco_pkts;
589
Gustavo Padovan807deac2012-05-17 00:36:24 -0300590 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
591 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200592}
593
594static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
595{
596 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
597
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300598 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200599
600 if (!rp->status)
601 bacpy(&hdev->bdaddr, &rp->bdaddr);
Johan Hedberg23bb5762010-12-21 23:01:27 +0200602}
603
Johan Hedbergf332ec62013-03-15 17:07:11 -0500604static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
605 struct sk_buff *skb)
606{
607 struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;
608
609 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
610
611 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status) {
612 hdev->page_scan_interval = __le16_to_cpu(rp->interval);
613 hdev->page_scan_window = __le16_to_cpu(rp->window);
614 }
615}
616
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500617static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
618 struct sk_buff *skb)
619{
620 u8 status = *((u8 *) skb->data);
621 struct hci_cp_write_page_scan_activity *sent;
622
623 BT_DBG("%s status 0x%2.2x", hdev->name, status);
624
625 if (status)
626 return;
627
628 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
629 if (!sent)
630 return;
631
632 hdev->page_scan_interval = __le16_to_cpu(sent->interval);
633 hdev->page_scan_window = __le16_to_cpu(sent->window);
634}
635
Johan Hedbergf332ec62013-03-15 17:07:11 -0500636static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
637 struct sk_buff *skb)
638{
639 struct hci_rp_read_page_scan_type *rp = (void *) skb->data;
640
641 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
642
643 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status)
644 hdev->page_scan_type = rp->type;
645}
646
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500647static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
648 struct sk_buff *skb)
649{
650 u8 status = *((u8 *) skb->data);
651 u8 *type;
652
653 BT_DBG("%s status 0x%2.2x", hdev->name, status);
654
655 if (status)
656 return;
657
658 type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
659 if (type)
660 hdev->page_scan_type = *type;
661}
662
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200663static void hci_cc_read_data_block_size(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300664 struct sk_buff *skb)
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200665{
666 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
667
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300668 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200669
670 if (rp->status)
671 return;
672
673 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
674 hdev->block_len = __le16_to_cpu(rp->block_len);
675 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
676
677 hdev->block_cnt = hdev->num_blocks;
678
679 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300680 hdev->block_cnt, hdev->block_len);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200681}
682
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300683static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300684 struct sk_buff *skb)
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300685{
686 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
687
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300688 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300689
690 if (rp->status)
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300691 goto a2mp_rsp;
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300692
693 hdev->amp_status = rp->amp_status;
694 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
695 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
696 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
697 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
698 hdev->amp_type = rp->amp_type;
699 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
700 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
701 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
702 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
703
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300704a2mp_rsp:
705 a2mp_send_getinfo_rsp(hdev);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300706}
707
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300708static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
709 struct sk_buff *skb)
710{
711 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
712 struct amp_assoc *assoc = &hdev->loc_assoc;
713 size_t rem_len, frag_len;
714
715 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
716
717 if (rp->status)
718 goto a2mp_rsp;
719
720 frag_len = skb->len - sizeof(*rp);
721 rem_len = __le16_to_cpu(rp->rem_len);
722
723 if (rem_len > frag_len) {
Andrei Emeltchenko2e430be32012-09-28 14:44:23 +0300724 BT_DBG("frag_len %zu rem_len %zu", frag_len, rem_len);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300725
726 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
727 assoc->offset += frag_len;
728
729 /* Read other fragments */
730 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
731
732 return;
733 }
734
735 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
736 assoc->len = assoc->offset + rem_len;
737 assoc->offset = 0;
738
739a2mp_rsp:
740 /* Send A2MP Rsp when all fragments are received */
741 a2mp_send_getampassoc_rsp(hdev, rp->status);
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +0300742 a2mp_send_create_phy_link_req(hdev, rp->status);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300743}
744
Johan Hedbergd5859e22011-01-25 01:19:58 +0200745static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300746 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200747{
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700748 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200749
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300750 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200751
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700752 if (!rp->status)
753 hdev->inq_tx_power = rp->tx_power;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200754}
755
Johan Hedberg980e1a52011-01-22 06:10:07 +0200756static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
757{
758 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
759 struct hci_cp_pin_code_reply *cp;
760 struct hci_conn *conn;
761
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300762 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200763
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200764 hci_dev_lock(hdev);
765
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200766 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200767 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200768
Mikel Astizfa1bd912012-08-09 09:52:29 +0200769 if (rp->status)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200770 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200771
772 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
773 if (!cp)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200774 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200775
776 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
777 if (conn)
778 conn->pin_length = cp->pin_len;
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200779
780unlock:
781 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200782}
783
784static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
785{
786 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
787
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300788 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200789
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200790 hci_dev_lock(hdev);
791
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200792 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200793 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300794 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200795
796 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200797}
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200798
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300799static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
800 struct sk_buff *skb)
801{
802 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
803
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300804 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300805
806 if (rp->status)
807 return;
808
809 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
810 hdev->le_pkts = rp->le_max_pkt;
811
812 hdev->le_cnt = hdev->le_pkts;
813
814 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300815}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200816
Johan Hedberg60e77322013-01-22 14:01:59 +0200817static void hci_cc_le_read_local_features(struct hci_dev *hdev,
818 struct sk_buff *skb)
819{
820 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
821
822 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
823
824 if (!rp->status)
825 memcpy(hdev->le_features, rp->features, 8);
Johan Hedberg60e77322013-01-22 14:01:59 +0200826}
827
Johan Hedberg8fa19092012-10-19 20:57:49 +0300828static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
829 struct sk_buff *skb)
830{
831 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
832
833 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
834
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500835 if (!rp->status)
Johan Hedberg8fa19092012-10-19 20:57:49 +0300836 hdev->adv_tx_power = rp->tx_power;
Johan Hedberg8fa19092012-10-19 20:57:49 +0300837}
838
Johan Hedberga5c29682011-02-19 12:05:57 -0300839static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
840{
841 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
842
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300843 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300844
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200845 hci_dev_lock(hdev);
846
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200847 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300848 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
849 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200850
851 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300852}
853
854static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300855 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -0300856{
857 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
858
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300859 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300860
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200861 hci_dev_lock(hdev);
862
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200863 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200864 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300865 ACL_LINK, 0, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200866
867 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300868}
869
Brian Gix1143d452011-11-23 08:28:34 -0800870static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
871{
872 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
873
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300874 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800875
876 hci_dev_lock(hdev);
877
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200878 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +0200879 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300880 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800881
882 hci_dev_unlock(hdev);
883}
884
885static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300886 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -0800887{
888 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
889
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300890 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800891
892 hci_dev_lock(hdev);
893
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200894 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Brian Gix1143d452011-11-23 08:28:34 -0800895 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300896 ACL_LINK, 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800897
898 hci_dev_unlock(hdev);
899}
900
Szymon Jancc35938b2011-03-22 13:12:21 +0100901static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300902 struct sk_buff *skb)
Szymon Jancc35938b2011-03-22 13:12:21 +0100903{
904 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
905
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300906 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Szymon Jancc35938b2011-03-22 13:12:21 +0100907
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200908 hci_dev_lock(hdev);
Johan Hedberg744cf192011-11-08 20:40:14 +0200909 mgmt_read_local_oob_data_reply_complete(hdev, rp->hash,
Szymon Jancc35938b2011-03-22 13:12:21 +0100910 rp->randomizer, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200911 hci_dev_unlock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +0100912}
913
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100914static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
915{
916 __u8 *sent, status = *((__u8 *) skb->data);
917
918 BT_DBG("%s status 0x%2.2x", hdev->name, status);
919
920 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
921 if (!sent)
922 return;
923
924 hci_dev_lock(hdev);
925
926 if (!status) {
927 if (*sent)
928 set_bit(HCI_LE_PERIPHERAL, &hdev->dev_flags);
929 else
930 clear_bit(HCI_LE_PERIPHERAL, &hdev->dev_flags);
931 }
932
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500933 if (!test_bit(HCI_INIT, &hdev->flags)) {
934 struct hci_request req;
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100935
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500936 hci_req_init(&req, hdev);
937 hci_update_ad(&req);
938 hci_req_run(&req, NULL);
939 }
940
941 hci_dev_unlock(hdev);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100942}
943
Andre Guedes07f7fa52011-12-02 21:13:31 +0900944static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
945{
946 __u8 status = *((__u8 *) skb->data);
947
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300948 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedes7ba8b4b2012-02-03 17:47:59 -0300949
Andre Guedes3fd24152012-02-03 17:48:01 -0300950 if (status) {
951 hci_dev_lock(hdev);
952 mgmt_start_discovery_failed(hdev, status);
953 hci_dev_unlock(hdev);
954 return;
955 }
Andre Guedes07f7fa52011-12-02 21:13:31 +0900956}
957
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300958static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300959 struct sk_buff *skb)
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300960{
961 struct hci_cp_le_set_scan_enable *cp;
962 __u8 status = *((__u8 *) skb->data);
963
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300964 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300965
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300966 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
967 if (!cp)
968 return;
969
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +0200970 switch (cp->enable) {
971 case LE_SCANNING_ENABLED:
Andre Guedes3fd24152012-02-03 17:48:01 -0300972 if (status) {
973 hci_dev_lock(hdev);
974 mgmt_start_discovery_failed(hdev, status);
975 hci_dev_unlock(hdev);
Andre Guedes7ba8b4b2012-02-03 17:47:59 -0300976 return;
Andre Guedes3fd24152012-02-03 17:48:01 -0300977 }
Andre Guedes7ba8b4b2012-02-03 17:47:59 -0300978
Andre Guedesd23264a2011-11-25 20:53:38 -0300979 set_bit(HCI_LE_SCAN, &hdev->dev_flags);
980
Andre Guedesa8f13c82011-09-09 18:56:24 -0300981 hci_dev_lock(hdev);
Andre Guedes343f9352012-02-17 20:39:37 -0300982 hci_discovery_set_state(hdev, DISCOVERY_FINDING);
Andre Guedesa8f13c82011-09-09 18:56:24 -0300983 hci_dev_unlock(hdev);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +0200984 break;
985
986 case LE_SCANNING_DISABLED:
Andre Guedesc9ecc482012-03-15 16:52:08 -0300987 if (status) {
988 hci_dev_lock(hdev);
989 mgmt_stop_discovery_failed(hdev, status);
990 hci_dev_unlock(hdev);
Andre Guedes7ba8b4b2012-02-03 17:47:59 -0300991 return;
Andre Guedesc9ecc482012-03-15 16:52:08 -0300992 }
Andre Guedes7ba8b4b2012-02-03 17:47:59 -0300993
Andre Guedesd23264a2011-11-25 20:53:38 -0300994 clear_bit(HCI_LE_SCAN, &hdev->dev_flags);
995
Andre Guedesbc3dd332012-03-06 19:37:06 -0300996 if (hdev->discovery.type == DISCOV_TYPE_INTERLEAVED &&
997 hdev->discovery.state == DISCOVERY_FINDING) {
Andre Guedes5e0452c2012-02-17 20:39:38 -0300998 mgmt_interleaved_discovery(hdev);
999 } else {
1000 hci_dev_lock(hdev);
1001 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1002 hci_dev_unlock(hdev);
1003 }
1004
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001005 break;
1006
1007 default:
1008 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1009 break;
Andre Guedes35815082011-05-26 16:23:53 -03001010 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001011}
1012
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001013static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
1014 struct sk_buff *skb)
1015{
1016 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
1017
1018 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
1019
1020 if (!rp->status)
1021 hdev->le_white_list_size = rp->size;
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001022}
1023
Johan Hedberg9b008c02013-01-22 14:02:01 +02001024static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
1025 struct sk_buff *skb)
1026{
1027 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
1028
1029 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1030
1031 if (!rp->status)
1032 memcpy(hdev->le_states, rp->le_states, 8);
Johan Hedberg9b008c02013-01-22 14:02:01 +02001033}
1034
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001035static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1036 struct sk_buff *skb)
Andre Guedesf9b49302011-06-30 19:20:53 -03001037{
Johan Hedberg06199cf2012-02-22 16:37:11 +02001038 struct hci_cp_write_le_host_supported *sent;
Andre Guedesf9b49302011-06-30 19:20:53 -03001039 __u8 status = *((__u8 *) skb->data);
1040
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001041 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001042
Johan Hedberg06199cf2012-02-22 16:37:11 +02001043 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001044 if (!sent)
Andre Guedesf9b49302011-06-30 19:20:53 -03001045 return;
1046
Johan Hedberg8f984df2012-02-28 01:07:22 +02001047 if (!status) {
1048 if (sent->le)
1049 hdev->host_features[0] |= LMP_HOST_LE;
1050 else
1051 hdev->host_features[0] &= ~LMP_HOST_LE;
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001052
1053 if (sent->simul)
1054 hdev->host_features[0] |= LMP_HOST_LE_BREDR;
1055 else
1056 hdev->host_features[0] &= ~LMP_HOST_LE_BREDR;
Johan Hedberg8f984df2012-02-28 01:07:22 +02001057 }
1058
1059 if (test_bit(HCI_MGMT, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001060 !test_bit(HCI_INIT, &hdev->flags))
Johan Hedberg8f984df2012-02-28 01:07:22 +02001061 mgmt_le_enable_complete(hdev, sent->le, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001062}
1063
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001064static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1065 struct sk_buff *skb)
1066{
1067 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1068
1069 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1070 hdev->name, rp->status, rp->phy_handle);
1071
1072 if (rp->status)
1073 return;
1074
1075 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1076}
1077
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001078static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001079{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001080 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001081
1082 if (status) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001083 hci_conn_check_pending(hdev);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001084 hci_dev_lock(hdev);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001085 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Andre Guedes7a135102011-11-09 17:14:25 -03001086 mgmt_start_discovery_failed(hdev, status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001087 hci_dev_unlock(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001088 return;
1089 }
1090
Andre Guedes89352e72011-11-04 14:16:53 -03001091 set_bit(HCI_INQUIRY, &hdev->flags);
1092
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001093 hci_dev_lock(hdev);
Andre Guedes343f9352012-02-17 20:39:37 -03001094 hci_discovery_set_state(hdev, DISCOVERY_FINDING);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001095 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001096}
1097
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001098static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001099{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001100 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001101 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001102
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001103 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001104
1105 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001106 if (!cp)
1107 return;
1108
1109 hci_dev_lock(hdev);
1110
1111 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1112
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001113 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001114
1115 if (status) {
1116 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001117 if (status != 0x0c || conn->attempt > 2) {
1118 conn->state = BT_CLOSED;
1119 hci_proto_connect_cfm(conn, status);
1120 hci_conn_del(conn);
1121 } else
1122 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001123 }
1124 } else {
1125 if (!conn) {
1126 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1127 if (conn) {
Johan Hedberga0c808b2012-01-16 09:49:58 +02001128 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001129 conn->link_mode |= HCI_LM_MASTER;
1130 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001131 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001132 }
1133 }
1134
1135 hci_dev_unlock(hdev);
1136}
1137
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001138static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001139{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001140 struct hci_cp_add_sco *cp;
1141 struct hci_conn *acl, *sco;
1142 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001143
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001144 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001145
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001146 if (!status)
1147 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001148
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001149 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1150 if (!cp)
1151 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001152
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001153 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001154
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001155 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001156
1157 hci_dev_lock(hdev);
1158
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001159 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001160 if (acl) {
1161 sco = acl->link;
1162 if (sco) {
1163 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001164
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001165 hci_proto_connect_cfm(sco, status);
1166 hci_conn_del(sco);
1167 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001168 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001169
1170 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001171}
1172
Marcel Holtmannf8558552008-07-14 20:13:49 +02001173static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1174{
1175 struct hci_cp_auth_requested *cp;
1176 struct hci_conn *conn;
1177
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001178 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001179
1180 if (!status)
1181 return;
1182
1183 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1184 if (!cp)
1185 return;
1186
1187 hci_dev_lock(hdev);
1188
1189 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1190 if (conn) {
1191 if (conn->state == BT_CONFIG) {
1192 hci_proto_connect_cfm(conn, status);
1193 hci_conn_put(conn);
1194 }
1195 }
1196
1197 hci_dev_unlock(hdev);
1198}
1199
1200static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1201{
1202 struct hci_cp_set_conn_encrypt *cp;
1203 struct hci_conn *conn;
1204
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001205 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001206
1207 if (!status)
1208 return;
1209
1210 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1211 if (!cp)
1212 return;
1213
1214 hci_dev_lock(hdev);
1215
1216 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1217 if (conn) {
1218 if (conn->state == BT_CONFIG) {
1219 hci_proto_connect_cfm(conn, status);
1220 hci_conn_put(conn);
1221 }
1222 }
1223
1224 hci_dev_unlock(hdev);
1225}
1226
Johan Hedberg127178d2010-11-18 22:22:29 +02001227static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001228 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001229{
Johan Hedberg392599b2010-11-18 22:22:28 +02001230 if (conn->state != BT_CONFIG || !conn->out)
1231 return 0;
1232
Johan Hedberg765c2a92011-01-19 12:06:52 +05301233 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001234 return 0;
1235
1236 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001237 * devices with sec_level HIGH or if MITM protection is requested */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001238 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
1239 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001240 return 0;
1241
Johan Hedberg392599b2010-11-18 22:22:28 +02001242 return 1;
1243}
1244
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001245static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001246 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001247{
1248 struct hci_cp_remote_name_req cp;
1249
1250 memset(&cp, 0, sizeof(cp));
1251
1252 bacpy(&cp.bdaddr, &e->data.bdaddr);
1253 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1254 cp.pscan_mode = e->data.pscan_mode;
1255 cp.clock_offset = e->data.clock_offset;
1256
1257 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1258}
1259
Johan Hedbergb644ba32012-01-17 21:48:47 +02001260static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001261{
1262 struct discovery_state *discov = &hdev->discovery;
1263 struct inquiry_entry *e;
1264
Johan Hedbergb644ba32012-01-17 21:48:47 +02001265 if (list_empty(&discov->resolve))
1266 return false;
1267
1268 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001269 if (!e)
1270 return false;
1271
Johan Hedbergb644ba32012-01-17 21:48:47 +02001272 if (hci_resolve_name(hdev, e) == 0) {
1273 e->name_state = NAME_PENDING;
1274 return true;
1275 }
1276
1277 return false;
1278}
1279
1280static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001281 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001282{
1283 struct discovery_state *discov = &hdev->discovery;
1284 struct inquiry_entry *e;
1285
1286 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001287 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1288 name_len, conn->dev_class);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001289
1290 if (discov->state == DISCOVERY_STOPPED)
1291 return;
1292
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001293 if (discov->state == DISCOVERY_STOPPING)
1294 goto discov_complete;
1295
1296 if (discov->state != DISCOVERY_RESOLVING)
1297 return;
1298
1299 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001300 /* If the device was not found in a list of found devices names of which
1301 * are pending. there is no need to continue resolving a next name as it
1302 * will be done upon receiving another Remote Name Request Complete
1303 * Event */
1304 if (!e)
1305 return;
1306
1307 list_del(&e->list);
1308 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001309 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001310 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1311 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001312 } else {
1313 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001314 }
1315
Johan Hedbergb644ba32012-01-17 21:48:47 +02001316 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001317 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001318
1319discov_complete:
1320 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1321}
1322
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001323static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1324{
Johan Hedberg127178d2010-11-18 22:22:29 +02001325 struct hci_cp_remote_name_req *cp;
1326 struct hci_conn *conn;
1327
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001328 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001329
1330 /* If successful wait for the name req complete event before
1331 * checking for the need to do authentication */
1332 if (!status)
1333 return;
1334
1335 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1336 if (!cp)
1337 return;
1338
1339 hci_dev_lock(hdev);
1340
1341 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001342
1343 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1344 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1345
Johan Hedberg79c6c702011-04-28 11:28:55 -07001346 if (!conn)
1347 goto unlock;
1348
1349 if (!hci_outgoing_auth_needed(hdev, conn))
1350 goto unlock;
1351
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001352 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001353 struct hci_cp_auth_requested cp;
1354 cp.handle = __cpu_to_le16(conn->handle);
1355 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1356 }
1357
Johan Hedberg79c6c702011-04-28 11:28:55 -07001358unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001359 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001360}
1361
Marcel Holtmann769be972008-07-14 20:13:49 +02001362static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1363{
1364 struct hci_cp_read_remote_features *cp;
1365 struct hci_conn *conn;
1366
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001367 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001368
1369 if (!status)
1370 return;
1371
1372 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1373 if (!cp)
1374 return;
1375
1376 hci_dev_lock(hdev);
1377
1378 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1379 if (conn) {
1380 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001381 hci_proto_connect_cfm(conn, status);
1382 hci_conn_put(conn);
1383 }
1384 }
1385
1386 hci_dev_unlock(hdev);
1387}
1388
1389static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1390{
1391 struct hci_cp_read_remote_ext_features *cp;
1392 struct hci_conn *conn;
1393
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001394 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001395
1396 if (!status)
1397 return;
1398
1399 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1400 if (!cp)
1401 return;
1402
1403 hci_dev_lock(hdev);
1404
1405 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1406 if (conn) {
1407 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001408 hci_proto_connect_cfm(conn, status);
1409 hci_conn_put(conn);
1410 }
1411 }
1412
1413 hci_dev_unlock(hdev);
1414}
1415
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001416static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1417{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001418 struct hci_cp_setup_sync_conn *cp;
1419 struct hci_conn *acl, *sco;
1420 __u16 handle;
1421
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001422 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001423
1424 if (!status)
1425 return;
1426
1427 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1428 if (!cp)
1429 return;
1430
1431 handle = __le16_to_cpu(cp->handle);
1432
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001433 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001434
1435 hci_dev_lock(hdev);
1436
1437 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001438 if (acl) {
1439 sco = acl->link;
1440 if (sco) {
1441 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001442
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001443 hci_proto_connect_cfm(sco, status);
1444 hci_conn_del(sco);
1445 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001446 }
1447
1448 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001449}
1450
1451static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1452{
1453 struct hci_cp_sniff_mode *cp;
1454 struct hci_conn *conn;
1455
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001456 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001457
1458 if (!status)
1459 return;
1460
1461 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1462 if (!cp)
1463 return;
1464
1465 hci_dev_lock(hdev);
1466
1467 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001468 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001469 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001470
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001471 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001472 hci_sco_setup(conn, status);
1473 }
1474
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001475 hci_dev_unlock(hdev);
1476}
1477
1478static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1479{
1480 struct hci_cp_exit_sniff_mode *cp;
1481 struct hci_conn *conn;
1482
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001483 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001484
1485 if (!status)
1486 return;
1487
1488 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1489 if (!cp)
1490 return;
1491
1492 hci_dev_lock(hdev);
1493
1494 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001495 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001496 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001497
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001498 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001499 hci_sco_setup(conn, status);
1500 }
1501
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001502 hci_dev_unlock(hdev);
1503}
1504
Johan Hedberg88c3df12012-02-09 14:27:38 +02001505static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1506{
1507 struct hci_cp_disconnect *cp;
1508 struct hci_conn *conn;
1509
1510 if (!status)
1511 return;
1512
1513 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1514 if (!cp)
1515 return;
1516
1517 hci_dev_lock(hdev);
1518
1519 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1520 if (conn)
1521 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001522 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001523
1524 hci_dev_unlock(hdev);
1525}
1526
Ville Tervofcd89c02011-02-10 22:38:47 -03001527static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1528{
Ville Tervofcd89c02011-02-10 22:38:47 -03001529 struct hci_conn *conn;
1530
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001531 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Ville Tervofcd89c02011-02-10 22:38:47 -03001532
Ville Tervofcd89c02011-02-10 22:38:47 -03001533 if (status) {
Andre Guedesf00a06a2012-07-27 15:10:13 -03001534 hci_dev_lock(hdev);
Ville Tervofcd89c02011-02-10 22:38:47 -03001535
Andre Guedes0c95ab72012-07-27 15:10:14 -03001536 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001537 if (!conn) {
1538 hci_dev_unlock(hdev);
1539 return;
1540 }
1541
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001542 BT_DBG("%s bdaddr %pMR conn %p", hdev->name, &conn->dst, conn);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001543
1544 conn->state = BT_CLOSED;
Andre Guedes0c95ab72012-07-27 15:10:14 -03001545 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Andre Guedesf00a06a2012-07-27 15:10:13 -03001546 conn->dst_type, status);
1547 hci_proto_connect_cfm(conn, status);
1548 hci_conn_del(conn);
1549
1550 hci_dev_unlock(hdev);
1551 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001552}
1553
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001554static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1555{
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001556 struct hci_cp_create_phy_link *cp;
1557
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001558 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001559
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001560 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1561 if (!cp)
1562 return;
1563
Andrei Emeltchenkoe58917b2012-10-31 15:46:33 +02001564 hci_dev_lock(hdev);
1565
1566 if (status) {
1567 struct hci_conn *hcon;
1568
1569 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1570 if (hcon)
1571 hci_conn_del(hcon);
1572 } else {
1573 amp_write_remote_assoc(hdev, cp->phy_handle);
1574 }
1575
1576 hci_dev_unlock(hdev);
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001577}
1578
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03001579static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1580{
1581 struct hci_cp_accept_phy_link *cp;
1582
1583 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1584
1585 if (status)
1586 return;
1587
1588 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1589 if (!cp)
1590 return;
1591
1592 amp_write_remote_assoc(hdev, cp->phy_handle);
1593}
1594
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001595static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001596{
1597 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001598 struct discovery_state *discov = &hdev->discovery;
1599 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001600
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001601 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001602
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001603 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001604
1605 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1606 return;
1607
Andre Guedes3e13fa12013-03-27 20:04:56 -03001608 smp_mb__after_clear_bit(); /* wake_up_bit advises about this barrier */
1609 wake_up_bit(&hdev->flags, HCI_INQUIRY);
1610
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001611 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001612 return;
1613
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001614 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001615
Andre Guedes343f9352012-02-17 20:39:37 -03001616 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001617 goto unlock;
1618
1619 if (list_empty(&discov->resolve)) {
1620 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1621 goto unlock;
1622 }
1623
1624 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1625 if (e && hci_resolve_name(hdev, e) == 0) {
1626 e->name_state = NAME_PENDING;
1627 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1628 } else {
1629 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1630 }
1631
1632unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001633 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001634}
1635
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001636static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001638 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001639 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640 int num_rsp = *((__u8 *) skb->data);
1641
1642 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1643
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001644 if (!num_rsp)
1645 return;
1646
Andre Guedes1519cc12012-03-21 00:03:38 -03001647 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1648 return;
1649
Linus Torvalds1da177e2005-04-16 15:20:36 -07001650 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001651
Johan Hedberge17acd42011-03-30 23:57:16 +03001652 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001653 bool name_known, ssp;
Johan Hedberg31754052012-01-04 13:39:52 +02001654
Linus Torvalds1da177e2005-04-16 15:20:36 -07001655 bacpy(&data.bdaddr, &info->bdaddr);
1656 data.pscan_rep_mode = info->pscan_rep_mode;
1657 data.pscan_period_mode = info->pscan_period_mode;
1658 data.pscan_mode = info->pscan_mode;
1659 memcpy(data.dev_class, info->dev_class, 3);
1660 data.clock_offset = info->clock_offset;
1661 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001662 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02001663
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001664 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02001665 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001666 info->dev_class, 0, !name_known, ssp, NULL,
1667 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001668 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001669
Linus Torvalds1da177e2005-04-16 15:20:36 -07001670 hci_dev_unlock(hdev);
1671}
1672
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001673static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001674{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001675 struct hci_ev_conn_complete *ev = (void *) skb->data;
1676 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001677
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001678 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001679
Linus Torvalds1da177e2005-04-16 15:20:36 -07001680 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001681
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001682 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001683 if (!conn) {
1684 if (ev->link_type != SCO_LINK)
1685 goto unlock;
1686
1687 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1688 if (!conn)
1689 goto unlock;
1690
1691 conn->type = SCO_LINK;
1692 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001693
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001694 if (!ev->status) {
1695 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001696
1697 if (conn->type == ACL_LINK) {
1698 conn->state = BT_CONFIG;
1699 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02001700
1701 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1702 !hci_find_link_key(hdev, &ev->bdaddr))
1703 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1704 else
1705 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02001706 } else
1707 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001708
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07001709 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001710 hci_conn_add_sysfs(conn);
1711
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001712 if (test_bit(HCI_AUTH, &hdev->flags))
1713 conn->link_mode |= HCI_LM_AUTH;
1714
1715 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1716 conn->link_mode |= HCI_LM_ENCRYPT;
1717
1718 /* Get remote features */
1719 if (conn->type == ACL_LINK) {
1720 struct hci_cp_read_remote_features cp;
1721 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001722 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001723 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001724 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001725
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001726 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02001727 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001728 struct hci_cp_change_conn_ptype cp;
1729 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001730 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001731 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
1732 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001733 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001734 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001735 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001736 if (conn->type == ACL_LINK)
Johan Hedberg744cf192011-11-08 20:40:14 +02001737 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001738 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02001739 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001740
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001741 if (conn->type == ACL_LINK)
1742 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001743
Marcel Holtmann769be972008-07-14 20:13:49 +02001744 if (ev->status) {
1745 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001746 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001747 } else if (ev->link_type != ACL_LINK)
1748 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001749
1750unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001751 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001752
1753 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001754}
1755
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001756void hci_conn_accept(struct hci_conn *conn, int mask)
1757{
1758 struct hci_dev *hdev = conn->hdev;
1759
1760 BT_DBG("conn %p", conn);
1761
1762 conn->state = BT_CONFIG;
1763
1764 if (!lmp_esco_capable(hdev)) {
1765 struct hci_cp_accept_conn_req cp;
1766
1767 bacpy(&cp.bdaddr, &conn->dst);
1768
1769 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1770 cp.role = 0x00; /* Become master */
1771 else
1772 cp.role = 0x01; /* Remain slave */
1773
1774 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp), &cp);
1775 } else /* lmp_esco_capable(hdev)) */ {
1776 struct hci_cp_accept_sync_conn_req cp;
1777
1778 bacpy(&cp.bdaddr, &conn->dst);
1779 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1780
1781 cp.tx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1782 cp.rx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1783 cp.max_latency = __constant_cpu_to_le16(0xffff);
1784 cp.content_format = cpu_to_le16(hdev->voice_setting);
1785 cp.retrans_effort = 0xff;
1786
1787 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1788 sizeof(cp), &cp);
1789 }
1790}
1791
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001792static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001793{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001794 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001795 int mask = hdev->link_mode;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001796 __u8 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001797
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001798 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001799 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001801 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
1802 &flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001803
Szymon Janc138d22e2011-02-17 16:44:23 +01001804 if ((mask & HCI_LM_ACCEPT) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001805 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001806 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001807 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001808 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001809
1810 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001811
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001812 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1813 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001814 memcpy(ie->data.dev_class, ev->dev_class, 3);
1815
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03001816 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
1817 &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001818 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001819 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1820 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001821 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001822 hci_dev_unlock(hdev);
1823 return;
1824 }
1825 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001826
Linus Torvalds1da177e2005-04-16 15:20:36 -07001827 memcpy(conn->dev_class, ev->dev_class, 3);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001828
Linus Torvalds1da177e2005-04-16 15:20:36 -07001829 hci_dev_unlock(hdev);
1830
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001831 if (ev->link_type == ACL_LINK ||
1832 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001833 struct hci_cp_accept_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001834 conn->state = BT_CONNECT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001835
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001836 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001837
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001838 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1839 cp.role = 0x00; /* Become master */
1840 else
1841 cp.role = 0x01; /* Remain slave */
1842
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001843 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
1844 &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001845 } else if (!(flags & HCI_PROTO_DEFER)) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001846 struct hci_cp_accept_sync_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001847 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001848
1849 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001850 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001851
Andrei Emeltchenko82781e62012-05-25 11:38:27 +03001852 cp.tx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1853 cp.rx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1854 cp.max_latency = __constant_cpu_to_le16(0xffff);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001855 cp.content_format = cpu_to_le16(hdev->voice_setting);
1856 cp.retrans_effort = 0xff;
1857
1858 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001859 sizeof(cp), &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001860 } else {
1861 conn->state = BT_CONNECT2;
1862 hci_proto_connect_cfm(conn, 0);
1863 hci_conn_put(conn);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001864 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001865 } else {
1866 /* Connection rejected */
1867 struct hci_cp_reject_conn_req cp;
1868
1869 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02001870 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001871 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001872 }
1873}
1874
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001875static u8 hci_to_mgmt_reason(u8 err)
1876{
1877 switch (err) {
1878 case HCI_ERROR_CONNECTION_TIMEOUT:
1879 return MGMT_DEV_DISCONN_TIMEOUT;
1880 case HCI_ERROR_REMOTE_USER_TERM:
1881 case HCI_ERROR_REMOTE_LOW_RESOURCES:
1882 case HCI_ERROR_REMOTE_POWER_OFF:
1883 return MGMT_DEV_DISCONN_REMOTE;
1884 case HCI_ERROR_LOCAL_HOST_TERM:
1885 return MGMT_DEV_DISCONN_LOCAL_HOST;
1886 default:
1887 return MGMT_DEV_DISCONN_UNKNOWN;
1888 }
1889}
1890
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001891static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001892{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001893 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001894 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001895
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001896 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001897
Linus Torvalds1da177e2005-04-16 15:20:36 -07001898 hci_dev_lock(hdev);
1899
Marcel Holtmann04837f62006-07-03 10:02:33 +02001900 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001901 if (!conn)
1902 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001903
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001904 if (ev->status == 0)
1905 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001906
Johan Hedbergb644ba32012-01-17 21:48:47 +02001907 if (test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001908 (conn->type == ACL_LINK || conn->type == LE_LINK)) {
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001909 if (ev->status) {
Johan Hedberg88c3df12012-02-09 14:27:38 +02001910 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001911 conn->dst_type, ev->status);
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001912 } else {
1913 u8 reason = hci_to_mgmt_reason(ev->reason);
1914
Johan Hedbergafc747a2012-01-15 18:11:07 +02001915 mgmt_device_disconnected(hdev, &conn->dst, conn->type,
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001916 conn->dst_type, reason);
1917 }
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001918 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001919
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001920 if (ev->status == 0) {
Vishal Agarwal6ec5bca2012-04-16 14:44:44 +05301921 if (conn->type == ACL_LINK && conn->flush_key)
1922 hci_remove_link_key(hdev, &conn->dst);
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001923 hci_proto_disconn_cfm(conn, ev->reason);
1924 hci_conn_del(conn);
1925 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001926
1927unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001928 hci_dev_unlock(hdev);
1929}
1930
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001931static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001932{
1933 struct hci_ev_auth_complete *ev = (void *) skb->data;
1934 struct hci_conn *conn;
1935
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001936 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001937
1938 hci_dev_lock(hdev);
1939
1940 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001941 if (!conn)
1942 goto unlock;
1943
1944 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02001945 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001946 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001947 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001948 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001949 conn->link_mode |= HCI_LM_AUTH;
1950 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001951 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001952 } else {
Johan Hedbergbab73cb2012-02-09 16:07:29 +02001953 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001954 ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001955 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001956
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001957 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
1958 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001959
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001960 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02001961 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001962 struct hci_cp_set_conn_encrypt cp;
1963 cp.handle = ev->handle;
1964 cp.encrypt = 0x01;
1965 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03001966 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001967 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001968 conn->state = BT_CONNECTED;
1969 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001970 hci_conn_put(conn);
1971 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001972 } else {
1973 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001974
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001975 hci_conn_hold(conn);
1976 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1977 hci_conn_put(conn);
1978 }
1979
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001980 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001981 if (!ev->status) {
1982 struct hci_cp_set_conn_encrypt cp;
1983 cp.handle = ev->handle;
1984 cp.encrypt = 0x01;
1985 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03001986 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001987 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001988 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001989 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001990 }
1991 }
1992
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001993unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001994 hci_dev_unlock(hdev);
1995}
1996
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001997static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001998{
Johan Hedberg127178d2010-11-18 22:22:29 +02001999 struct hci_ev_remote_name *ev = (void *) skb->data;
2000 struct hci_conn *conn;
2001
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002002 BT_DBG("%s", hdev->name);
2003
2004 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02002005
2006 hci_dev_lock(hdev);
2007
2008 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002009
2010 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
2011 goto check_auth;
2012
2013 if (ev->status == 0)
2014 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002015 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02002016 else
2017 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2018
2019check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07002020 if (!conn)
2021 goto unlock;
2022
2023 if (!hci_outgoing_auth_needed(hdev, conn))
2024 goto unlock;
2025
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002026 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002027 struct hci_cp_auth_requested cp;
2028 cp.handle = __cpu_to_le16(conn->handle);
2029 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2030 }
2031
Johan Hedberg79c6c702011-04-28 11:28:55 -07002032unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02002033 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002034}
2035
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002036static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002037{
2038 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2039 struct hci_conn *conn;
2040
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002041 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002042
2043 hci_dev_lock(hdev);
2044
2045 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2046 if (conn) {
2047 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02002048 if (ev->encrypt) {
2049 /* Encryption implies authentication */
2050 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002051 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03002052 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02002053 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002054 conn->link_mode &= ~HCI_LM_ENCRYPT;
2055 }
2056
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002057 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002058
Gustavo Padovana7d77232012-05-13 03:20:07 -03002059 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03002060 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
Gustavo Padovana7d77232012-05-13 03:20:07 -03002061 hci_conn_put(conn);
2062 goto unlock;
2063 }
2064
Marcel Holtmannf8558552008-07-14 20:13:49 +02002065 if (conn->state == BT_CONFIG) {
2066 if (!ev->status)
2067 conn->state = BT_CONNECTED;
2068
2069 hci_proto_connect_cfm(conn, ev->status);
2070 hci_conn_put(conn);
2071 } else
2072 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002073 }
2074
Gustavo Padovana7d77232012-05-13 03:20:07 -03002075unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002076 hci_dev_unlock(hdev);
2077}
2078
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002079static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2080 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002081{
2082 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2083 struct hci_conn *conn;
2084
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002085 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002086
2087 hci_dev_lock(hdev);
2088
2089 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2090 if (conn) {
2091 if (!ev->status)
2092 conn->link_mode |= HCI_LM_SECURE;
2093
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002094 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002095
2096 hci_key_change_cfm(conn, ev->status);
2097 }
2098
2099 hci_dev_unlock(hdev);
2100}
2101
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002102static void hci_remote_features_evt(struct hci_dev *hdev,
2103 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002104{
2105 struct hci_ev_remote_features *ev = (void *) skb->data;
2106 struct hci_conn *conn;
2107
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002108 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002109
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002110 hci_dev_lock(hdev);
2111
2112 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002113 if (!conn)
2114 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002115
Johan Hedbergccd556f2010-11-10 17:11:51 +02002116 if (!ev->status)
2117 memcpy(conn->features, ev->features, 8);
2118
2119 if (conn->state != BT_CONFIG)
2120 goto unlock;
2121
2122 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2123 struct hci_cp_read_remote_ext_features cp;
2124 cp.handle = ev->handle;
2125 cp.page = 0x01;
2126 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002127 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002128 goto unlock;
2129 }
2130
Johan Hedberg671267b2012-05-12 16:11:50 -03002131 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002132 struct hci_cp_remote_name_req cp;
2133 memset(&cp, 0, sizeof(cp));
2134 bacpy(&cp.bdaddr, &conn->dst);
2135 cp.pscan_rep_mode = 0x02;
2136 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002137 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2138 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002139 conn->dst_type, 0, NULL, 0,
2140 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002141
Johan Hedberg127178d2010-11-18 22:22:29 +02002142 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002143 conn->state = BT_CONNECTED;
2144 hci_proto_connect_cfm(conn, ev->status);
2145 hci_conn_put(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002146 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002147
Johan Hedbergccd556f2010-11-10 17:11:51 +02002148unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002149 hci_dev_unlock(hdev);
2150}
2151
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002152static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002153{
2154 struct hci_ev_cmd_complete *ev = (void *) skb->data;
Johan Hedberg9238f362013-03-05 20:37:48 +02002155 u8 status = skb->data[sizeof(*ev)];
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002156 __u16 opcode;
2157
2158 skb_pull(skb, sizeof(*ev));
2159
2160 opcode = __le16_to_cpu(ev->opcode);
2161
2162 switch (opcode) {
2163 case HCI_OP_INQUIRY_CANCEL:
2164 hci_cc_inquiry_cancel(hdev, skb);
2165 break;
2166
Andre Guedes4d934832012-03-21 00:03:35 -03002167 case HCI_OP_PERIODIC_INQ:
2168 hci_cc_periodic_inq(hdev, skb);
2169 break;
2170
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002171 case HCI_OP_EXIT_PERIODIC_INQ:
2172 hci_cc_exit_periodic_inq(hdev, skb);
2173 break;
2174
2175 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2176 hci_cc_remote_name_req_cancel(hdev, skb);
2177 break;
2178
2179 case HCI_OP_ROLE_DISCOVERY:
2180 hci_cc_role_discovery(hdev, skb);
2181 break;
2182
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002183 case HCI_OP_READ_LINK_POLICY:
2184 hci_cc_read_link_policy(hdev, skb);
2185 break;
2186
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002187 case HCI_OP_WRITE_LINK_POLICY:
2188 hci_cc_write_link_policy(hdev, skb);
2189 break;
2190
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002191 case HCI_OP_READ_DEF_LINK_POLICY:
2192 hci_cc_read_def_link_policy(hdev, skb);
2193 break;
2194
2195 case HCI_OP_WRITE_DEF_LINK_POLICY:
2196 hci_cc_write_def_link_policy(hdev, skb);
2197 break;
2198
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002199 case HCI_OP_RESET:
2200 hci_cc_reset(hdev, skb);
2201 break;
2202
2203 case HCI_OP_WRITE_LOCAL_NAME:
2204 hci_cc_write_local_name(hdev, skb);
2205 break;
2206
2207 case HCI_OP_READ_LOCAL_NAME:
2208 hci_cc_read_local_name(hdev, skb);
2209 break;
2210
2211 case HCI_OP_WRITE_AUTH_ENABLE:
2212 hci_cc_write_auth_enable(hdev, skb);
2213 break;
2214
2215 case HCI_OP_WRITE_ENCRYPT_MODE:
2216 hci_cc_write_encrypt_mode(hdev, skb);
2217 break;
2218
2219 case HCI_OP_WRITE_SCAN_ENABLE:
2220 hci_cc_write_scan_enable(hdev, skb);
2221 break;
2222
2223 case HCI_OP_READ_CLASS_OF_DEV:
2224 hci_cc_read_class_of_dev(hdev, skb);
2225 break;
2226
2227 case HCI_OP_WRITE_CLASS_OF_DEV:
2228 hci_cc_write_class_of_dev(hdev, skb);
2229 break;
2230
2231 case HCI_OP_READ_VOICE_SETTING:
2232 hci_cc_read_voice_setting(hdev, skb);
2233 break;
2234
2235 case HCI_OP_WRITE_VOICE_SETTING:
2236 hci_cc_write_voice_setting(hdev, skb);
2237 break;
2238
Marcel Holtmann333140b2008-07-14 20:13:48 +02002239 case HCI_OP_WRITE_SSP_MODE:
2240 hci_cc_write_ssp_mode(hdev, skb);
2241 break;
2242
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002243 case HCI_OP_READ_LOCAL_VERSION:
2244 hci_cc_read_local_version(hdev, skb);
2245 break;
2246
2247 case HCI_OP_READ_LOCAL_COMMANDS:
2248 hci_cc_read_local_commands(hdev, skb);
2249 break;
2250
2251 case HCI_OP_READ_LOCAL_FEATURES:
2252 hci_cc_read_local_features(hdev, skb);
2253 break;
2254
Andre Guedes971e3a42011-06-30 19:20:52 -03002255 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2256 hci_cc_read_local_ext_features(hdev, skb);
2257 break;
2258
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002259 case HCI_OP_READ_BUFFER_SIZE:
2260 hci_cc_read_buffer_size(hdev, skb);
2261 break;
2262
2263 case HCI_OP_READ_BD_ADDR:
2264 hci_cc_read_bd_addr(hdev, skb);
2265 break;
2266
Johan Hedbergf332ec62013-03-15 17:07:11 -05002267 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2268 hci_cc_read_page_scan_activity(hdev, skb);
2269 break;
2270
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002271 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2272 hci_cc_write_page_scan_activity(hdev, skb);
2273 break;
2274
Johan Hedbergf332ec62013-03-15 17:07:11 -05002275 case HCI_OP_READ_PAGE_SCAN_TYPE:
2276 hci_cc_read_page_scan_type(hdev, skb);
2277 break;
2278
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002279 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2280 hci_cc_write_page_scan_type(hdev, skb);
2281 break;
2282
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002283 case HCI_OP_READ_DATA_BLOCK_SIZE:
2284 hci_cc_read_data_block_size(hdev, skb);
2285 break;
2286
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002287 case HCI_OP_READ_FLOW_CONTROL_MODE:
2288 hci_cc_read_flow_control_mode(hdev, skb);
2289 break;
2290
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002291 case HCI_OP_READ_LOCAL_AMP_INFO:
2292 hci_cc_read_local_amp_info(hdev, skb);
2293 break;
2294
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002295 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2296 hci_cc_read_local_amp_assoc(hdev, skb);
2297 break;
2298
Johan Hedbergd5859e22011-01-25 01:19:58 +02002299 case HCI_OP_READ_INQ_RSP_TX_POWER:
2300 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2301 break;
2302
Johan Hedberg980e1a52011-01-22 06:10:07 +02002303 case HCI_OP_PIN_CODE_REPLY:
2304 hci_cc_pin_code_reply(hdev, skb);
2305 break;
2306
2307 case HCI_OP_PIN_CODE_NEG_REPLY:
2308 hci_cc_pin_code_neg_reply(hdev, skb);
2309 break;
2310
Szymon Jancc35938b2011-03-22 13:12:21 +01002311 case HCI_OP_READ_LOCAL_OOB_DATA:
2312 hci_cc_read_local_oob_data_reply(hdev, skb);
2313 break;
2314
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002315 case HCI_OP_LE_READ_BUFFER_SIZE:
2316 hci_cc_le_read_buffer_size(hdev, skb);
2317 break;
2318
Johan Hedberg60e77322013-01-22 14:01:59 +02002319 case HCI_OP_LE_READ_LOCAL_FEATURES:
2320 hci_cc_le_read_local_features(hdev, skb);
2321 break;
2322
Johan Hedberg8fa19092012-10-19 20:57:49 +03002323 case HCI_OP_LE_READ_ADV_TX_POWER:
2324 hci_cc_le_read_adv_tx_power(hdev, skb);
2325 break;
2326
Johan Hedberga5c29682011-02-19 12:05:57 -03002327 case HCI_OP_USER_CONFIRM_REPLY:
2328 hci_cc_user_confirm_reply(hdev, skb);
2329 break;
2330
2331 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2332 hci_cc_user_confirm_neg_reply(hdev, skb);
2333 break;
2334
Brian Gix1143d452011-11-23 08:28:34 -08002335 case HCI_OP_USER_PASSKEY_REPLY:
2336 hci_cc_user_passkey_reply(hdev, skb);
2337 break;
2338
2339 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2340 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002341 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002342
2343 case HCI_OP_LE_SET_SCAN_PARAM:
2344 hci_cc_le_set_scan_param(hdev, skb);
Brian Gix1143d452011-11-23 08:28:34 -08002345 break;
2346
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01002347 case HCI_OP_LE_SET_ADV_ENABLE:
2348 hci_cc_le_set_adv_enable(hdev, skb);
2349 break;
2350
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002351 case HCI_OP_LE_SET_SCAN_ENABLE:
2352 hci_cc_le_set_scan_enable(hdev, skb);
2353 break;
2354
Johan Hedbergcf1d0812013-01-22 14:02:00 +02002355 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2356 hci_cc_le_read_white_list_size(hdev, skb);
2357 break;
2358
Johan Hedberg9b008c02013-01-22 14:02:01 +02002359 case HCI_OP_LE_READ_SUPPORTED_STATES:
2360 hci_cc_le_read_supported_states(hdev, skb);
2361 break;
2362
Andre Guedesf9b49302011-06-30 19:20:53 -03002363 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2364 hci_cc_write_le_host_supported(hdev, skb);
2365 break;
2366
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03002367 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2368 hci_cc_write_remote_amp_assoc(hdev, skb);
2369 break;
2370
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002371 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002372 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002373 break;
2374 }
2375
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002376 if (opcode != HCI_OP_NOP)
Ville Tervo6bd32322011-02-16 16:32:41 +02002377 del_timer(&hdev->cmd_timer);
2378
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002379 hci_req_cmd_complete(hdev, opcode, status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002380
Szymon Jancdbccd792012-12-11 08:51:19 +01002381 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002382 atomic_set(&hdev->cmd_cnt, 1);
2383 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002384 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002385 }
2386}
2387
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002388static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002389{
2390 struct hci_ev_cmd_status *ev = (void *) skb->data;
2391 __u16 opcode;
2392
2393 skb_pull(skb, sizeof(*ev));
2394
2395 opcode = __le16_to_cpu(ev->opcode);
2396
2397 switch (opcode) {
2398 case HCI_OP_INQUIRY:
2399 hci_cs_inquiry(hdev, ev->status);
2400 break;
2401
2402 case HCI_OP_CREATE_CONN:
2403 hci_cs_create_conn(hdev, ev->status);
2404 break;
2405
2406 case HCI_OP_ADD_SCO:
2407 hci_cs_add_sco(hdev, ev->status);
2408 break;
2409
Marcel Holtmannf8558552008-07-14 20:13:49 +02002410 case HCI_OP_AUTH_REQUESTED:
2411 hci_cs_auth_requested(hdev, ev->status);
2412 break;
2413
2414 case HCI_OP_SET_CONN_ENCRYPT:
2415 hci_cs_set_conn_encrypt(hdev, ev->status);
2416 break;
2417
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002418 case HCI_OP_REMOTE_NAME_REQ:
2419 hci_cs_remote_name_req(hdev, ev->status);
2420 break;
2421
Marcel Holtmann769be972008-07-14 20:13:49 +02002422 case HCI_OP_READ_REMOTE_FEATURES:
2423 hci_cs_read_remote_features(hdev, ev->status);
2424 break;
2425
2426 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2427 hci_cs_read_remote_ext_features(hdev, ev->status);
2428 break;
2429
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002430 case HCI_OP_SETUP_SYNC_CONN:
2431 hci_cs_setup_sync_conn(hdev, ev->status);
2432 break;
2433
2434 case HCI_OP_SNIFF_MODE:
2435 hci_cs_sniff_mode(hdev, ev->status);
2436 break;
2437
2438 case HCI_OP_EXIT_SNIFF_MODE:
2439 hci_cs_exit_sniff_mode(hdev, ev->status);
2440 break;
2441
Johan Hedberg8962ee72011-01-20 12:40:27 +02002442 case HCI_OP_DISCONNECT:
Johan Hedberg88c3df12012-02-09 14:27:38 +02002443 hci_cs_disconnect(hdev, ev->status);
Johan Hedberg8962ee72011-01-20 12:40:27 +02002444 break;
2445
Ville Tervofcd89c02011-02-10 22:38:47 -03002446 case HCI_OP_LE_CREATE_CONN:
2447 hci_cs_le_create_conn(hdev, ev->status);
2448 break;
2449
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03002450 case HCI_OP_CREATE_PHY_LINK:
2451 hci_cs_create_phylink(hdev, ev->status);
2452 break;
2453
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03002454 case HCI_OP_ACCEPT_PHY_LINK:
2455 hci_cs_accept_phylink(hdev, ev->status);
2456 break;
2457
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002458 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002459 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002460 break;
2461 }
2462
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002463 if (opcode != HCI_OP_NOP)
Ville Tervo6bd32322011-02-16 16:32:41 +02002464 del_timer(&hdev->cmd_timer);
2465
Johan Hedberg02350a72013-04-03 21:50:29 +03002466 if (ev->status ||
2467 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
2468 hci_req_cmd_complete(hdev, opcode, ev->status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002469
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002470 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002471 atomic_set(&hdev->cmd_cnt, 1);
2472 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002473 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002474 }
2475}
2476
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002477static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002478{
2479 struct hci_ev_role_change *ev = (void *) skb->data;
2480 struct hci_conn *conn;
2481
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002482 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002483
2484 hci_dev_lock(hdev);
2485
2486 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2487 if (conn) {
2488 if (!ev->status) {
2489 if (ev->role)
2490 conn->link_mode &= ~HCI_LM_MASTER;
2491 else
2492 conn->link_mode |= HCI_LM_MASTER;
2493 }
2494
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002495 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002496
2497 hci_role_switch_cfm(conn, ev->status, ev->role);
2498 }
2499
2500 hci_dev_unlock(hdev);
2501}
2502
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002503static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002504{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002505 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002506 int i;
2507
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02002508 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2509 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2510 return;
2511 }
2512
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002513 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002514 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002515 BT_DBG("%s bad parameters", hdev->name);
2516 return;
2517 }
2518
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002519 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2520
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002521 for (i = 0; i < ev->num_hndl; i++) {
2522 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002523 struct hci_conn *conn;
2524 __u16 handle, count;
2525
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002526 handle = __le16_to_cpu(info->handle);
2527 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002528
2529 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002530 if (!conn)
2531 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002532
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002533 conn->sent -= count;
2534
2535 switch (conn->type) {
2536 case ACL_LINK:
2537 hdev->acl_cnt += count;
2538 if (hdev->acl_cnt > hdev->acl_pkts)
2539 hdev->acl_cnt = hdev->acl_pkts;
2540 break;
2541
2542 case LE_LINK:
2543 if (hdev->le_pkts) {
2544 hdev->le_cnt += count;
2545 if (hdev->le_cnt > hdev->le_pkts)
2546 hdev->le_cnt = hdev->le_pkts;
2547 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002548 hdev->acl_cnt += count;
2549 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002550 hdev->acl_cnt = hdev->acl_pkts;
2551 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002552 break;
2553
2554 case SCO_LINK:
2555 hdev->sco_cnt += count;
2556 if (hdev->sco_cnt > hdev->sco_pkts)
2557 hdev->sco_cnt = hdev->sco_pkts;
2558 break;
2559
2560 default:
2561 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2562 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002563 }
2564 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002565
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02002566 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002567}
2568
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002569static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
2570 __u16 handle)
2571{
2572 struct hci_chan *chan;
2573
2574 switch (hdev->dev_type) {
2575 case HCI_BREDR:
2576 return hci_conn_hash_lookup_handle(hdev, handle);
2577 case HCI_AMP:
2578 chan = hci_chan_lookup_handle(hdev, handle);
2579 if (chan)
2580 return chan->conn;
2581 break;
2582 default:
2583 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
2584 break;
2585 }
2586
2587 return NULL;
2588}
2589
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002590static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002591{
2592 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2593 int i;
2594
2595 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2596 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2597 return;
2598 }
2599
2600 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002601 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002602 BT_DBG("%s bad parameters", hdev->name);
2603 return;
2604 }
2605
2606 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002607 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002608
2609 for (i = 0; i < ev->num_hndl; i++) {
2610 struct hci_comp_blocks_info *info = &ev->handles[i];
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002611 struct hci_conn *conn = NULL;
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002612 __u16 handle, block_count;
2613
2614 handle = __le16_to_cpu(info->handle);
2615 block_count = __le16_to_cpu(info->blocks);
2616
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002617 conn = __hci_conn_lookup_handle(hdev, handle);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002618 if (!conn)
2619 continue;
2620
2621 conn->sent -= block_count;
2622
2623 switch (conn->type) {
2624 case ACL_LINK:
Andrei Emeltchenkobd1eb662012-10-10 17:38:30 +03002625 case AMP_LINK:
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002626 hdev->block_cnt += block_count;
2627 if (hdev->block_cnt > hdev->num_blocks)
2628 hdev->block_cnt = hdev->num_blocks;
2629 break;
2630
2631 default:
2632 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2633 break;
2634 }
2635 }
2636
2637 queue_work(hdev->workqueue, &hdev->tx_work);
2638}
2639
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002640static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002641{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002642 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002643 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002644
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002645 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002646
2647 hci_dev_lock(hdev);
2648
Marcel Holtmann04837f62006-07-03 10:02:33 +02002649 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2650 if (conn) {
2651 conn->mode = ev->mode;
2652 conn->interval = __le16_to_cpu(ev->interval);
2653
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002654 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2655 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02002656 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002657 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002658 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02002659 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002660 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002661
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002662 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002663 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002664 }
2665
2666 hci_dev_unlock(hdev);
2667}
2668
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002669static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002670{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002671 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2672 struct hci_conn *conn;
2673
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002674 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002675
2676 hci_dev_lock(hdev);
2677
2678 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002679 if (!conn)
2680 goto unlock;
2681
2682 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002683 hci_conn_hold(conn);
2684 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2685 hci_conn_put(conn);
2686 }
2687
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002688 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02002689 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002690 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002691 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002692 u8 secure;
2693
2694 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2695 secure = 1;
2696 else
2697 secure = 0;
2698
Johan Hedberg744cf192011-11-08 20:40:14 +02002699 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002700 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002701
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002702unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002703 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002704}
2705
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002706static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002707{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002708 struct hci_ev_link_key_req *ev = (void *) skb->data;
2709 struct hci_cp_link_key_reply cp;
2710 struct hci_conn *conn;
2711 struct link_key *key;
2712
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002713 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002714
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002715 if (!test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002716 return;
2717
2718 hci_dev_lock(hdev);
2719
2720 key = hci_find_link_key(hdev, &ev->bdaddr);
2721 if (!key) {
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002722 BT_DBG("%s link key not found for %pMR", hdev->name,
2723 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002724 goto not_found;
2725 }
2726
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002727 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
2728 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002729
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002730 if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002731 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002732 BT_DBG("%s ignoring debug key", hdev->name);
2733 goto not_found;
2734 }
2735
2736 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002737 if (conn) {
2738 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002739 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002740 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2741 goto not_found;
2742 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002743
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002744 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002745 conn->pending_sec_level == BT_SECURITY_HIGH) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002746 BT_DBG("%s ignoring key unauthenticated for high security",
2747 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002748 goto not_found;
2749 }
2750
2751 conn->key_type = key->type;
2752 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002753 }
2754
2755 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03002756 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002757
2758 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2759
2760 hci_dev_unlock(hdev);
2761
2762 return;
2763
2764not_found:
2765 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2766 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002767}
2768
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002769static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002770{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002771 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2772 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002773 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002774
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002775 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002776
2777 hci_dev_lock(hdev);
2778
2779 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2780 if (conn) {
2781 hci_conn_hold(conn);
2782 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002783 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002784
2785 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2786 conn->key_type = ev->key_type;
2787
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002788 hci_conn_put(conn);
2789 }
2790
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002791 if (test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002792 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002793 ev->key_type, pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002794
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002795 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002796}
2797
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002798static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02002799{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002800 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002801 struct hci_conn *conn;
2802
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002803 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002804
2805 hci_dev_lock(hdev);
2806
2807 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002808 if (conn && !ev->status) {
2809 struct inquiry_entry *ie;
2810
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002811 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2812 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002813 ie->data.clock_offset = ev->clock_offset;
2814 ie->timestamp = jiffies;
2815 }
2816 }
2817
2818 hci_dev_unlock(hdev);
2819}
2820
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002821static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02002822{
2823 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2824 struct hci_conn *conn;
2825
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002826 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02002827
2828 hci_dev_lock(hdev);
2829
2830 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2831 if (conn && !ev->status)
2832 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2833
2834 hci_dev_unlock(hdev);
2835}
2836
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002837static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002838{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002839 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002840 struct inquiry_entry *ie;
2841
2842 BT_DBG("%s", hdev->name);
2843
2844 hci_dev_lock(hdev);
2845
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002846 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2847 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002848 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2849 ie->timestamp = jiffies;
2850 }
2851
2852 hci_dev_unlock(hdev);
2853}
2854
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002855static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
2856 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002857{
2858 struct inquiry_data data;
2859 int num_rsp = *((__u8 *) skb->data);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002860 bool name_known, ssp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002861
2862 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2863
2864 if (!num_rsp)
2865 return;
2866
Andre Guedes1519cc12012-03-21 00:03:38 -03002867 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2868 return;
2869
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002870 hci_dev_lock(hdev);
2871
2872 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002873 struct inquiry_info_with_rssi_and_pscan_mode *info;
2874 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002875
Johan Hedberge17acd42011-03-30 23:57:16 +03002876 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002877 bacpy(&data.bdaddr, &info->bdaddr);
2878 data.pscan_rep_mode = info->pscan_rep_mode;
2879 data.pscan_period_mode = info->pscan_period_mode;
2880 data.pscan_mode = info->pscan_mode;
2881 memcpy(data.dev_class, info->dev_class, 3);
2882 data.clock_offset = info->clock_offset;
2883 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002884 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002885
2886 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002887 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002888 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002889 info->dev_class, info->rssi,
2890 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002891 }
2892 } else {
2893 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2894
Johan Hedberge17acd42011-03-30 23:57:16 +03002895 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002896 bacpy(&data.bdaddr, &info->bdaddr);
2897 data.pscan_rep_mode = info->pscan_rep_mode;
2898 data.pscan_period_mode = info->pscan_period_mode;
2899 data.pscan_mode = 0x00;
2900 memcpy(data.dev_class, info->dev_class, 3);
2901 data.clock_offset = info->clock_offset;
2902 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002903 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002904 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002905 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002906 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002907 info->dev_class, info->rssi,
2908 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002909 }
2910 }
2911
2912 hci_dev_unlock(hdev);
2913}
2914
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002915static void hci_remote_ext_features_evt(struct hci_dev *hdev,
2916 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002917{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002918 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2919 struct hci_conn *conn;
2920
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002921 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002922
Marcel Holtmann41a96212008-07-14 20:13:48 +02002923 hci_dev_lock(hdev);
2924
2925 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002926 if (!conn)
2927 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002928
Johan Hedbergccd556f2010-11-10 17:11:51 +02002929 if (!ev->status && ev->page == 0x01) {
2930 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002931
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002932 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2933 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02002934 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02002935
Johan Hedberg02b7cc62012-02-28 02:28:43 +02002936 if (ev->features[0] & LMP_HOST_SSP)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002937 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002938 }
2939
Johan Hedbergccd556f2010-11-10 17:11:51 +02002940 if (conn->state != BT_CONFIG)
2941 goto unlock;
2942
Johan Hedberg671267b2012-05-12 16:11:50 -03002943 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002944 struct hci_cp_remote_name_req cp;
2945 memset(&cp, 0, sizeof(cp));
2946 bacpy(&cp.bdaddr, &conn->dst);
2947 cp.pscan_rep_mode = 0x02;
2948 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002949 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2950 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002951 conn->dst_type, 0, NULL, 0,
2952 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002953
Johan Hedberg127178d2010-11-18 22:22:29 +02002954 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002955 conn->state = BT_CONNECTED;
2956 hci_proto_connect_cfm(conn, ev->status);
2957 hci_conn_put(conn);
2958 }
2959
2960unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002961 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002962}
2963
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002964static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
2965 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002966{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002967 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2968 struct hci_conn *conn;
2969
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002970 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002971
2972 hci_dev_lock(hdev);
2973
2974 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002975 if (!conn) {
2976 if (ev->link_type == ESCO_LINK)
2977 goto unlock;
2978
2979 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2980 if (!conn)
2981 goto unlock;
2982
2983 conn->type = SCO_LINK;
2984 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002985
Marcel Holtmann732547f2009-04-19 19:14:14 +02002986 switch (ev->status) {
2987 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002988 conn->handle = __le16_to_cpu(ev->handle);
2989 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002990
Marcel Holtmann9eba32b2009-08-22 14:19:26 -07002991 hci_conn_hold_device(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002992 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002993 break;
2994
Stephen Coe705e5712010-02-16 11:29:44 -05002995 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002996 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002997 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002998 case 0x1f: /* Unspecified error */
2999 if (conn->out && conn->attempt < 2) {
3000 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3001 (hdev->esco_type & EDR_ESCO_MASK);
3002 hci_setup_sync(conn, conn->link->handle);
3003 goto unlock;
3004 }
3005 /* fall through */
3006
3007 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003008 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003009 break;
3010 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003011
3012 hci_proto_connect_cfm(conn, ev->status);
3013 if (ev->status)
3014 hci_conn_del(conn);
3015
3016unlock:
3017 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003018}
3019
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003020static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3021 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003022{
3023 struct inquiry_data data;
3024 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3025 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303026 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003027
3028 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3029
3030 if (!num_rsp)
3031 return;
3032
Andre Guedes1519cc12012-03-21 00:03:38 -03003033 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3034 return;
3035
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003036 hci_dev_lock(hdev);
3037
Johan Hedberge17acd42011-03-30 23:57:16 +03003038 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003039 bool name_known, ssp;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003040
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003041 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01003042 data.pscan_rep_mode = info->pscan_rep_mode;
3043 data.pscan_period_mode = info->pscan_period_mode;
3044 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003045 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01003046 data.clock_offset = info->clock_offset;
3047 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003048 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003049
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003050 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02003051 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003052 sizeof(info->data),
3053 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02003054 else
3055 name_known = true;
3056
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003057 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003058 &ssp);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303059 eir_len = eir_get_length(info->data, sizeof(info->data));
Johan Hedberg48264f02011-11-09 13:58:58 +02003060 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003061 info->dev_class, info->rssi, !name_known,
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303062 ssp, info->data, eir_len);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003063 }
3064
3065 hci_dev_unlock(hdev);
3066}
3067
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003068static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3069 struct sk_buff *skb)
3070{
3071 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3072 struct hci_conn *conn;
3073
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003074 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003075 __le16_to_cpu(ev->handle));
3076
3077 hci_dev_lock(hdev);
3078
3079 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3080 if (!conn)
3081 goto unlock;
3082
3083 if (!ev->status)
3084 conn->sec_level = conn->pending_sec_level;
3085
3086 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3087
3088 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03003089 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003090 hci_conn_put(conn);
3091 goto unlock;
3092 }
3093
3094 if (conn->state == BT_CONFIG) {
3095 if (!ev->status)
3096 conn->state = BT_CONNECTED;
3097
3098 hci_proto_connect_cfm(conn, ev->status);
3099 hci_conn_put(conn);
3100 } else {
3101 hci_auth_cfm(conn, ev->status);
3102
3103 hci_conn_hold(conn);
3104 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
3105 hci_conn_put(conn);
3106 }
3107
3108unlock:
3109 hci_dev_unlock(hdev);
3110}
3111
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003112static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003113{
3114 /* If remote requests dedicated bonding follow that lead */
3115 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
3116 /* If both remote and local IO capabilities allow MITM
3117 * protection then require it, otherwise don't */
3118 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
3119 return 0x02;
3120 else
3121 return 0x03;
3122 }
3123
3124 /* If remote requests no-bonding follow that lead */
3125 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003126 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003127
3128 return conn->auth_type;
3129}
3130
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003131static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003132{
3133 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3134 struct hci_conn *conn;
3135
3136 BT_DBG("%s", hdev->name);
3137
3138 hci_dev_lock(hdev);
3139
3140 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003141 if (!conn)
3142 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003143
Johan Hedberg03b555e2011-01-04 15:40:05 +02003144 hci_conn_hold(conn);
3145
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003146 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003147 goto unlock;
3148
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003149 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003150 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003151 struct hci_cp_io_capability_reply cp;
3152
3153 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303154 /* Change the IO capability from KeyboardDisplay
3155 * to DisplayYesNo as it is not supported by BT spec. */
3156 cp.capability = (conn->io_capability == 0x04) ?
3157 0x01 : conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07003158 conn->auth_type = hci_get_auth_req(conn);
3159 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003160
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003161 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3162 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
Szymon Jancce85ee12011-03-22 13:12:23 +01003163 cp.oob_data = 0x01;
3164 else
3165 cp.oob_data = 0x00;
3166
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003167 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003168 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003169 } else {
3170 struct hci_cp_io_capability_neg_reply cp;
3171
3172 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02003173 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003174
3175 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003176 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003177 }
3178
3179unlock:
3180 hci_dev_unlock(hdev);
3181}
3182
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003183static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02003184{
3185 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3186 struct hci_conn *conn;
3187
3188 BT_DBG("%s", hdev->name);
3189
3190 hci_dev_lock(hdev);
3191
3192 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3193 if (!conn)
3194 goto unlock;
3195
Johan Hedberg03b555e2011-01-04 15:40:05 +02003196 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003197 conn->remote_auth = ev->authentication;
Johan Hedberg58a681e2012-01-16 06:47:28 +02003198 if (ev->oob_data)
3199 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003200
3201unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003202 hci_dev_unlock(hdev);
3203}
3204
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003205static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3206 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003207{
3208 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003209 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07003210 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03003211
3212 BT_DBG("%s", hdev->name);
3213
3214 hci_dev_lock(hdev);
3215
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003216 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg7a828902011-04-28 11:28:53 -07003217 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03003218
Johan Hedberg7a828902011-04-28 11:28:53 -07003219 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3220 if (!conn)
3221 goto unlock;
3222
3223 loc_mitm = (conn->auth_type & 0x01);
3224 rem_mitm = (conn->remote_auth & 0x01);
3225
3226 /* If we require MITM but the remote device can't provide that
3227 * (it has NoInputNoOutput) then reject the confirmation
3228 * request. The only exception is when we're dedicated bonding
3229 * initiators (connect_cfm_cb set) since then we always have the MITM
3230 * bit set. */
3231 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
3232 BT_DBG("Rejecting request: remote device can't provide MITM");
3233 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003234 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003235 goto unlock;
3236 }
3237
3238 /* If no side requires MITM protection; auto-accept */
3239 if ((!loc_mitm || conn->remote_cap == 0x03) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003240 (!rem_mitm || conn->io_capability == 0x03)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003241
3242 /* If we're not the initiators request authorization to
3243 * proceed from user space (mgmt_user_confirm with
3244 * confirm_hint set to 1). */
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003245 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003246 BT_DBG("Confirming auto-accept as acceptor");
3247 confirm_hint = 1;
3248 goto confirm;
3249 }
3250
Johan Hedberg9f616562011-04-28 11:28:54 -07003251 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03003252 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003253
3254 if (hdev->auto_accept_delay > 0) {
3255 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
3256 mod_timer(&conn->auto_accept_timer, jiffies + delay);
3257 goto unlock;
3258 }
3259
Johan Hedberg7a828902011-04-28 11:28:53 -07003260 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003261 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003262 goto unlock;
3263 }
3264
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003265confirm:
Johan Hedberg272d90d2012-02-09 15:26:12 +02003266 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0, ev->passkey,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003267 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07003268
3269unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03003270 hci_dev_unlock(hdev);
3271}
3272
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003273static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3274 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08003275{
3276 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3277
3278 BT_DBG("%s", hdev->name);
3279
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003280 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02003281 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08003282}
3283
Johan Hedberg92a25252012-09-06 18:39:26 +03003284static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3285 struct sk_buff *skb)
3286{
3287 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3288 struct hci_conn *conn;
3289
3290 BT_DBG("%s", hdev->name);
3291
3292 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3293 if (!conn)
3294 return;
3295
3296 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3297 conn->passkey_entered = 0;
3298
3299 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3300 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3301 conn->dst_type, conn->passkey_notify,
3302 conn->passkey_entered);
3303}
3304
3305static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3306{
3307 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3308 struct hci_conn *conn;
3309
3310 BT_DBG("%s", hdev->name);
3311
3312 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3313 if (!conn)
3314 return;
3315
3316 switch (ev->type) {
3317 case HCI_KEYPRESS_STARTED:
3318 conn->passkey_entered = 0;
3319 return;
3320
3321 case HCI_KEYPRESS_ENTERED:
3322 conn->passkey_entered++;
3323 break;
3324
3325 case HCI_KEYPRESS_ERASED:
3326 conn->passkey_entered--;
3327 break;
3328
3329 case HCI_KEYPRESS_CLEARED:
3330 conn->passkey_entered = 0;
3331 break;
3332
3333 case HCI_KEYPRESS_COMPLETED:
3334 return;
3335 }
3336
3337 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3338 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3339 conn->dst_type, conn->passkey_notify,
3340 conn->passkey_entered);
3341}
3342
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003343static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3344 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003345{
3346 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3347 struct hci_conn *conn;
3348
3349 BT_DBG("%s", hdev->name);
3350
3351 hci_dev_lock(hdev);
3352
3353 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003354 if (!conn)
3355 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003356
Johan Hedberg2a611692011-02-19 12:06:00 -03003357 /* To avoid duplicate auth_failed events to user space we check
3358 * the HCI_CONN_AUTH_PEND flag which will be set if we
3359 * initiated the authentication. A traditional auth_complete
3360 * event gets always produced as initiator and is also mapped to
3361 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02003362 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003363 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003364 ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003365
3366 hci_conn_put(conn);
3367
3368unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003369 hci_dev_unlock(hdev);
3370}
3371
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003372static void hci_remote_host_features_evt(struct hci_dev *hdev,
3373 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003374{
3375 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3376 struct inquiry_entry *ie;
3377
3378 BT_DBG("%s", hdev->name);
3379
3380 hci_dev_lock(hdev);
3381
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003382 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3383 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003384 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003385
3386 hci_dev_unlock(hdev);
3387}
3388
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003389static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3390 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01003391{
3392 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3393 struct oob_data *data;
3394
3395 BT_DBG("%s", hdev->name);
3396
3397 hci_dev_lock(hdev);
3398
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003399 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Szymon Jance1ba1f12011-04-06 13:01:59 +02003400 goto unlock;
3401
Szymon Janc2763eda2011-03-22 13:12:22 +01003402 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3403 if (data) {
3404 struct hci_cp_remote_oob_data_reply cp;
3405
3406 bacpy(&cp.bdaddr, &ev->bdaddr);
3407 memcpy(cp.hash, data->hash, sizeof(cp.hash));
3408 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
3409
3410 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003411 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003412 } else {
3413 struct hci_cp_remote_oob_data_neg_reply cp;
3414
3415 bacpy(&cp.bdaddr, &ev->bdaddr);
3416 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003417 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003418 }
3419
Szymon Jance1ba1f12011-04-06 13:01:59 +02003420unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003421 hci_dev_unlock(hdev);
3422}
3423
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003424static void hci_phy_link_complete_evt(struct hci_dev *hdev,
3425 struct sk_buff *skb)
3426{
3427 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
3428 struct hci_conn *hcon, *bredr_hcon;
3429
3430 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
3431 ev->status);
3432
3433 hci_dev_lock(hdev);
3434
3435 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3436 if (!hcon) {
3437 hci_dev_unlock(hdev);
3438 return;
3439 }
3440
3441 if (ev->status) {
3442 hci_conn_del(hcon);
3443 hci_dev_unlock(hdev);
3444 return;
3445 }
3446
3447 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
3448
3449 hcon->state = BT_CONNECTED;
3450 bacpy(&hcon->dst, &bredr_hcon->dst);
3451
3452 hci_conn_hold(hcon);
3453 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
3454 hci_conn_put(hcon);
3455
3456 hci_conn_hold_device(hcon);
3457 hci_conn_add_sysfs(hcon);
3458
Andrei Emeltchenkocf70ff22012-10-31 15:46:36 +02003459 amp_physical_cfm(bredr_hcon, hcon);
3460
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003461 hci_dev_unlock(hdev);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003462}
3463
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003464static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3465{
3466 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
3467 struct hci_conn *hcon;
3468 struct hci_chan *hchan;
3469 struct amp_mgr *mgr;
3470
3471 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
3472 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
3473 ev->status);
3474
3475 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3476 if (!hcon)
3477 return;
3478
3479 /* Create AMP hchan */
3480 hchan = hci_chan_create(hcon);
3481 if (!hchan)
3482 return;
3483
3484 hchan->handle = le16_to_cpu(ev->handle);
3485
3486 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
3487
3488 mgr = hcon->amp_mgr;
3489 if (mgr && mgr->bredr_chan) {
3490 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
3491
3492 l2cap_chan_lock(bredr_chan);
3493
3494 bredr_chan->conn->mtu = hdev->block_mtu;
3495 l2cap_logical_cfm(bredr_chan, hchan, 0);
3496 hci_conn_hold(hcon);
3497
3498 l2cap_chan_unlock(bredr_chan);
3499 }
3500}
3501
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003502static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
3503 struct sk_buff *skb)
3504{
3505 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
3506 struct hci_chan *hchan;
3507
3508 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
3509 le16_to_cpu(ev->handle), ev->status);
3510
3511 if (ev->status)
3512 return;
3513
3514 hci_dev_lock(hdev);
3515
3516 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
3517 if (!hchan)
3518 goto unlock;
3519
3520 amp_destroy_logical_link(hchan, ev->reason);
3521
3522unlock:
3523 hci_dev_unlock(hdev);
3524}
3525
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003526static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
3527 struct sk_buff *skb)
3528{
3529 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
3530 struct hci_conn *hcon;
3531
3532 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3533
3534 if (ev->status)
3535 return;
3536
3537 hci_dev_lock(hdev);
3538
3539 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3540 if (hcon) {
3541 hcon->state = BT_CLOSED;
3542 hci_conn_del(hcon);
3543 }
3544
3545 hci_dev_unlock(hdev);
3546}
3547
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003548static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003549{
3550 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3551 struct hci_conn *conn;
3552
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003553 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003554
3555 hci_dev_lock(hdev);
3556
Andre Guedesb47a09b2012-07-27 15:10:15 -03003557 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03003558 if (!conn) {
3559 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
3560 if (!conn) {
3561 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03003562 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03003563 }
Andre Guedes29b79882011-05-31 14:20:54 -03003564
3565 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03003566
3567 if (ev->role == LE_CONN_ROLE_MASTER) {
3568 conn->out = true;
3569 conn->link_mode |= HCI_LM_MASTER;
3570 }
Ville Tervob62f3282011-02-10 22:38:50 -03003571 }
Ville Tervofcd89c02011-02-10 22:38:47 -03003572
Andre Guedescd17dec2012-07-27 15:10:16 -03003573 if (ev->status) {
3574 mgmt_connect_failed(hdev, &conn->dst, conn->type,
3575 conn->dst_type, ev->status);
3576 hci_proto_connect_cfm(conn, ev->status);
3577 conn->state = BT_CLOSED;
3578 hci_conn_del(conn);
3579 goto unlock;
3580 }
3581
Johan Hedbergb644ba32012-01-17 21:48:47 +02003582 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3583 mgmt_device_connected(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003584 conn->dst_type, 0, NULL, 0, NULL);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03003585
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03003586 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03003587 conn->handle = __le16_to_cpu(ev->handle);
3588 conn->state = BT_CONNECTED;
3589
3590 hci_conn_hold_device(conn);
3591 hci_conn_add_sysfs(conn);
3592
3593 hci_proto_connect_cfm(conn, ev->status);
3594
3595unlock:
3596 hci_dev_unlock(hdev);
3597}
3598
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003599static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03003600{
Andre Guedese95beb42011-09-26 20:48:35 -03003601 u8 num_reports = skb->data[0];
3602 void *ptr = &skb->data[1];
Andre Guedes3c9e9192012-01-10 18:20:50 -03003603 s8 rssi;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003604
Andre Guedese95beb42011-09-26 20:48:35 -03003605 while (num_reports--) {
3606 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003607
Andre Guedes3c9e9192012-01-10 18:20:50 -03003608 rssi = ev->data[ev->length];
3609 mgmt_device_found(hdev, &ev->bdaddr, LE_LINK, ev->bdaddr_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003610 NULL, rssi, 0, 1, ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03003611
Andre Guedese95beb42011-09-26 20:48:35 -03003612 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003613 }
Andre Guedes9aa04c92011-05-26 16:23:51 -03003614}
3615
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003616static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003617{
3618 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
3619 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003620 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003621 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003622 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003623
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003624 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003625
3626 hci_dev_lock(hdev);
3627
3628 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003629 if (conn == NULL)
3630 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003631
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003632 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
3633 if (ltk == NULL)
3634 goto not_found;
3635
3636 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003637 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003638
3639 if (ltk->authenticated)
3640 conn->sec_level = BT_SECURITY_HIGH;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003641
3642 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
3643
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003644 if (ltk->type & HCI_SMP_STK) {
3645 list_del(&ltk->list);
3646 kfree(ltk);
3647 }
3648
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003649 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003650
3651 return;
3652
3653not_found:
3654 neg.handle = ev->handle;
3655 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
3656 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003657}
3658
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003659static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003660{
3661 struct hci_ev_le_meta *le_ev = (void *) skb->data;
3662
3663 skb_pull(skb, sizeof(*le_ev));
3664
3665 switch (le_ev->subevent) {
3666 case HCI_EV_LE_CONN_COMPLETE:
3667 hci_le_conn_complete_evt(hdev, skb);
3668 break;
3669
Andre Guedes9aa04c92011-05-26 16:23:51 -03003670 case HCI_EV_LE_ADVERTISING_REPORT:
3671 hci_le_adv_report_evt(hdev, skb);
3672 break;
3673
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003674 case HCI_EV_LE_LTK_REQ:
3675 hci_le_ltk_request_evt(hdev, skb);
3676 break;
3677
Ville Tervofcd89c02011-02-10 22:38:47 -03003678 default:
3679 break;
3680 }
3681}
3682
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03003683static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
3684{
3685 struct hci_ev_channel_selected *ev = (void *) skb->data;
3686 struct hci_conn *hcon;
3687
3688 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
3689
3690 skb_pull(skb, sizeof(*ev));
3691
3692 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3693 if (!hcon)
3694 return;
3695
3696 amp_read_loc_assoc_final_data(hdev, hcon);
3697}
3698
Linus Torvalds1da177e2005-04-16 15:20:36 -07003699void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
3700{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003701 struct hci_event_hdr *hdr = (void *) skb->data;
3702 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003703
Johan Hedbergb6ddb632013-04-02 13:34:31 +03003704 hci_dev_lock(hdev);
3705
3706 /* Received events are (currently) only needed when a request is
3707 * ongoing so avoid unnecessary memory allocation.
3708 */
3709 if (hdev->req_status == HCI_REQ_PEND) {
3710 kfree_skb(hdev->recv_evt);
3711 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
3712 }
3713
3714 hci_dev_unlock(hdev);
3715
Linus Torvalds1da177e2005-04-16 15:20:36 -07003716 skb_pull(skb, HCI_EVENT_HDR_SIZE);
3717
Johan Hedberg02350a72013-04-03 21:50:29 +03003718 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
3719 struct hci_command_hdr *hdr = (void *) hdev->sent_cmd->data;
3720 u16 opcode = __le16_to_cpu(hdr->opcode);
3721
3722 hci_req_cmd_complete(hdev, opcode, 0);
3723 }
3724
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003725 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003726 case HCI_EV_INQUIRY_COMPLETE:
3727 hci_inquiry_complete_evt(hdev, skb);
3728 break;
3729
3730 case HCI_EV_INQUIRY_RESULT:
3731 hci_inquiry_result_evt(hdev, skb);
3732 break;
3733
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003734 case HCI_EV_CONN_COMPLETE:
3735 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02003736 break;
3737
Linus Torvalds1da177e2005-04-16 15:20:36 -07003738 case HCI_EV_CONN_REQUEST:
3739 hci_conn_request_evt(hdev, skb);
3740 break;
3741
Linus Torvalds1da177e2005-04-16 15:20:36 -07003742 case HCI_EV_DISCONN_COMPLETE:
3743 hci_disconn_complete_evt(hdev, skb);
3744 break;
3745
Linus Torvalds1da177e2005-04-16 15:20:36 -07003746 case HCI_EV_AUTH_COMPLETE:
3747 hci_auth_complete_evt(hdev, skb);
3748 break;
3749
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003750 case HCI_EV_REMOTE_NAME:
3751 hci_remote_name_evt(hdev, skb);
3752 break;
3753
Linus Torvalds1da177e2005-04-16 15:20:36 -07003754 case HCI_EV_ENCRYPT_CHANGE:
3755 hci_encrypt_change_evt(hdev, skb);
3756 break;
3757
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003758 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3759 hci_change_link_key_complete_evt(hdev, skb);
3760 break;
3761
3762 case HCI_EV_REMOTE_FEATURES:
3763 hci_remote_features_evt(hdev, skb);
3764 break;
3765
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003766 case HCI_EV_CMD_COMPLETE:
3767 hci_cmd_complete_evt(hdev, skb);
3768 break;
3769
3770 case HCI_EV_CMD_STATUS:
3771 hci_cmd_status_evt(hdev, skb);
3772 break;
3773
3774 case HCI_EV_ROLE_CHANGE:
3775 hci_role_change_evt(hdev, skb);
3776 break;
3777
3778 case HCI_EV_NUM_COMP_PKTS:
3779 hci_num_comp_pkts_evt(hdev, skb);
3780 break;
3781
3782 case HCI_EV_MODE_CHANGE:
3783 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003784 break;
3785
3786 case HCI_EV_PIN_CODE_REQ:
3787 hci_pin_code_request_evt(hdev, skb);
3788 break;
3789
3790 case HCI_EV_LINK_KEY_REQ:
3791 hci_link_key_request_evt(hdev, skb);
3792 break;
3793
3794 case HCI_EV_LINK_KEY_NOTIFY:
3795 hci_link_key_notify_evt(hdev, skb);
3796 break;
3797
3798 case HCI_EV_CLOCK_OFFSET:
3799 hci_clock_offset_evt(hdev, skb);
3800 break;
3801
Marcel Holtmanna8746412008-07-14 20:13:46 +02003802 case HCI_EV_PKT_TYPE_CHANGE:
3803 hci_pkt_type_change_evt(hdev, skb);
3804 break;
3805
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003806 case HCI_EV_PSCAN_REP_MODE:
3807 hci_pscan_rep_mode_evt(hdev, skb);
3808 break;
3809
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003810 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3811 hci_inquiry_result_with_rssi_evt(hdev, skb);
3812 break;
3813
3814 case HCI_EV_REMOTE_EXT_FEATURES:
3815 hci_remote_ext_features_evt(hdev, skb);
3816 break;
3817
3818 case HCI_EV_SYNC_CONN_COMPLETE:
3819 hci_sync_conn_complete_evt(hdev, skb);
3820 break;
3821
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003822 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3823 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003824 break;
3825
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003826 case HCI_EV_KEY_REFRESH_COMPLETE:
3827 hci_key_refresh_complete_evt(hdev, skb);
3828 break;
3829
Marcel Holtmann04936842008-07-14 20:13:48 +02003830 case HCI_EV_IO_CAPA_REQUEST:
3831 hci_io_capa_request_evt(hdev, skb);
3832 break;
3833
Johan Hedberg03b555e2011-01-04 15:40:05 +02003834 case HCI_EV_IO_CAPA_REPLY:
3835 hci_io_capa_reply_evt(hdev, skb);
3836 break;
3837
Johan Hedberga5c29682011-02-19 12:05:57 -03003838 case HCI_EV_USER_CONFIRM_REQUEST:
3839 hci_user_confirm_request_evt(hdev, skb);
3840 break;
3841
Brian Gix1143d452011-11-23 08:28:34 -08003842 case HCI_EV_USER_PASSKEY_REQUEST:
3843 hci_user_passkey_request_evt(hdev, skb);
3844 break;
3845
Johan Hedberg92a25252012-09-06 18:39:26 +03003846 case HCI_EV_USER_PASSKEY_NOTIFY:
3847 hci_user_passkey_notify_evt(hdev, skb);
3848 break;
3849
3850 case HCI_EV_KEYPRESS_NOTIFY:
3851 hci_keypress_notify_evt(hdev, skb);
3852 break;
3853
Marcel Holtmann04936842008-07-14 20:13:48 +02003854 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3855 hci_simple_pair_complete_evt(hdev, skb);
3856 break;
3857
Marcel Holtmann41a96212008-07-14 20:13:48 +02003858 case HCI_EV_REMOTE_HOST_FEATURES:
3859 hci_remote_host_features_evt(hdev, skb);
3860 break;
3861
Ville Tervofcd89c02011-02-10 22:38:47 -03003862 case HCI_EV_LE_META:
3863 hci_le_meta_evt(hdev, skb);
3864 break;
3865
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03003866 case HCI_EV_CHANNEL_SELECTED:
3867 hci_chan_selected_evt(hdev, skb);
3868 break;
3869
Szymon Janc2763eda2011-03-22 13:12:22 +01003870 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3871 hci_remote_oob_data_request_evt(hdev, skb);
3872 break;
3873
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003874 case HCI_EV_PHY_LINK_COMPLETE:
3875 hci_phy_link_complete_evt(hdev, skb);
3876 break;
3877
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003878 case HCI_EV_LOGICAL_LINK_COMPLETE:
3879 hci_loglink_complete_evt(hdev, skb);
3880 break;
3881
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003882 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
3883 hci_disconn_loglink_complete_evt(hdev, skb);
3884 break;
3885
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003886 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
3887 hci_disconn_phylink_complete_evt(hdev, skb);
3888 break;
3889
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003890 case HCI_EV_NUM_COMP_BLOCKS:
3891 hci_num_comp_blocks_evt(hdev, skb);
3892 break;
3893
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003894 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003895 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003896 break;
3897 }
3898
3899 kfree_skb(skb);
3900 hdev->stat.evt_rx++;
3901}