blob: 94aab73f89d4c9e447d2b65f12f8ec71ee1a66e6 [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 Guedes82f47852013-04-30 15:29:34 -030043 if (status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020044 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070045
Andre Guedes89352e72011-11-04 14:16:53 -030046 clear_bit(HCI_INQUIRY, &hdev->flags);
Andre Guedes3e13fa12013-03-27 20:04:56 -030047 smp_mb__after_clear_bit(); /* wake_up_bit advises about this barrier */
48 wake_up_bit(&hdev->flags, HCI_INQUIRY);
Andre Guedes89352e72011-11-04 14:16:53 -030049
Marcel Holtmanna9de9242007-10-20 13:33:56 +020050 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070051}
52
Andre Guedes4d934832012-03-21 00:03:35 -030053static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
54{
55 __u8 status = *((__u8 *) skb->data);
56
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030057 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesae854a72012-03-21 00:03:36 -030058
59 if (status)
60 return;
61
62 set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
Andre Guedes4d934832012-03-21 00:03:35 -030063}
64
Marcel Holtmanna9de9242007-10-20 13:33:56 +020065static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070066{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020067 __u8 status = *((__u8 *) skb->data);
68
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030069 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020070
71 if (status)
72 return;
73
Andre Guedesae854a72012-03-21 00:03:36 -030074 clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
75
Marcel Holtmanna9de9242007-10-20 13:33:56 +020076 hci_conn_check_pending(hdev);
77}
78
Gustavo Padovan807deac2012-05-17 00:36:24 -030079static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
80 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020081{
82 BT_DBG("%s", hdev->name);
83}
84
85static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
86{
87 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070088 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070089
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030090 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
Marcel Holtmanna9de9242007-10-20 13:33:56 +020092 if (rp->status)
93 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070094
Marcel Holtmanna9de9242007-10-20 13:33:56 +020095 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070096
Marcel Holtmanna9de9242007-10-20 13:33:56 +020097 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
98 if (conn) {
99 if (rp->role)
100 conn->link_mode &= ~HCI_LM_MASTER;
101 else
102 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200104
105 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106}
107
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200108static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
109{
110 struct hci_rp_read_link_policy *rp = (void *) skb->data;
111 struct hci_conn *conn;
112
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300113 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200114
115 if (rp->status)
116 return;
117
118 hci_dev_lock(hdev);
119
120 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
121 if (conn)
122 conn->link_policy = __le16_to_cpu(rp->policy);
123
124 hci_dev_unlock(hdev);
125}
126
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200127static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200129 struct hci_rp_write_link_policy *rp = (void *) skb->data;
130 struct hci_conn *conn;
131 void *sent;
132
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300133 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200134
135 if (rp->status)
136 return;
137
138 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
139 if (!sent)
140 return;
141
142 hci_dev_lock(hdev);
143
144 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200145 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700146 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200147
148 hci_dev_unlock(hdev);
149}
150
Gustavo Padovan807deac2012-05-17 00:36:24 -0300151static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
152 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200153{
154 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
155
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300156 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200157
158 if (rp->status)
159 return;
160
161 hdev->link_policy = __le16_to_cpu(rp->policy);
162}
163
Gustavo Padovan807deac2012-05-17 00:36:24 -0300164static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
165 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200166{
167 __u8 status = *((__u8 *) skb->data);
168 void *sent;
169
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300170 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200171
172 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
173 if (!sent)
174 return;
175
176 if (!status)
177 hdev->link_policy = get_unaligned_le16(sent);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200178}
179
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200180static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
181{
182 __u8 status = *((__u8 *) skb->data);
183
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300184 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200185
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300186 clear_bit(HCI_RESET, &hdev->flags);
187
Johan Hedberga297e972012-02-21 17:55:47 +0200188 /* Reset all non-persistent flags */
Johan Hedberg2cc6fb02013-03-15 17:06:57 -0500189 hdev->dev_flags &= ~HCI_PERSISTENT_MASK;
Andre Guedes69775ff2012-02-23 16:50:05 +0200190
191 hdev->discovery.state = DISCOVERY_STOPPED;
Johan Hedbergbbaf4442012-11-08 01:22:59 +0100192 hdev->inq_tx_power = HCI_TX_POWER_INVALID;
193 hdev->adv_tx_power = HCI_TX_POWER_INVALID;
Johan Hedberg3f0f5242012-11-08 01:23:00 +0100194
195 memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
196 hdev->adv_data_len = 0;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200197}
198
199static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
200{
201 __u8 status = *((__u8 *) skb->data);
202 void *sent;
203
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300204 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200205
206 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
207 if (!sent)
208 return;
209
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200210 hci_dev_lock(hdev);
211
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200212 if (test_bit(HCI_MGMT, &hdev->dev_flags))
213 mgmt_set_local_name_complete(hdev, sent, status);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +0200214 else if (!status)
215 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200216
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200217 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200218}
219
220static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
221{
222 struct hci_rp_read_local_name *rp = (void *) skb->data;
223
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300224 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200225
226 if (rp->status)
227 return;
228
Johan Hedbergdb99b5f2012-02-22 20:14:22 +0200229 if (test_bit(HCI_SETUP, &hdev->dev_flags))
230 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200231}
232
233static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
234{
235 __u8 status = *((__u8 *) skb->data);
236 void *sent;
237
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300238 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200239
240 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
241 if (!sent)
242 return;
243
244 if (!status) {
245 __u8 param = *((__u8 *) sent);
246
247 if (param == AUTH_ENABLED)
248 set_bit(HCI_AUTH, &hdev->flags);
249 else
250 clear_bit(HCI_AUTH, &hdev->flags);
251 }
252
Johan Hedberg33ef95e2012-02-16 23:56:27 +0200253 if (test_bit(HCI_MGMT, &hdev->dev_flags))
254 mgmt_auth_enable_complete(hdev, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200255}
256
257static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
258{
259 __u8 status = *((__u8 *) skb->data);
260 void *sent;
261
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300262 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200263
264 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
265 if (!sent)
266 return;
267
268 if (!status) {
269 __u8 param = *((__u8 *) sent);
270
271 if (param)
272 set_bit(HCI_ENCRYPT, &hdev->flags);
273 else
274 clear_bit(HCI_ENCRYPT, &hdev->flags);
275 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200276}
277
278static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
279{
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200280 __u8 param, status = *((__u8 *) skb->data);
281 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200282 void *sent;
283
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300284 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200285
286 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
287 if (!sent)
288 return;
289
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200290 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200291
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200292 hci_dev_lock(hdev);
293
Mikel Astizfa1bd912012-08-09 09:52:29 +0200294 if (status) {
Johan Hedberg744cf192011-11-08 20:40:14 +0200295 mgmt_write_scan_failed(hdev, param, status);
Johan Hedberg2d7cee52011-11-07 22:16:03 +0200296 hdev->discov_timeout = 0;
297 goto done;
298 }
299
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200300 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
301 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200302
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200303 if (param & SCAN_INQUIRY) {
304 set_bit(HCI_ISCAN, &hdev->flags);
305 if (!old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200306 mgmt_discoverable(hdev, 1);
Johan Hedberg16ab91a2011-11-07 22:16:02 +0200307 if (hdev->discov_timeout > 0) {
308 int to = msecs_to_jiffies(hdev->discov_timeout * 1000);
309 queue_delayed_work(hdev->workqueue, &hdev->discov_off,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300310 to);
Johan Hedberg16ab91a2011-11-07 22:16:02 +0200311 }
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200312 } else if (old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200313 mgmt_discoverable(hdev, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200314
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200315 if (param & SCAN_PAGE) {
316 set_bit(HCI_PSCAN, &hdev->flags);
317 if (!old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200318 mgmt_connectable(hdev, 1);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200319 } else if (old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200320 mgmt_connectable(hdev, 0);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200321
322done:
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200323 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200324}
325
326static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
327{
328 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
329
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300330 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200331
332 if (rp->status)
333 return;
334
335 memcpy(hdev->dev_class, rp->dev_class, 3);
336
337 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300338 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200339}
340
341static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
342{
343 __u8 status = *((__u8 *) skb->data);
344 void *sent;
345
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300346 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200347
348 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
349 if (!sent)
350 return;
351
Marcel Holtmann7f9a9032012-02-22 18:38:01 +0100352 hci_dev_lock(hdev);
353
354 if (status == 0)
355 memcpy(hdev->dev_class, sent, 3);
356
357 if (test_bit(HCI_MGMT, &hdev->dev_flags))
358 mgmt_set_class_of_dev_complete(hdev, sent, status);
359
360 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200361}
362
363static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
364{
365 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200367
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300368 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200369
370 if (rp->status)
371 return;
372
373 setting = __le16_to_cpu(rp->voice_setting);
374
Marcel Holtmannf383f272008-07-14 20:13:47 +0200375 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200376 return;
377
378 hdev->voice_setting = setting;
379
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300380 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200381
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200382 if (hdev->notify)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200383 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200384}
385
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300386static void hci_cc_write_voice_setting(struct hci_dev *hdev,
387 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200388{
389 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200390 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 void *sent;
392
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300393 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394
Marcel Holtmannf383f272008-07-14 20:13:47 +0200395 if (status)
396 return;
397
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200398 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
399 if (!sent)
400 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401
Marcel Holtmannf383f272008-07-14 20:13:47 +0200402 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Marcel Holtmannf383f272008-07-14 20:13:47 +0200404 if (hdev->voice_setting == setting)
405 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700406
Marcel Holtmannf383f272008-07-14 20:13:47 +0200407 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300409 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200410
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200411 if (hdev->notify)
Marcel Holtmannf383f272008-07-14 20:13:47 +0200412 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413}
414
Marcel Holtmann333140b2008-07-14 20:13:48 +0200415static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
416{
417 __u8 status = *((__u8 *) skb->data);
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300418 struct hci_cp_write_ssp_mode *sent;
Marcel Holtmann333140b2008-07-14 20:13:48 +0200419
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300420 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann333140b2008-07-14 20:13:48 +0200421
Marcel Holtmann333140b2008-07-14 20:13:48 +0200422 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
423 if (!sent)
424 return;
425
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300426 if (!status) {
427 if (sent->mode)
Johan Hedbergcad718e2013-04-17 15:00:51 +0300428 hdev->features[1][0] |= LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300429 else
Johan Hedbergcad718e2013-04-17 15:00:51 +0300430 hdev->features[1][0] &= ~LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300431 }
432
Johan Hedberged2c4ee2012-02-17 00:56:28 +0200433 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300434 mgmt_ssp_enable_complete(hdev, sent->mode, status);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200435 else if (!status) {
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300436 if (sent->mode)
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200437 set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
438 else
439 clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
440 }
Marcel Holtmann333140b2008-07-14 20:13:48 +0200441}
442
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200443static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
444{
445 struct hci_rp_read_local_version *rp = (void *) skb->data;
446
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300447 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200448
449 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200450 return;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200451
452 hdev->hci_ver = rp->hci_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200453 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200454 hdev->lmp_ver = rp->lmp_ver;
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200455 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200456 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200457
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300458 BT_DBG("%s manufacturer 0x%4.4x hci ver %d:%d", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300459 hdev->manufacturer, hdev->hci_ver, hdev->hci_rev);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200460}
461
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300462static void hci_cc_read_local_commands(struct hci_dev *hdev,
463 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200464{
465 struct hci_rp_read_local_commands *rp = (void *) skb->data;
466
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300467 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200468
Johan Hedberg2177bab2013-03-05 20:37:43 +0200469 if (!rp->status)
470 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200471}
472
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300473static void hci_cc_read_local_features(struct hci_dev *hdev,
474 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200475{
476 struct hci_rp_read_local_features *rp = (void *) skb->data;
477
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300478 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200479
480 if (rp->status)
481 return;
482
483 memcpy(hdev->features, rp->features, 8);
484
485 /* Adjust default settings according to features
486 * supported by device. */
487
Johan Hedbergcad718e2013-04-17 15:00:51 +0300488 if (hdev->features[0][0] & LMP_3SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200489 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
490
Johan Hedbergcad718e2013-04-17 15:00:51 +0300491 if (hdev->features[0][0] & LMP_5SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200492 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
493
Johan Hedbergcad718e2013-04-17 15:00:51 +0300494 if (hdev->features[0][1] & LMP_HV2) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200495 hdev->pkt_type |= (HCI_HV2);
496 hdev->esco_type |= (ESCO_HV2);
497 }
498
Johan Hedbergcad718e2013-04-17 15:00:51 +0300499 if (hdev->features[0][1] & LMP_HV3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200500 hdev->pkt_type |= (HCI_HV3);
501 hdev->esco_type |= (ESCO_HV3);
502 }
503
Andre Guedes45db810f2012-07-24 15:03:49 -0300504 if (lmp_esco_capable(hdev))
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200505 hdev->esco_type |= (ESCO_EV3);
506
Johan Hedbergcad718e2013-04-17 15:00:51 +0300507 if (hdev->features[0][4] & LMP_EV4)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200508 hdev->esco_type |= (ESCO_EV4);
509
Johan Hedbergcad718e2013-04-17 15:00:51 +0300510 if (hdev->features[0][4] & LMP_EV5)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200511 hdev->esco_type |= (ESCO_EV5);
512
Johan Hedbergcad718e2013-04-17 15:00:51 +0300513 if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100514 hdev->esco_type |= (ESCO_2EV3);
515
Johan Hedbergcad718e2013-04-17 15:00:51 +0300516 if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100517 hdev->esco_type |= (ESCO_3EV3);
518
Johan Hedbergcad718e2013-04-17 15:00:51 +0300519 if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100520 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
521
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200522 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
Johan Hedbergcad718e2013-04-17 15:00:51 +0300523 hdev->features[0][0], hdev->features[0][1],
524 hdev->features[0][2], hdev->features[0][3],
525 hdev->features[0][4], hdev->features[0][5],
526 hdev->features[0][6], hdev->features[0][7]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200527}
528
Andre Guedes971e3a42011-06-30 19:20:52 -0300529static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300530 struct sk_buff *skb)
Andre Guedes971e3a42011-06-30 19:20:52 -0300531{
532 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
533
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300534 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andre Guedes971e3a42011-06-30 19:20:52 -0300535
536 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200537 return;
Andre Guedes971e3a42011-06-30 19:20:52 -0300538
Johan Hedbergd2c5d772013-04-17 15:00:52 +0300539 hdev->max_page = rp->max_page;
540
Johan Hedbergcad718e2013-04-17 15:00:51 +0300541 if (rp->page < HCI_MAX_PAGES)
542 memcpy(hdev->features[rp->page], rp->features, 8);
Andre Guedes971e3a42011-06-30 19:20:52 -0300543}
544
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200545static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300546 struct sk_buff *skb)
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200547{
548 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
549
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300550 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200551
Johan Hedberg42c6b122013-03-05 20:37:49 +0200552 if (!rp->status)
553 hdev->flow_ctl_mode = rp->mode;
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200554}
555
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200556static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
557{
558 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
559
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300560 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200561
562 if (rp->status)
563 return;
564
565 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
566 hdev->sco_mtu = rp->sco_mtu;
567 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
568 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
569
570 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
571 hdev->sco_mtu = 64;
572 hdev->sco_pkts = 8;
573 }
574
575 hdev->acl_cnt = hdev->acl_pkts;
576 hdev->sco_cnt = hdev->sco_pkts;
577
Gustavo Padovan807deac2012-05-17 00:36:24 -0300578 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
579 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200580}
581
582static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
583{
584 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
585
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300586 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200587
588 if (!rp->status)
589 bacpy(&hdev->bdaddr, &rp->bdaddr);
Johan Hedberg23bb5762010-12-21 23:01:27 +0200590}
591
Johan Hedbergf332ec62013-03-15 17:07:11 -0500592static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
593 struct sk_buff *skb)
594{
595 struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;
596
597 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
598
599 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status) {
600 hdev->page_scan_interval = __le16_to_cpu(rp->interval);
601 hdev->page_scan_window = __le16_to_cpu(rp->window);
602 }
603}
604
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500605static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
606 struct sk_buff *skb)
607{
608 u8 status = *((u8 *) skb->data);
609 struct hci_cp_write_page_scan_activity *sent;
610
611 BT_DBG("%s status 0x%2.2x", hdev->name, status);
612
613 if (status)
614 return;
615
616 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
617 if (!sent)
618 return;
619
620 hdev->page_scan_interval = __le16_to_cpu(sent->interval);
621 hdev->page_scan_window = __le16_to_cpu(sent->window);
622}
623
Johan Hedbergf332ec62013-03-15 17:07:11 -0500624static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
625 struct sk_buff *skb)
626{
627 struct hci_rp_read_page_scan_type *rp = (void *) skb->data;
628
629 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
630
631 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status)
632 hdev->page_scan_type = rp->type;
633}
634
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500635static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
636 struct sk_buff *skb)
637{
638 u8 status = *((u8 *) skb->data);
639 u8 *type;
640
641 BT_DBG("%s status 0x%2.2x", hdev->name, status);
642
643 if (status)
644 return;
645
646 type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
647 if (type)
648 hdev->page_scan_type = *type;
649}
650
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200651static void hci_cc_read_data_block_size(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300652 struct sk_buff *skb)
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200653{
654 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
655
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300656 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200657
658 if (rp->status)
659 return;
660
661 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
662 hdev->block_len = __le16_to_cpu(rp->block_len);
663 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
664
665 hdev->block_cnt = hdev->num_blocks;
666
667 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300668 hdev->block_cnt, hdev->block_len);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200669}
670
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300671static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300672 struct sk_buff *skb)
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300673{
674 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
675
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300676 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300677
678 if (rp->status)
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300679 goto a2mp_rsp;
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300680
681 hdev->amp_status = rp->amp_status;
682 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
683 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
684 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
685 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
686 hdev->amp_type = rp->amp_type;
687 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
688 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
689 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
690 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
691
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300692a2mp_rsp:
693 a2mp_send_getinfo_rsp(hdev);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300694}
695
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300696static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
697 struct sk_buff *skb)
698{
699 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
700 struct amp_assoc *assoc = &hdev->loc_assoc;
701 size_t rem_len, frag_len;
702
703 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
704
705 if (rp->status)
706 goto a2mp_rsp;
707
708 frag_len = skb->len - sizeof(*rp);
709 rem_len = __le16_to_cpu(rp->rem_len);
710
711 if (rem_len > frag_len) {
Andrei Emeltchenko2e430be32012-09-28 14:44:23 +0300712 BT_DBG("frag_len %zu rem_len %zu", frag_len, rem_len);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300713
714 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
715 assoc->offset += frag_len;
716
717 /* Read other fragments */
718 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
719
720 return;
721 }
722
723 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
724 assoc->len = assoc->offset + rem_len;
725 assoc->offset = 0;
726
727a2mp_rsp:
728 /* Send A2MP Rsp when all fragments are received */
729 a2mp_send_getampassoc_rsp(hdev, rp->status);
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +0300730 a2mp_send_create_phy_link_req(hdev, rp->status);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300731}
732
Johan Hedbergd5859e22011-01-25 01:19:58 +0200733static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300734 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200735{
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700736 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200737
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300738 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200739
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700740 if (!rp->status)
741 hdev->inq_tx_power = rp->tx_power;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200742}
743
Johan Hedberg980e1a52011-01-22 06:10:07 +0200744static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
745{
746 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
747 struct hci_cp_pin_code_reply *cp;
748 struct hci_conn *conn;
749
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300750 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200751
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200752 hci_dev_lock(hdev);
753
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200754 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200755 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200756
Mikel Astizfa1bd912012-08-09 09:52:29 +0200757 if (rp->status)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200758 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200759
760 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
761 if (!cp)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200762 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200763
764 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
765 if (conn)
766 conn->pin_length = cp->pin_len;
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200767
768unlock:
769 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200770}
771
772static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
773{
774 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
775
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300776 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200777
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200778 hci_dev_lock(hdev);
779
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200780 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200781 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300782 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200783
784 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200785}
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200786
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300787static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
788 struct sk_buff *skb)
789{
790 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
791
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300792 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300793
794 if (rp->status)
795 return;
796
797 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
798 hdev->le_pkts = rp->le_max_pkt;
799
800 hdev->le_cnt = hdev->le_pkts;
801
802 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300803}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200804
Johan Hedberg60e77322013-01-22 14:01:59 +0200805static void hci_cc_le_read_local_features(struct hci_dev *hdev,
806 struct sk_buff *skb)
807{
808 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
809
810 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
811
812 if (!rp->status)
813 memcpy(hdev->le_features, rp->features, 8);
Johan Hedberg60e77322013-01-22 14:01:59 +0200814}
815
Johan Hedberg8fa19092012-10-19 20:57:49 +0300816static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
817 struct sk_buff *skb)
818{
819 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
820
821 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
822
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500823 if (!rp->status)
Johan Hedberg8fa19092012-10-19 20:57:49 +0300824 hdev->adv_tx_power = rp->tx_power;
Johan Hedberg8fa19092012-10-19 20:57:49 +0300825}
826
Johan Hedberga5c29682011-02-19 12:05:57 -0300827static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
828{
829 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
830
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300831 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300832
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200833 hci_dev_lock(hdev);
834
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200835 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300836 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
837 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200838
839 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300840}
841
842static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300843 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -0300844{
845 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
846
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300847 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300848
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200849 hci_dev_lock(hdev);
850
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200851 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200852 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300853 ACL_LINK, 0, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200854
855 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300856}
857
Brian Gix1143d452011-11-23 08:28:34 -0800858static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
859{
860 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
861
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300862 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800863
864 hci_dev_lock(hdev);
865
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200866 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +0200867 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300868 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800869
870 hci_dev_unlock(hdev);
871}
872
873static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300874 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -0800875{
876 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
877
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300878 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800879
880 hci_dev_lock(hdev);
881
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200882 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Brian Gix1143d452011-11-23 08:28:34 -0800883 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300884 ACL_LINK, 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800885
886 hci_dev_unlock(hdev);
887}
888
Szymon Jancc35938b2011-03-22 13:12:21 +0100889static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300890 struct sk_buff *skb)
Szymon Jancc35938b2011-03-22 13:12:21 +0100891{
892 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
893
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300894 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Szymon Jancc35938b2011-03-22 13:12:21 +0100895
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200896 hci_dev_lock(hdev);
Johan Hedberg744cf192011-11-08 20:40:14 +0200897 mgmt_read_local_oob_data_reply_complete(hdev, rp->hash,
Szymon Jancc35938b2011-03-22 13:12:21 +0100898 rp->randomizer, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200899 hci_dev_unlock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +0100900}
901
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100902static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
903{
904 __u8 *sent, status = *((__u8 *) skb->data);
905
906 BT_DBG("%s status 0x%2.2x", hdev->name, status);
907
908 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
909 if (!sent)
910 return;
911
912 hci_dev_lock(hdev);
913
914 if (!status) {
915 if (*sent)
916 set_bit(HCI_LE_PERIPHERAL, &hdev->dev_flags);
917 else
918 clear_bit(HCI_LE_PERIPHERAL, &hdev->dev_flags);
919 }
920
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500921 if (!test_bit(HCI_INIT, &hdev->flags)) {
922 struct hci_request req;
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100923
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500924 hci_req_init(&req, hdev);
925 hci_update_ad(&req);
926 hci_req_run(&req, NULL);
927 }
928
929 hci_dev_unlock(hdev);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100930}
931
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300932static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300933 struct sk_buff *skb)
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300934{
935 struct hci_cp_le_set_scan_enable *cp;
936 __u8 status = *((__u8 *) skb->data);
937
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300938 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300939
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300940 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
941 if (!cp)
942 return;
943
Andre Guedes3fd319b2013-04-30 15:29:36 -0300944 if (status)
945 return;
946
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +0200947 switch (cp->enable) {
Andre Guedes76a388b2013-04-04 20:21:02 -0300948 case LE_SCAN_ENABLE:
Andre Guedesd23264a2011-11-25 20:53:38 -0300949 set_bit(HCI_LE_SCAN, &hdev->dev_flags);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +0200950 break;
951
Andre Guedes76a388b2013-04-04 20:21:02 -0300952 case LE_SCAN_DISABLE:
Andre Guedesd23264a2011-11-25 20:53:38 -0300953 clear_bit(HCI_LE_SCAN, &hdev->dev_flags);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +0200954 break;
955
956 default:
957 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
958 break;
Andre Guedes35815082011-05-26 16:23:53 -0300959 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -0300960}
961
Johan Hedbergcf1d0812013-01-22 14:02:00 +0200962static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
963 struct sk_buff *skb)
964{
965 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
966
967 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
968
969 if (!rp->status)
970 hdev->le_white_list_size = rp->size;
Johan Hedbergcf1d0812013-01-22 14:02:00 +0200971}
972
Johan Hedberg9b008c02013-01-22 14:02:01 +0200973static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
974 struct sk_buff *skb)
975{
976 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
977
978 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
979
980 if (!rp->status)
981 memcpy(hdev->le_states, rp->le_states, 8);
Johan Hedberg9b008c02013-01-22 14:02:01 +0200982}
983
Gustavo Padovan6039aa732012-05-23 04:04:18 -0300984static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
985 struct sk_buff *skb)
Andre Guedesf9b49302011-06-30 19:20:53 -0300986{
Johan Hedberg06199cf2012-02-22 16:37:11 +0200987 struct hci_cp_write_le_host_supported *sent;
Andre Guedesf9b49302011-06-30 19:20:53 -0300988 __u8 status = *((__u8 *) skb->data);
989
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300990 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesf9b49302011-06-30 19:20:53 -0300991
Johan Hedberg06199cf2012-02-22 16:37:11 +0200992 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
Johan Hedberg8f984df2012-02-28 01:07:22 +0200993 if (!sent)
Andre Guedesf9b49302011-06-30 19:20:53 -0300994 return;
995
Johan Hedberg8f984df2012-02-28 01:07:22 +0200996 if (!status) {
997 if (sent->le)
Johan Hedbergcad718e2013-04-17 15:00:51 +0300998 hdev->features[1][0] |= LMP_HOST_LE;
Johan Hedberg8f984df2012-02-28 01:07:22 +0200999 else
Johan Hedbergcad718e2013-04-17 15:00:51 +03001000 hdev->features[1][0] &= ~LMP_HOST_LE;
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001001
1002 if (sent->simul)
Johan Hedbergcad718e2013-04-17 15:00:51 +03001003 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001004 else
Johan Hedbergcad718e2013-04-17 15:00:51 +03001005 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
Johan Hedberg8f984df2012-02-28 01:07:22 +02001006 }
1007
1008 if (test_bit(HCI_MGMT, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001009 !test_bit(HCI_INIT, &hdev->flags))
Johan Hedberg8f984df2012-02-28 01:07:22 +02001010 mgmt_le_enable_complete(hdev, sent->le, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001011}
1012
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001013static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1014 struct sk_buff *skb)
1015{
1016 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1017
1018 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1019 hdev->name, rp->status, rp->phy_handle);
1020
1021 if (rp->status)
1022 return;
1023
1024 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1025}
1026
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001027static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001028{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001029 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001030
1031 if (status) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001032 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001033 return;
1034 }
1035
Andre Guedes89352e72011-11-04 14:16:53 -03001036 set_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001037}
1038
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001039static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001040{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001041 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001042 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001044 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001045
1046 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047 if (!cp)
1048 return;
1049
1050 hci_dev_lock(hdev);
1051
1052 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1053
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001054 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001055
1056 if (status) {
1057 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001058 if (status != 0x0c || conn->attempt > 2) {
1059 conn->state = BT_CLOSED;
1060 hci_proto_connect_cfm(conn, status);
1061 hci_conn_del(conn);
1062 } else
1063 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064 }
1065 } else {
1066 if (!conn) {
1067 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1068 if (conn) {
Johan Hedberga0c808b2012-01-16 09:49:58 +02001069 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 conn->link_mode |= HCI_LM_MASTER;
1071 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001072 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073 }
1074 }
1075
1076 hci_dev_unlock(hdev);
1077}
1078
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001079static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001080{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001081 struct hci_cp_add_sco *cp;
1082 struct hci_conn *acl, *sco;
1083 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001085 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001086
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001087 if (!status)
1088 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001089
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001090 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1091 if (!cp)
1092 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001093
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001094 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001095
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001096 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001097
1098 hci_dev_lock(hdev);
1099
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001100 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001101 if (acl) {
1102 sco = acl->link;
1103 if (sco) {
1104 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001105
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001106 hci_proto_connect_cfm(sco, status);
1107 hci_conn_del(sco);
1108 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001109 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001110
1111 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001112}
1113
Marcel Holtmannf8558552008-07-14 20:13:49 +02001114static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1115{
1116 struct hci_cp_auth_requested *cp;
1117 struct hci_conn *conn;
1118
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001119 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001120
1121 if (!status)
1122 return;
1123
1124 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1125 if (!cp)
1126 return;
1127
1128 hci_dev_lock(hdev);
1129
1130 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1131 if (conn) {
1132 if (conn->state == BT_CONFIG) {
1133 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001134 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001135 }
1136 }
1137
1138 hci_dev_unlock(hdev);
1139}
1140
1141static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1142{
1143 struct hci_cp_set_conn_encrypt *cp;
1144 struct hci_conn *conn;
1145
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001146 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001147
1148 if (!status)
1149 return;
1150
1151 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1152 if (!cp)
1153 return;
1154
1155 hci_dev_lock(hdev);
1156
1157 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1158 if (conn) {
1159 if (conn->state == BT_CONFIG) {
1160 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001161 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001162 }
1163 }
1164
1165 hci_dev_unlock(hdev);
1166}
1167
Johan Hedberg127178d2010-11-18 22:22:29 +02001168static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001169 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001170{
Johan Hedberg392599b2010-11-18 22:22:28 +02001171 if (conn->state != BT_CONFIG || !conn->out)
1172 return 0;
1173
Johan Hedberg765c2a92011-01-19 12:06:52 +05301174 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001175 return 0;
1176
1177 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001178 * devices with sec_level HIGH or if MITM protection is requested */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001179 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
1180 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001181 return 0;
1182
Johan Hedberg392599b2010-11-18 22:22:28 +02001183 return 1;
1184}
1185
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001186static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001187 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001188{
1189 struct hci_cp_remote_name_req cp;
1190
1191 memset(&cp, 0, sizeof(cp));
1192
1193 bacpy(&cp.bdaddr, &e->data.bdaddr);
1194 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1195 cp.pscan_mode = e->data.pscan_mode;
1196 cp.clock_offset = e->data.clock_offset;
1197
1198 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1199}
1200
Johan Hedbergb644ba32012-01-17 21:48:47 +02001201static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001202{
1203 struct discovery_state *discov = &hdev->discovery;
1204 struct inquiry_entry *e;
1205
Johan Hedbergb644ba32012-01-17 21:48:47 +02001206 if (list_empty(&discov->resolve))
1207 return false;
1208
1209 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001210 if (!e)
1211 return false;
1212
Johan Hedbergb644ba32012-01-17 21:48:47 +02001213 if (hci_resolve_name(hdev, e) == 0) {
1214 e->name_state = NAME_PENDING;
1215 return true;
1216 }
1217
1218 return false;
1219}
1220
1221static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001222 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001223{
1224 struct discovery_state *discov = &hdev->discovery;
1225 struct inquiry_entry *e;
1226
1227 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001228 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1229 name_len, conn->dev_class);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001230
1231 if (discov->state == DISCOVERY_STOPPED)
1232 return;
1233
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001234 if (discov->state == DISCOVERY_STOPPING)
1235 goto discov_complete;
1236
1237 if (discov->state != DISCOVERY_RESOLVING)
1238 return;
1239
1240 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001241 /* If the device was not found in a list of found devices names of which
1242 * are pending. there is no need to continue resolving a next name as it
1243 * will be done upon receiving another Remote Name Request Complete
1244 * Event */
1245 if (!e)
1246 return;
1247
1248 list_del(&e->list);
1249 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001250 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001251 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1252 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001253 } else {
1254 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001255 }
1256
Johan Hedbergb644ba32012-01-17 21:48:47 +02001257 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001258 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001259
1260discov_complete:
1261 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1262}
1263
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001264static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1265{
Johan Hedberg127178d2010-11-18 22:22:29 +02001266 struct hci_cp_remote_name_req *cp;
1267 struct hci_conn *conn;
1268
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001269 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001270
1271 /* If successful wait for the name req complete event before
1272 * checking for the need to do authentication */
1273 if (!status)
1274 return;
1275
1276 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1277 if (!cp)
1278 return;
1279
1280 hci_dev_lock(hdev);
1281
1282 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001283
1284 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1285 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1286
Johan Hedberg79c6c702011-04-28 11:28:55 -07001287 if (!conn)
1288 goto unlock;
1289
1290 if (!hci_outgoing_auth_needed(hdev, conn))
1291 goto unlock;
1292
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001293 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001294 struct hci_cp_auth_requested cp;
1295 cp.handle = __cpu_to_le16(conn->handle);
1296 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1297 }
1298
Johan Hedberg79c6c702011-04-28 11:28:55 -07001299unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001300 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001301}
1302
Marcel Holtmann769be972008-07-14 20:13:49 +02001303static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1304{
1305 struct hci_cp_read_remote_features *cp;
1306 struct hci_conn *conn;
1307
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001308 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001309
1310 if (!status)
1311 return;
1312
1313 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1314 if (!cp)
1315 return;
1316
1317 hci_dev_lock(hdev);
1318
1319 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1320 if (conn) {
1321 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001322 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001323 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001324 }
1325 }
1326
1327 hci_dev_unlock(hdev);
1328}
1329
1330static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1331{
1332 struct hci_cp_read_remote_ext_features *cp;
1333 struct hci_conn *conn;
1334
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001335 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001336
1337 if (!status)
1338 return;
1339
1340 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1341 if (!cp)
1342 return;
1343
1344 hci_dev_lock(hdev);
1345
1346 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1347 if (conn) {
1348 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001349 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001350 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001351 }
1352 }
1353
1354 hci_dev_unlock(hdev);
1355}
1356
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001357static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1358{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001359 struct hci_cp_setup_sync_conn *cp;
1360 struct hci_conn *acl, *sco;
1361 __u16 handle;
1362
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001363 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001364
1365 if (!status)
1366 return;
1367
1368 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1369 if (!cp)
1370 return;
1371
1372 handle = __le16_to_cpu(cp->handle);
1373
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001374 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001375
1376 hci_dev_lock(hdev);
1377
1378 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001379 if (acl) {
1380 sco = acl->link;
1381 if (sco) {
1382 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001383
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001384 hci_proto_connect_cfm(sco, status);
1385 hci_conn_del(sco);
1386 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001387 }
1388
1389 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001390}
1391
1392static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1393{
1394 struct hci_cp_sniff_mode *cp;
1395 struct hci_conn *conn;
1396
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001397 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001398
1399 if (!status)
1400 return;
1401
1402 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1403 if (!cp)
1404 return;
1405
1406 hci_dev_lock(hdev);
1407
1408 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001409 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001410 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001411
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001412 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001413 hci_sco_setup(conn, status);
1414 }
1415
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001416 hci_dev_unlock(hdev);
1417}
1418
1419static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1420{
1421 struct hci_cp_exit_sniff_mode *cp;
1422 struct hci_conn *conn;
1423
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001424 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001425
1426 if (!status)
1427 return;
1428
1429 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1430 if (!cp)
1431 return;
1432
1433 hci_dev_lock(hdev);
1434
1435 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001436 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001437 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001438
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001439 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001440 hci_sco_setup(conn, status);
1441 }
1442
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001443 hci_dev_unlock(hdev);
1444}
1445
Johan Hedberg88c3df12012-02-09 14:27:38 +02001446static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1447{
1448 struct hci_cp_disconnect *cp;
1449 struct hci_conn *conn;
1450
1451 if (!status)
1452 return;
1453
1454 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1455 if (!cp)
1456 return;
1457
1458 hci_dev_lock(hdev);
1459
1460 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1461 if (conn)
1462 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001463 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001464
1465 hci_dev_unlock(hdev);
1466}
1467
Ville Tervofcd89c02011-02-10 22:38:47 -03001468static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1469{
Ville Tervofcd89c02011-02-10 22:38:47 -03001470 struct hci_conn *conn;
1471
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001472 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Ville Tervofcd89c02011-02-10 22:38:47 -03001473
Ville Tervofcd89c02011-02-10 22:38:47 -03001474 if (status) {
Andre Guedesf00a06a2012-07-27 15:10:13 -03001475 hci_dev_lock(hdev);
Ville Tervofcd89c02011-02-10 22:38:47 -03001476
Andre Guedes0c95ab72012-07-27 15:10:14 -03001477 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001478 if (!conn) {
1479 hci_dev_unlock(hdev);
1480 return;
1481 }
1482
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001483 BT_DBG("%s bdaddr %pMR conn %p", hdev->name, &conn->dst, conn);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001484
1485 conn->state = BT_CLOSED;
Andre Guedes0c95ab72012-07-27 15:10:14 -03001486 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Andre Guedesf00a06a2012-07-27 15:10:13 -03001487 conn->dst_type, status);
1488 hci_proto_connect_cfm(conn, status);
1489 hci_conn_del(conn);
1490
1491 hci_dev_unlock(hdev);
1492 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001493}
1494
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001495static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1496{
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001497 struct hci_cp_create_phy_link *cp;
1498
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001499 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001500
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001501 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1502 if (!cp)
1503 return;
1504
Andrei Emeltchenkoe58917b2012-10-31 15:46:33 +02001505 hci_dev_lock(hdev);
1506
1507 if (status) {
1508 struct hci_conn *hcon;
1509
1510 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1511 if (hcon)
1512 hci_conn_del(hcon);
1513 } else {
1514 amp_write_remote_assoc(hdev, cp->phy_handle);
1515 }
1516
1517 hci_dev_unlock(hdev);
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001518}
1519
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03001520static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1521{
1522 struct hci_cp_accept_phy_link *cp;
1523
1524 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1525
1526 if (status)
1527 return;
1528
1529 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1530 if (!cp)
1531 return;
1532
1533 amp_write_remote_assoc(hdev, cp->phy_handle);
1534}
1535
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001536static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001537{
1538 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001539 struct discovery_state *discov = &hdev->discovery;
1540 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001541
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001542 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001543
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001544 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001545
1546 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1547 return;
1548
Andre Guedes3e13fa12013-03-27 20:04:56 -03001549 smp_mb__after_clear_bit(); /* wake_up_bit advises about this barrier */
1550 wake_up_bit(&hdev->flags, HCI_INQUIRY);
1551
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001552 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001553 return;
1554
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001555 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001556
Andre Guedes343f9352012-02-17 20:39:37 -03001557 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001558 goto unlock;
1559
1560 if (list_empty(&discov->resolve)) {
1561 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1562 goto unlock;
1563 }
1564
1565 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1566 if (e && hci_resolve_name(hdev, e) == 0) {
1567 e->name_state = NAME_PENDING;
1568 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1569 } else {
1570 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1571 }
1572
1573unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001574 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001575}
1576
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001577static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001578{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001579 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001580 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001581 int num_rsp = *((__u8 *) skb->data);
1582
1583 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1584
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001585 if (!num_rsp)
1586 return;
1587
Andre Guedes1519cc12012-03-21 00:03:38 -03001588 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1589 return;
1590
Linus Torvalds1da177e2005-04-16 15:20:36 -07001591 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001592
Johan Hedberge17acd42011-03-30 23:57:16 +03001593 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001594 bool name_known, ssp;
Johan Hedberg31754052012-01-04 13:39:52 +02001595
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596 bacpy(&data.bdaddr, &info->bdaddr);
1597 data.pscan_rep_mode = info->pscan_rep_mode;
1598 data.pscan_period_mode = info->pscan_period_mode;
1599 data.pscan_mode = info->pscan_mode;
1600 memcpy(data.dev_class, info->dev_class, 3);
1601 data.clock_offset = info->clock_offset;
1602 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001603 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02001604
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001605 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02001606 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001607 info->dev_class, 0, !name_known, ssp, NULL,
1608 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001609 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001610
Linus Torvalds1da177e2005-04-16 15:20:36 -07001611 hci_dev_unlock(hdev);
1612}
1613
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001614static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001616 struct hci_ev_conn_complete *ev = (void *) skb->data;
1617 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001618
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001619 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001620
Linus Torvalds1da177e2005-04-16 15:20:36 -07001621 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001622
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001623 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001624 if (!conn) {
1625 if (ev->link_type != SCO_LINK)
1626 goto unlock;
1627
1628 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1629 if (!conn)
1630 goto unlock;
1631
1632 conn->type = SCO_LINK;
1633 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001634
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001635 if (!ev->status) {
1636 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001637
1638 if (conn->type == ACL_LINK) {
1639 conn->state = BT_CONFIG;
1640 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02001641
1642 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1643 !hci_find_link_key(hdev, &ev->bdaddr))
1644 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1645 else
1646 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02001647 } else
1648 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001649
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001650 hci_conn_add_sysfs(conn);
1651
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001652 if (test_bit(HCI_AUTH, &hdev->flags))
1653 conn->link_mode |= HCI_LM_AUTH;
1654
1655 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1656 conn->link_mode |= HCI_LM_ENCRYPT;
1657
1658 /* Get remote features */
1659 if (conn->type == ACL_LINK) {
1660 struct hci_cp_read_remote_features cp;
1661 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001662 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001663 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001664 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001665
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001666 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02001667 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001668 struct hci_cp_change_conn_ptype cp;
1669 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001670 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001671 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
1672 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001673 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001674 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001675 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001676 if (conn->type == ACL_LINK)
Johan Hedberg744cf192011-11-08 20:40:14 +02001677 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001678 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02001679 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001680
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001681 if (conn->type == ACL_LINK)
1682 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001683
Marcel Holtmann769be972008-07-14 20:13:49 +02001684 if (ev->status) {
1685 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001686 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001687 } else if (ev->link_type != ACL_LINK)
1688 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001689
1690unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001691 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001692
1693 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001694}
1695
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001696static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001697{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001698 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001699 int mask = hdev->link_mode;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001700 __u8 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001701
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001702 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001703 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001704
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001705 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
1706 &flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001707
Szymon Janc138d22e2011-02-17 16:44:23 +01001708 if ((mask & HCI_LM_ACCEPT) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001709 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001710 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001711 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001712 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001713
1714 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001715
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001716 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1717 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001718 memcpy(ie->data.dev_class, ev->dev_class, 3);
1719
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03001720 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
1721 &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001722 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001723 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1724 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001725 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001726 hci_dev_unlock(hdev);
1727 return;
1728 }
1729 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001730
Linus Torvalds1da177e2005-04-16 15:20:36 -07001731 memcpy(conn->dev_class, ev->dev_class, 3);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001732
Linus Torvalds1da177e2005-04-16 15:20:36 -07001733 hci_dev_unlock(hdev);
1734
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001735 if (ev->link_type == ACL_LINK ||
1736 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001737 struct hci_cp_accept_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001738 conn->state = BT_CONNECT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001739
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001740 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001741
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001742 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1743 cp.role = 0x00; /* Become master */
1744 else
1745 cp.role = 0x01; /* Remain slave */
1746
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001747 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
1748 &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001749 } else if (!(flags & HCI_PROTO_DEFER)) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001750 struct hci_cp_accept_sync_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001751 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001752
1753 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001754 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001755
Andrei Emeltchenko82781e62012-05-25 11:38:27 +03001756 cp.tx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1757 cp.rx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1758 cp.max_latency = __constant_cpu_to_le16(0xffff);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001759 cp.content_format = cpu_to_le16(hdev->voice_setting);
1760 cp.retrans_effort = 0xff;
1761
1762 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001763 sizeof(cp), &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001764 } else {
1765 conn->state = BT_CONNECT2;
1766 hci_proto_connect_cfm(conn, 0);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001767 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001768 } else {
1769 /* Connection rejected */
1770 struct hci_cp_reject_conn_req cp;
1771
1772 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02001773 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001774 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775 }
1776}
1777
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001778static u8 hci_to_mgmt_reason(u8 err)
1779{
1780 switch (err) {
1781 case HCI_ERROR_CONNECTION_TIMEOUT:
1782 return MGMT_DEV_DISCONN_TIMEOUT;
1783 case HCI_ERROR_REMOTE_USER_TERM:
1784 case HCI_ERROR_REMOTE_LOW_RESOURCES:
1785 case HCI_ERROR_REMOTE_POWER_OFF:
1786 return MGMT_DEV_DISCONN_REMOTE;
1787 case HCI_ERROR_LOCAL_HOST_TERM:
1788 return MGMT_DEV_DISCONN_LOCAL_HOST;
1789 default:
1790 return MGMT_DEV_DISCONN_UNKNOWN;
1791 }
1792}
1793
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001794static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001795{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001796 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001797 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001798
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001799 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800
Linus Torvalds1da177e2005-04-16 15:20:36 -07001801 hci_dev_lock(hdev);
1802
Marcel Holtmann04837f62006-07-03 10:02:33 +02001803 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001804 if (!conn)
1805 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001806
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001807 if (ev->status == 0)
1808 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001809
Johan Hedbergb644ba32012-01-17 21:48:47 +02001810 if (test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001811 (conn->type == ACL_LINK || conn->type == LE_LINK)) {
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001812 if (ev->status) {
Johan Hedberg88c3df12012-02-09 14:27:38 +02001813 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001814 conn->dst_type, ev->status);
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001815 } else {
1816 u8 reason = hci_to_mgmt_reason(ev->reason);
1817
Johan Hedbergafc747a2012-01-15 18:11:07 +02001818 mgmt_device_disconnected(hdev, &conn->dst, conn->type,
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001819 conn->dst_type, reason);
1820 }
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001821 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001822
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001823 if (ev->status == 0) {
Vishal Agarwal6ec5bca2012-04-16 14:44:44 +05301824 if (conn->type == ACL_LINK && conn->flush_key)
1825 hci_remove_link_key(hdev, &conn->dst);
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001826 hci_proto_disconn_cfm(conn, ev->reason);
1827 hci_conn_del(conn);
1828 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001829
1830unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001831 hci_dev_unlock(hdev);
1832}
1833
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001834static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001835{
1836 struct hci_ev_auth_complete *ev = (void *) skb->data;
1837 struct hci_conn *conn;
1838
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001839 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001840
1841 hci_dev_lock(hdev);
1842
1843 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001844 if (!conn)
1845 goto unlock;
1846
1847 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02001848 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001849 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001850 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001851 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001852 conn->link_mode |= HCI_LM_AUTH;
1853 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001854 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001855 } else {
Johan Hedbergbab73cb2012-02-09 16:07:29 +02001856 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001857 ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001858 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001859
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001860 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
1861 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001862
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001863 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02001864 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001865 struct hci_cp_set_conn_encrypt cp;
1866 cp.handle = ev->handle;
1867 cp.encrypt = 0x01;
1868 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03001869 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001870 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001871 conn->state = BT_CONNECTED;
1872 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001873 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001874 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001875 } else {
1876 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001877
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001878 hci_conn_hold(conn);
1879 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02001880 hci_conn_drop(conn);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001881 }
1882
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001883 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001884 if (!ev->status) {
1885 struct hci_cp_set_conn_encrypt cp;
1886 cp.handle = ev->handle;
1887 cp.encrypt = 0x01;
1888 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03001889 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001890 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001891 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001892 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001893 }
1894 }
1895
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001896unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001897 hci_dev_unlock(hdev);
1898}
1899
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001900static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001901{
Johan Hedberg127178d2010-11-18 22:22:29 +02001902 struct hci_ev_remote_name *ev = (void *) skb->data;
1903 struct hci_conn *conn;
1904
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001905 BT_DBG("%s", hdev->name);
1906
1907 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001908
1909 hci_dev_lock(hdev);
1910
1911 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001912
1913 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
1914 goto check_auth;
1915
1916 if (ev->status == 0)
1917 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001918 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02001919 else
1920 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
1921
1922check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07001923 if (!conn)
1924 goto unlock;
1925
1926 if (!hci_outgoing_auth_needed(hdev, conn))
1927 goto unlock;
1928
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001929 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001930 struct hci_cp_auth_requested cp;
1931 cp.handle = __cpu_to_le16(conn->handle);
1932 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1933 }
1934
Johan Hedberg79c6c702011-04-28 11:28:55 -07001935unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001936 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001937}
1938
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001939static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001940{
1941 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1942 struct hci_conn *conn;
1943
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001944 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001945
1946 hci_dev_lock(hdev);
1947
1948 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1949 if (conn) {
1950 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001951 if (ev->encrypt) {
1952 /* Encryption implies authentication */
1953 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001954 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03001955 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001956 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001957 conn->link_mode &= ~HCI_LM_ENCRYPT;
1958 }
1959
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001960 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001961
Gustavo Padovana7d77232012-05-13 03:20:07 -03001962 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03001963 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02001964 hci_conn_drop(conn);
Gustavo Padovana7d77232012-05-13 03:20:07 -03001965 goto unlock;
1966 }
1967
Marcel Holtmannf8558552008-07-14 20:13:49 +02001968 if (conn->state == BT_CONFIG) {
1969 if (!ev->status)
1970 conn->state = BT_CONNECTED;
1971
1972 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001973 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001974 } else
1975 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001976 }
1977
Gustavo Padovana7d77232012-05-13 03:20:07 -03001978unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001979 hci_dev_unlock(hdev);
1980}
1981
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001982static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
1983 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001984{
1985 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1986 struct hci_conn *conn;
1987
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001988 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001989
1990 hci_dev_lock(hdev);
1991
1992 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1993 if (conn) {
1994 if (!ev->status)
1995 conn->link_mode |= HCI_LM_SECURE;
1996
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001997 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001998
1999 hci_key_change_cfm(conn, ev->status);
2000 }
2001
2002 hci_dev_unlock(hdev);
2003}
2004
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002005static void hci_remote_features_evt(struct hci_dev *hdev,
2006 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002007{
2008 struct hci_ev_remote_features *ev = (void *) skb->data;
2009 struct hci_conn *conn;
2010
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002011 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002012
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002013 hci_dev_lock(hdev);
2014
2015 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002016 if (!conn)
2017 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002018
Johan Hedbergccd556f2010-11-10 17:11:51 +02002019 if (!ev->status)
Johan Hedbergcad718e2013-04-17 15:00:51 +03002020 memcpy(conn->features[0], ev->features, 8);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002021
2022 if (conn->state != BT_CONFIG)
2023 goto unlock;
2024
2025 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2026 struct hci_cp_read_remote_ext_features cp;
2027 cp.handle = ev->handle;
2028 cp.page = 0x01;
2029 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002030 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002031 goto unlock;
2032 }
2033
Johan Hedberg671267b2012-05-12 16:11:50 -03002034 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002035 struct hci_cp_remote_name_req cp;
2036 memset(&cp, 0, sizeof(cp));
2037 bacpy(&cp.bdaddr, &conn->dst);
2038 cp.pscan_rep_mode = 0x02;
2039 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002040 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2041 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002042 conn->dst_type, 0, NULL, 0,
2043 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002044
Johan Hedberg127178d2010-11-18 22:22:29 +02002045 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002046 conn->state = BT_CONNECTED;
2047 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002048 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002049 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002050
Johan Hedbergccd556f2010-11-10 17:11:51 +02002051unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002052 hci_dev_unlock(hdev);
2053}
2054
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002055static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002056{
2057 struct hci_ev_cmd_complete *ev = (void *) skb->data;
Johan Hedberg9238f362013-03-05 20:37:48 +02002058 u8 status = skb->data[sizeof(*ev)];
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002059 __u16 opcode;
2060
2061 skb_pull(skb, sizeof(*ev));
2062
2063 opcode = __le16_to_cpu(ev->opcode);
2064
2065 switch (opcode) {
2066 case HCI_OP_INQUIRY_CANCEL:
2067 hci_cc_inquiry_cancel(hdev, skb);
2068 break;
2069
Andre Guedes4d934832012-03-21 00:03:35 -03002070 case HCI_OP_PERIODIC_INQ:
2071 hci_cc_periodic_inq(hdev, skb);
2072 break;
2073
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002074 case HCI_OP_EXIT_PERIODIC_INQ:
2075 hci_cc_exit_periodic_inq(hdev, skb);
2076 break;
2077
2078 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2079 hci_cc_remote_name_req_cancel(hdev, skb);
2080 break;
2081
2082 case HCI_OP_ROLE_DISCOVERY:
2083 hci_cc_role_discovery(hdev, skb);
2084 break;
2085
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002086 case HCI_OP_READ_LINK_POLICY:
2087 hci_cc_read_link_policy(hdev, skb);
2088 break;
2089
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002090 case HCI_OP_WRITE_LINK_POLICY:
2091 hci_cc_write_link_policy(hdev, skb);
2092 break;
2093
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002094 case HCI_OP_READ_DEF_LINK_POLICY:
2095 hci_cc_read_def_link_policy(hdev, skb);
2096 break;
2097
2098 case HCI_OP_WRITE_DEF_LINK_POLICY:
2099 hci_cc_write_def_link_policy(hdev, skb);
2100 break;
2101
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002102 case HCI_OP_RESET:
2103 hci_cc_reset(hdev, skb);
2104 break;
2105
2106 case HCI_OP_WRITE_LOCAL_NAME:
2107 hci_cc_write_local_name(hdev, skb);
2108 break;
2109
2110 case HCI_OP_READ_LOCAL_NAME:
2111 hci_cc_read_local_name(hdev, skb);
2112 break;
2113
2114 case HCI_OP_WRITE_AUTH_ENABLE:
2115 hci_cc_write_auth_enable(hdev, skb);
2116 break;
2117
2118 case HCI_OP_WRITE_ENCRYPT_MODE:
2119 hci_cc_write_encrypt_mode(hdev, skb);
2120 break;
2121
2122 case HCI_OP_WRITE_SCAN_ENABLE:
2123 hci_cc_write_scan_enable(hdev, skb);
2124 break;
2125
2126 case HCI_OP_READ_CLASS_OF_DEV:
2127 hci_cc_read_class_of_dev(hdev, skb);
2128 break;
2129
2130 case HCI_OP_WRITE_CLASS_OF_DEV:
2131 hci_cc_write_class_of_dev(hdev, skb);
2132 break;
2133
2134 case HCI_OP_READ_VOICE_SETTING:
2135 hci_cc_read_voice_setting(hdev, skb);
2136 break;
2137
2138 case HCI_OP_WRITE_VOICE_SETTING:
2139 hci_cc_write_voice_setting(hdev, skb);
2140 break;
2141
Marcel Holtmann333140b2008-07-14 20:13:48 +02002142 case HCI_OP_WRITE_SSP_MODE:
2143 hci_cc_write_ssp_mode(hdev, skb);
2144 break;
2145
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002146 case HCI_OP_READ_LOCAL_VERSION:
2147 hci_cc_read_local_version(hdev, skb);
2148 break;
2149
2150 case HCI_OP_READ_LOCAL_COMMANDS:
2151 hci_cc_read_local_commands(hdev, skb);
2152 break;
2153
2154 case HCI_OP_READ_LOCAL_FEATURES:
2155 hci_cc_read_local_features(hdev, skb);
2156 break;
2157
Andre Guedes971e3a42011-06-30 19:20:52 -03002158 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2159 hci_cc_read_local_ext_features(hdev, skb);
2160 break;
2161
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002162 case HCI_OP_READ_BUFFER_SIZE:
2163 hci_cc_read_buffer_size(hdev, skb);
2164 break;
2165
2166 case HCI_OP_READ_BD_ADDR:
2167 hci_cc_read_bd_addr(hdev, skb);
2168 break;
2169
Johan Hedbergf332ec62013-03-15 17:07:11 -05002170 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2171 hci_cc_read_page_scan_activity(hdev, skb);
2172 break;
2173
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002174 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2175 hci_cc_write_page_scan_activity(hdev, skb);
2176 break;
2177
Johan Hedbergf332ec62013-03-15 17:07:11 -05002178 case HCI_OP_READ_PAGE_SCAN_TYPE:
2179 hci_cc_read_page_scan_type(hdev, skb);
2180 break;
2181
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002182 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2183 hci_cc_write_page_scan_type(hdev, skb);
2184 break;
2185
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002186 case HCI_OP_READ_DATA_BLOCK_SIZE:
2187 hci_cc_read_data_block_size(hdev, skb);
2188 break;
2189
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002190 case HCI_OP_READ_FLOW_CONTROL_MODE:
2191 hci_cc_read_flow_control_mode(hdev, skb);
2192 break;
2193
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002194 case HCI_OP_READ_LOCAL_AMP_INFO:
2195 hci_cc_read_local_amp_info(hdev, skb);
2196 break;
2197
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002198 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2199 hci_cc_read_local_amp_assoc(hdev, skb);
2200 break;
2201
Johan Hedbergd5859e22011-01-25 01:19:58 +02002202 case HCI_OP_READ_INQ_RSP_TX_POWER:
2203 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2204 break;
2205
Johan Hedberg980e1a52011-01-22 06:10:07 +02002206 case HCI_OP_PIN_CODE_REPLY:
2207 hci_cc_pin_code_reply(hdev, skb);
2208 break;
2209
2210 case HCI_OP_PIN_CODE_NEG_REPLY:
2211 hci_cc_pin_code_neg_reply(hdev, skb);
2212 break;
2213
Szymon Jancc35938b2011-03-22 13:12:21 +01002214 case HCI_OP_READ_LOCAL_OOB_DATA:
2215 hci_cc_read_local_oob_data_reply(hdev, skb);
2216 break;
2217
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002218 case HCI_OP_LE_READ_BUFFER_SIZE:
2219 hci_cc_le_read_buffer_size(hdev, skb);
2220 break;
2221
Johan Hedberg60e77322013-01-22 14:01:59 +02002222 case HCI_OP_LE_READ_LOCAL_FEATURES:
2223 hci_cc_le_read_local_features(hdev, skb);
2224 break;
2225
Johan Hedberg8fa19092012-10-19 20:57:49 +03002226 case HCI_OP_LE_READ_ADV_TX_POWER:
2227 hci_cc_le_read_adv_tx_power(hdev, skb);
2228 break;
2229
Johan Hedberga5c29682011-02-19 12:05:57 -03002230 case HCI_OP_USER_CONFIRM_REPLY:
2231 hci_cc_user_confirm_reply(hdev, skb);
2232 break;
2233
2234 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2235 hci_cc_user_confirm_neg_reply(hdev, skb);
2236 break;
2237
Brian Gix1143d452011-11-23 08:28:34 -08002238 case HCI_OP_USER_PASSKEY_REPLY:
2239 hci_cc_user_passkey_reply(hdev, skb);
2240 break;
2241
2242 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2243 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002244 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002245
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01002246 case HCI_OP_LE_SET_ADV_ENABLE:
2247 hci_cc_le_set_adv_enable(hdev, skb);
2248 break;
2249
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002250 case HCI_OP_LE_SET_SCAN_ENABLE:
2251 hci_cc_le_set_scan_enable(hdev, skb);
2252 break;
2253
Johan Hedbergcf1d0812013-01-22 14:02:00 +02002254 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2255 hci_cc_le_read_white_list_size(hdev, skb);
2256 break;
2257
Johan Hedberg9b008c02013-01-22 14:02:01 +02002258 case HCI_OP_LE_READ_SUPPORTED_STATES:
2259 hci_cc_le_read_supported_states(hdev, skb);
2260 break;
2261
Andre Guedesf9b49302011-06-30 19:20:53 -03002262 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2263 hci_cc_write_le_host_supported(hdev, skb);
2264 break;
2265
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03002266 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2267 hci_cc_write_remote_amp_assoc(hdev, skb);
2268 break;
2269
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002270 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002271 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002272 break;
2273 }
2274
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002275 if (opcode != HCI_OP_NOP)
Ville Tervo6bd32322011-02-16 16:32:41 +02002276 del_timer(&hdev->cmd_timer);
2277
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002278 hci_req_cmd_complete(hdev, opcode, status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002279
Szymon Jancdbccd792012-12-11 08:51:19 +01002280 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002281 atomic_set(&hdev->cmd_cnt, 1);
2282 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002283 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002284 }
2285}
2286
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002287static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002288{
2289 struct hci_ev_cmd_status *ev = (void *) skb->data;
2290 __u16 opcode;
2291
2292 skb_pull(skb, sizeof(*ev));
2293
2294 opcode = __le16_to_cpu(ev->opcode);
2295
2296 switch (opcode) {
2297 case HCI_OP_INQUIRY:
2298 hci_cs_inquiry(hdev, ev->status);
2299 break;
2300
2301 case HCI_OP_CREATE_CONN:
2302 hci_cs_create_conn(hdev, ev->status);
2303 break;
2304
2305 case HCI_OP_ADD_SCO:
2306 hci_cs_add_sco(hdev, ev->status);
2307 break;
2308
Marcel Holtmannf8558552008-07-14 20:13:49 +02002309 case HCI_OP_AUTH_REQUESTED:
2310 hci_cs_auth_requested(hdev, ev->status);
2311 break;
2312
2313 case HCI_OP_SET_CONN_ENCRYPT:
2314 hci_cs_set_conn_encrypt(hdev, ev->status);
2315 break;
2316
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002317 case HCI_OP_REMOTE_NAME_REQ:
2318 hci_cs_remote_name_req(hdev, ev->status);
2319 break;
2320
Marcel Holtmann769be972008-07-14 20:13:49 +02002321 case HCI_OP_READ_REMOTE_FEATURES:
2322 hci_cs_read_remote_features(hdev, ev->status);
2323 break;
2324
2325 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2326 hci_cs_read_remote_ext_features(hdev, ev->status);
2327 break;
2328
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002329 case HCI_OP_SETUP_SYNC_CONN:
2330 hci_cs_setup_sync_conn(hdev, ev->status);
2331 break;
2332
2333 case HCI_OP_SNIFF_MODE:
2334 hci_cs_sniff_mode(hdev, ev->status);
2335 break;
2336
2337 case HCI_OP_EXIT_SNIFF_MODE:
2338 hci_cs_exit_sniff_mode(hdev, ev->status);
2339 break;
2340
Johan Hedberg8962ee72011-01-20 12:40:27 +02002341 case HCI_OP_DISCONNECT:
Johan Hedberg88c3df12012-02-09 14:27:38 +02002342 hci_cs_disconnect(hdev, ev->status);
Johan Hedberg8962ee72011-01-20 12:40:27 +02002343 break;
2344
Ville Tervofcd89c02011-02-10 22:38:47 -03002345 case HCI_OP_LE_CREATE_CONN:
2346 hci_cs_le_create_conn(hdev, ev->status);
2347 break;
2348
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03002349 case HCI_OP_CREATE_PHY_LINK:
2350 hci_cs_create_phylink(hdev, ev->status);
2351 break;
2352
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03002353 case HCI_OP_ACCEPT_PHY_LINK:
2354 hci_cs_accept_phylink(hdev, ev->status);
2355 break;
2356
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002357 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002358 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002359 break;
2360 }
2361
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002362 if (opcode != HCI_OP_NOP)
Ville Tervo6bd32322011-02-16 16:32:41 +02002363 del_timer(&hdev->cmd_timer);
2364
Johan Hedberg02350a72013-04-03 21:50:29 +03002365 if (ev->status ||
2366 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
2367 hci_req_cmd_complete(hdev, opcode, ev->status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002368
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002369 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002370 atomic_set(&hdev->cmd_cnt, 1);
2371 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002372 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002373 }
2374}
2375
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002376static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002377{
2378 struct hci_ev_role_change *ev = (void *) skb->data;
2379 struct hci_conn *conn;
2380
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002381 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002382
2383 hci_dev_lock(hdev);
2384
2385 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2386 if (conn) {
2387 if (!ev->status) {
2388 if (ev->role)
2389 conn->link_mode &= ~HCI_LM_MASTER;
2390 else
2391 conn->link_mode |= HCI_LM_MASTER;
2392 }
2393
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002394 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002395
2396 hci_role_switch_cfm(conn, ev->status, ev->role);
2397 }
2398
2399 hci_dev_unlock(hdev);
2400}
2401
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002402static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002403{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002404 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002405 int i;
2406
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02002407 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2408 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2409 return;
2410 }
2411
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002412 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002413 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002414 BT_DBG("%s bad parameters", hdev->name);
2415 return;
2416 }
2417
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002418 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2419
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002420 for (i = 0; i < ev->num_hndl; i++) {
2421 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002422 struct hci_conn *conn;
2423 __u16 handle, count;
2424
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002425 handle = __le16_to_cpu(info->handle);
2426 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002427
2428 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002429 if (!conn)
2430 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002431
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002432 conn->sent -= count;
2433
2434 switch (conn->type) {
2435 case ACL_LINK:
2436 hdev->acl_cnt += count;
2437 if (hdev->acl_cnt > hdev->acl_pkts)
2438 hdev->acl_cnt = hdev->acl_pkts;
2439 break;
2440
2441 case LE_LINK:
2442 if (hdev->le_pkts) {
2443 hdev->le_cnt += count;
2444 if (hdev->le_cnt > hdev->le_pkts)
2445 hdev->le_cnt = hdev->le_pkts;
2446 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002447 hdev->acl_cnt += count;
2448 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002449 hdev->acl_cnt = hdev->acl_pkts;
2450 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002451 break;
2452
2453 case SCO_LINK:
2454 hdev->sco_cnt += count;
2455 if (hdev->sco_cnt > hdev->sco_pkts)
2456 hdev->sco_cnt = hdev->sco_pkts;
2457 break;
2458
2459 default:
2460 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2461 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002462 }
2463 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002464
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02002465 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002466}
2467
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002468static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
2469 __u16 handle)
2470{
2471 struct hci_chan *chan;
2472
2473 switch (hdev->dev_type) {
2474 case HCI_BREDR:
2475 return hci_conn_hash_lookup_handle(hdev, handle);
2476 case HCI_AMP:
2477 chan = hci_chan_lookup_handle(hdev, handle);
2478 if (chan)
2479 return chan->conn;
2480 break;
2481 default:
2482 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
2483 break;
2484 }
2485
2486 return NULL;
2487}
2488
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002489static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002490{
2491 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2492 int i;
2493
2494 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2495 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2496 return;
2497 }
2498
2499 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002500 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002501 BT_DBG("%s bad parameters", hdev->name);
2502 return;
2503 }
2504
2505 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002506 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002507
2508 for (i = 0; i < ev->num_hndl; i++) {
2509 struct hci_comp_blocks_info *info = &ev->handles[i];
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002510 struct hci_conn *conn = NULL;
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002511 __u16 handle, block_count;
2512
2513 handle = __le16_to_cpu(info->handle);
2514 block_count = __le16_to_cpu(info->blocks);
2515
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002516 conn = __hci_conn_lookup_handle(hdev, handle);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002517 if (!conn)
2518 continue;
2519
2520 conn->sent -= block_count;
2521
2522 switch (conn->type) {
2523 case ACL_LINK:
Andrei Emeltchenkobd1eb662012-10-10 17:38:30 +03002524 case AMP_LINK:
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002525 hdev->block_cnt += block_count;
2526 if (hdev->block_cnt > hdev->num_blocks)
2527 hdev->block_cnt = hdev->num_blocks;
2528 break;
2529
2530 default:
2531 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2532 break;
2533 }
2534 }
2535
2536 queue_work(hdev->workqueue, &hdev->tx_work);
2537}
2538
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002539static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002540{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002541 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002542 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002543
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002544 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002545
2546 hci_dev_lock(hdev);
2547
Marcel Holtmann04837f62006-07-03 10:02:33 +02002548 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2549 if (conn) {
2550 conn->mode = ev->mode;
2551 conn->interval = __le16_to_cpu(ev->interval);
2552
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002553 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2554 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02002555 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002556 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002557 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02002558 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002559 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002560
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002561 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002562 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002563 }
2564
2565 hci_dev_unlock(hdev);
2566}
2567
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002568static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002569{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002570 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2571 struct hci_conn *conn;
2572
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002573 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002574
2575 hci_dev_lock(hdev);
2576
2577 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002578 if (!conn)
2579 goto unlock;
2580
2581 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002582 hci_conn_hold(conn);
2583 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02002584 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002585 }
2586
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002587 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02002588 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002589 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002590 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002591 u8 secure;
2592
2593 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2594 secure = 1;
2595 else
2596 secure = 0;
2597
Johan Hedberg744cf192011-11-08 20:40:14 +02002598 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002599 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002600
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002601unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002602 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002603}
2604
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002605static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002606{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002607 struct hci_ev_link_key_req *ev = (void *) skb->data;
2608 struct hci_cp_link_key_reply cp;
2609 struct hci_conn *conn;
2610 struct link_key *key;
2611
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002612 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002613
Andrei Emeltchenko034cbea2013-05-14 11:44:16 +03002614 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002615 return;
2616
2617 hci_dev_lock(hdev);
2618
2619 key = hci_find_link_key(hdev, &ev->bdaddr);
2620 if (!key) {
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002621 BT_DBG("%s link key not found for %pMR", hdev->name,
2622 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002623 goto not_found;
2624 }
2625
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002626 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
2627 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002628
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002629 if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002630 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002631 BT_DBG("%s ignoring debug key", hdev->name);
2632 goto not_found;
2633 }
2634
2635 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002636 if (conn) {
2637 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002638 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002639 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2640 goto not_found;
2641 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002642
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002643 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002644 conn->pending_sec_level == BT_SECURITY_HIGH) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002645 BT_DBG("%s ignoring key unauthenticated for high security",
2646 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002647 goto not_found;
2648 }
2649
2650 conn->key_type = key->type;
2651 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002652 }
2653
2654 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03002655 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002656
2657 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2658
2659 hci_dev_unlock(hdev);
2660
2661 return;
2662
2663not_found:
2664 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2665 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002666}
2667
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002668static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002669{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002670 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2671 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002672 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002673
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);
2679 if (conn) {
2680 hci_conn_hold(conn);
2681 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002682 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002683
2684 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2685 conn->key_type = ev->key_type;
2686
David Herrmann76a68ba2013-04-06 20:28:37 +02002687 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002688 }
2689
Andrei Emeltchenko034cbea2013-05-14 11:44:16 +03002690 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002691 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002692 ev->key_type, pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02002693
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002694 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002695}
2696
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002697static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02002698{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002699 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002700 struct hci_conn *conn;
2701
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002702 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002703
2704 hci_dev_lock(hdev);
2705
2706 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002707 if (conn && !ev->status) {
2708 struct inquiry_entry *ie;
2709
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002710 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2711 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002712 ie->data.clock_offset = ev->clock_offset;
2713 ie->timestamp = jiffies;
2714 }
2715 }
2716
2717 hci_dev_unlock(hdev);
2718}
2719
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002720static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02002721{
2722 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2723 struct hci_conn *conn;
2724
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002725 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02002726
2727 hci_dev_lock(hdev);
2728
2729 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2730 if (conn && !ev->status)
2731 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2732
2733 hci_dev_unlock(hdev);
2734}
2735
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002736static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002737{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002738 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002739 struct inquiry_entry *ie;
2740
2741 BT_DBG("%s", hdev->name);
2742
2743 hci_dev_lock(hdev);
2744
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002745 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2746 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002747 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2748 ie->timestamp = jiffies;
2749 }
2750
2751 hci_dev_unlock(hdev);
2752}
2753
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002754static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
2755 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002756{
2757 struct inquiry_data data;
2758 int num_rsp = *((__u8 *) skb->data);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002759 bool name_known, ssp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002760
2761 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2762
2763 if (!num_rsp)
2764 return;
2765
Andre Guedes1519cc12012-03-21 00:03:38 -03002766 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2767 return;
2768
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002769 hci_dev_lock(hdev);
2770
2771 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002772 struct inquiry_info_with_rssi_and_pscan_mode *info;
2773 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002774
Johan Hedberge17acd42011-03-30 23:57:16 +03002775 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002776 bacpy(&data.bdaddr, &info->bdaddr);
2777 data.pscan_rep_mode = info->pscan_rep_mode;
2778 data.pscan_period_mode = info->pscan_period_mode;
2779 data.pscan_mode = info->pscan_mode;
2780 memcpy(data.dev_class, info->dev_class, 3);
2781 data.clock_offset = info->clock_offset;
2782 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002783 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002784
2785 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002786 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002787 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002788 info->dev_class, info->rssi,
2789 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002790 }
2791 } else {
2792 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2793
Johan Hedberge17acd42011-03-30 23:57:16 +03002794 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002795 bacpy(&data.bdaddr, &info->bdaddr);
2796 data.pscan_rep_mode = info->pscan_rep_mode;
2797 data.pscan_period_mode = info->pscan_period_mode;
2798 data.pscan_mode = 0x00;
2799 memcpy(data.dev_class, info->dev_class, 3);
2800 data.clock_offset = info->clock_offset;
2801 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002802 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002803 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002804 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002805 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002806 info->dev_class, info->rssi,
2807 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002808 }
2809 }
2810
2811 hci_dev_unlock(hdev);
2812}
2813
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002814static void hci_remote_ext_features_evt(struct hci_dev *hdev,
2815 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002816{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002817 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2818 struct hci_conn *conn;
2819
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002820 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002821
Marcel Holtmann41a96212008-07-14 20:13:48 +02002822 hci_dev_lock(hdev);
2823
2824 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002825 if (!conn)
2826 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002827
Johan Hedbergcad718e2013-04-17 15:00:51 +03002828 if (ev->page < HCI_MAX_PAGES)
2829 memcpy(conn->features[ev->page], ev->features, 8);
2830
Johan Hedbergccd556f2010-11-10 17:11:51 +02002831 if (!ev->status && ev->page == 0x01) {
2832 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002833
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002834 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2835 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02002836 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02002837
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05302838 if (ev->features[0] & LMP_HOST_SSP) {
Johan Hedberg58a681e2012-01-16 06:47:28 +02002839 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05302840 } else {
2841 /* It is mandatory by the Bluetooth specification that
2842 * Extended Inquiry Results are only used when Secure
2843 * Simple Pairing is enabled, but some devices violate
2844 * this.
2845 *
2846 * To make these devices work, the internal SSP
2847 * enabled flag needs to be cleared if the remote host
2848 * features do not indicate SSP support */
2849 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
2850 }
Marcel Holtmann41a96212008-07-14 20:13:48 +02002851 }
2852
Johan Hedbergccd556f2010-11-10 17:11:51 +02002853 if (conn->state != BT_CONFIG)
2854 goto unlock;
2855
Johan Hedberg671267b2012-05-12 16:11:50 -03002856 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002857 struct hci_cp_remote_name_req cp;
2858 memset(&cp, 0, sizeof(cp));
2859 bacpy(&cp.bdaddr, &conn->dst);
2860 cp.pscan_rep_mode = 0x02;
2861 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002862 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2863 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002864 conn->dst_type, 0, NULL, 0,
2865 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002866
Johan Hedberg127178d2010-11-18 22:22:29 +02002867 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002868 conn->state = BT_CONNECTED;
2869 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002870 hci_conn_drop(conn);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002871 }
2872
2873unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002874 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002875}
2876
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002877static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
2878 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002879{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002880 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2881 struct hci_conn *conn;
2882
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002883 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002884
2885 hci_dev_lock(hdev);
2886
2887 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002888 if (!conn) {
2889 if (ev->link_type == ESCO_LINK)
2890 goto unlock;
2891
2892 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2893 if (!conn)
2894 goto unlock;
2895
2896 conn->type = SCO_LINK;
2897 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002898
Marcel Holtmann732547f2009-04-19 19:14:14 +02002899 switch (ev->status) {
2900 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002901 conn->handle = __le16_to_cpu(ev->handle);
2902 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002903
2904 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002905 break;
2906
Frédéric Dalleau1a4c9582013-08-19 14:24:02 +02002907 case 0x0d: /* Connection Rejected due to Limited Resources */
Stephen Coe705e5712010-02-16 11:29:44 -05002908 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002909 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002910 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002911 case 0x1f: /* Unspecified error */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02002912 if (conn->out) {
Marcel Holtmann732547f2009-04-19 19:14:14 +02002913 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2914 (hdev->esco_type & EDR_ESCO_MASK);
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02002915 if (hci_setup_sync(conn, conn->link->handle))
2916 goto unlock;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002917 }
2918 /* fall through */
2919
2920 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002921 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002922 break;
2923 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002924
2925 hci_proto_connect_cfm(conn, ev->status);
2926 if (ev->status)
2927 hci_conn_del(conn);
2928
2929unlock:
2930 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002931}
2932
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002933static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
2934 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002935{
2936 struct inquiry_data data;
2937 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2938 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05302939 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002940
2941 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2942
2943 if (!num_rsp)
2944 return;
2945
Andre Guedes1519cc12012-03-21 00:03:38 -03002946 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2947 return;
2948
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002949 hci_dev_lock(hdev);
2950
Johan Hedberge17acd42011-03-30 23:57:16 +03002951 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002952 bool name_known, ssp;
Johan Hedberg561aafb2012-01-04 13:31:59 +02002953
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002954 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002955 data.pscan_rep_mode = info->pscan_rep_mode;
2956 data.pscan_period_mode = info->pscan_period_mode;
2957 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002958 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002959 data.clock_offset = info->clock_offset;
2960 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002961 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02002962
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002963 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02002964 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002965 sizeof(info->data),
2966 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02002967 else
2968 name_known = true;
2969
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002970 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002971 &ssp);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05302972 eir_len = eir_get_length(info->data, sizeof(info->data));
Johan Hedberg48264f02011-11-09 13:58:58 +02002973 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002974 info->dev_class, info->rssi, !name_known,
Vishal Agarwal9d939d92012-04-26 19:19:56 +05302975 ssp, info->data, eir_len);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002976 }
2977
2978 hci_dev_unlock(hdev);
2979}
2980
Johan Hedberg1c2e0042012-06-08 23:31:13 +08002981static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
2982 struct sk_buff *skb)
2983{
2984 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
2985 struct hci_conn *conn;
2986
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002987 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08002988 __le16_to_cpu(ev->handle));
2989
2990 hci_dev_lock(hdev);
2991
2992 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2993 if (!conn)
2994 goto unlock;
2995
2996 if (!ev->status)
2997 conn->sec_level = conn->pending_sec_level;
2998
2999 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3000
3001 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03003002 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02003003 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003004 goto unlock;
3005 }
3006
3007 if (conn->state == BT_CONFIG) {
3008 if (!ev->status)
3009 conn->state = BT_CONNECTED;
3010
3011 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003012 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003013 } else {
3014 hci_auth_cfm(conn, ev->status);
3015
3016 hci_conn_hold(conn);
3017 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003018 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003019 }
3020
3021unlock:
3022 hci_dev_unlock(hdev);
3023}
3024
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003025static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003026{
3027 /* If remote requests dedicated bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02003028 if (conn->remote_auth == HCI_AT_DEDICATED_BONDING ||
3029 conn->remote_auth == HCI_AT_DEDICATED_BONDING_MITM) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003030 /* If both remote and local IO capabilities allow MITM
3031 * protection then require it, otherwise don't */
Mikel Astizacabae92013-06-28 10:56:28 +02003032 if (conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT ||
3033 conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)
3034 return HCI_AT_DEDICATED_BONDING;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003035 else
Mikel Astizacabae92013-06-28 10:56:28 +02003036 return HCI_AT_DEDICATED_BONDING_MITM;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003037 }
3038
3039 /* If remote requests no-bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02003040 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3041 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003042 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003043
3044 return conn->auth_type;
3045}
3046
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003047static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003048{
3049 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3050 struct hci_conn *conn;
3051
3052 BT_DBG("%s", hdev->name);
3053
3054 hci_dev_lock(hdev);
3055
3056 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003057 if (!conn)
3058 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003059
Johan Hedberg03b555e2011-01-04 15:40:05 +02003060 hci_conn_hold(conn);
3061
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003062 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003063 goto unlock;
3064
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003065 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003066 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003067 struct hci_cp_io_capability_reply cp;
3068
3069 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303070 /* Change the IO capability from KeyboardDisplay
3071 * to DisplayYesNo as it is not supported by BT spec. */
3072 cp.capability = (conn->io_capability == 0x04) ?
Mikel Astiza7676312013-06-28 10:56:29 +02003073 HCI_IO_DISPLAY_YESNO : conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07003074 conn->auth_type = hci_get_auth_req(conn);
3075 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003076
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003077 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3078 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
Szymon Jancce85ee12011-03-22 13:12:23 +01003079 cp.oob_data = 0x01;
3080 else
3081 cp.oob_data = 0x00;
3082
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003083 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003084 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003085 } else {
3086 struct hci_cp_io_capability_neg_reply cp;
3087
3088 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02003089 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003090
3091 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003092 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003093 }
3094
3095unlock:
3096 hci_dev_unlock(hdev);
3097}
3098
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003099static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02003100{
3101 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3102 struct hci_conn *conn;
3103
3104 BT_DBG("%s", hdev->name);
3105
3106 hci_dev_lock(hdev);
3107
3108 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3109 if (!conn)
3110 goto unlock;
3111
Johan Hedberg03b555e2011-01-04 15:40:05 +02003112 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003113 conn->remote_auth = ev->authentication;
Johan Hedberg58a681e2012-01-16 06:47:28 +02003114 if (ev->oob_data)
3115 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003116
3117unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003118 hci_dev_unlock(hdev);
3119}
3120
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003121static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3122 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003123{
3124 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003125 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07003126 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03003127
3128 BT_DBG("%s", hdev->name);
3129
3130 hci_dev_lock(hdev);
3131
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003132 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg7a828902011-04-28 11:28:53 -07003133 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03003134
Johan Hedberg7a828902011-04-28 11:28:53 -07003135 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3136 if (!conn)
3137 goto unlock;
3138
3139 loc_mitm = (conn->auth_type & 0x01);
3140 rem_mitm = (conn->remote_auth & 0x01);
3141
3142 /* If we require MITM but the remote device can't provide that
3143 * (it has NoInputNoOutput) then reject the confirmation
3144 * request. The only exception is when we're dedicated bonding
3145 * initiators (connect_cfm_cb set) since then we always have the MITM
3146 * bit set. */
Mikel Astiza7676312013-06-28 10:56:29 +02003147 if (!conn->connect_cfm_cb && loc_mitm &&
3148 conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
Johan Hedberg7a828902011-04-28 11:28:53 -07003149 BT_DBG("Rejecting request: remote device can't provide MITM");
3150 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003151 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003152 goto unlock;
3153 }
3154
3155 /* If no side requires MITM protection; auto-accept */
Mikel Astiza7676312013-06-28 10:56:29 +02003156 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
3157 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003158
3159 /* If we're not the initiators request authorization to
3160 * proceed from user space (mgmt_user_confirm with
3161 * confirm_hint set to 1). */
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003162 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003163 BT_DBG("Confirming auto-accept as acceptor");
3164 confirm_hint = 1;
3165 goto confirm;
3166 }
3167
Johan Hedberg9f616562011-04-28 11:28:54 -07003168 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03003169 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003170
3171 if (hdev->auto_accept_delay > 0) {
3172 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
3173 mod_timer(&conn->auto_accept_timer, jiffies + delay);
3174 goto unlock;
3175 }
3176
Johan Hedberg7a828902011-04-28 11:28:53 -07003177 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003178 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003179 goto unlock;
3180 }
3181
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003182confirm:
Johan Hedberg272d90d2012-02-09 15:26:12 +02003183 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0, ev->passkey,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003184 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07003185
3186unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03003187 hci_dev_unlock(hdev);
3188}
3189
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003190static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3191 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08003192{
3193 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3194
3195 BT_DBG("%s", hdev->name);
3196
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003197 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02003198 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08003199}
3200
Johan Hedberg92a25252012-09-06 18:39:26 +03003201static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3202 struct sk_buff *skb)
3203{
3204 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3205 struct hci_conn *conn;
3206
3207 BT_DBG("%s", hdev->name);
3208
3209 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3210 if (!conn)
3211 return;
3212
3213 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3214 conn->passkey_entered = 0;
3215
3216 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3217 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3218 conn->dst_type, conn->passkey_notify,
3219 conn->passkey_entered);
3220}
3221
3222static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3223{
3224 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3225 struct hci_conn *conn;
3226
3227 BT_DBG("%s", hdev->name);
3228
3229 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3230 if (!conn)
3231 return;
3232
3233 switch (ev->type) {
3234 case HCI_KEYPRESS_STARTED:
3235 conn->passkey_entered = 0;
3236 return;
3237
3238 case HCI_KEYPRESS_ENTERED:
3239 conn->passkey_entered++;
3240 break;
3241
3242 case HCI_KEYPRESS_ERASED:
3243 conn->passkey_entered--;
3244 break;
3245
3246 case HCI_KEYPRESS_CLEARED:
3247 conn->passkey_entered = 0;
3248 break;
3249
3250 case HCI_KEYPRESS_COMPLETED:
3251 return;
3252 }
3253
3254 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3255 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3256 conn->dst_type, conn->passkey_notify,
3257 conn->passkey_entered);
3258}
3259
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003260static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3261 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003262{
3263 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3264 struct hci_conn *conn;
3265
3266 BT_DBG("%s", hdev->name);
3267
3268 hci_dev_lock(hdev);
3269
3270 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003271 if (!conn)
3272 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003273
Johan Hedberg2a611692011-02-19 12:06:00 -03003274 /* To avoid duplicate auth_failed events to user space we check
3275 * the HCI_CONN_AUTH_PEND flag which will be set if we
3276 * initiated the authentication. A traditional auth_complete
3277 * event gets always produced as initiator and is also mapped to
3278 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02003279 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003280 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003281 ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003282
David Herrmann76a68ba2013-04-06 20:28:37 +02003283 hci_conn_drop(conn);
Johan Hedberg2a611692011-02-19 12:06:00 -03003284
3285unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003286 hci_dev_unlock(hdev);
3287}
3288
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003289static void hci_remote_host_features_evt(struct hci_dev *hdev,
3290 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003291{
3292 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3293 struct inquiry_entry *ie;
Johan Hedbergcad718e2013-04-17 15:00:51 +03003294 struct hci_conn *conn;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003295
3296 BT_DBG("%s", hdev->name);
3297
3298 hci_dev_lock(hdev);
3299
Johan Hedbergcad718e2013-04-17 15:00:51 +03003300 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3301 if (conn)
3302 memcpy(conn->features[1], ev->features, 8);
3303
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003304 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3305 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003306 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003307
3308 hci_dev_unlock(hdev);
3309}
3310
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003311static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3312 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01003313{
3314 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3315 struct oob_data *data;
3316
3317 BT_DBG("%s", hdev->name);
3318
3319 hci_dev_lock(hdev);
3320
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003321 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Szymon Jance1ba1f12011-04-06 13:01:59 +02003322 goto unlock;
3323
Szymon Janc2763eda2011-03-22 13:12:22 +01003324 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3325 if (data) {
3326 struct hci_cp_remote_oob_data_reply cp;
3327
3328 bacpy(&cp.bdaddr, &ev->bdaddr);
3329 memcpy(cp.hash, data->hash, sizeof(cp.hash));
3330 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
3331
3332 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003333 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003334 } else {
3335 struct hci_cp_remote_oob_data_neg_reply cp;
3336
3337 bacpy(&cp.bdaddr, &ev->bdaddr);
3338 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003339 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003340 }
3341
Szymon Jance1ba1f12011-04-06 13:01:59 +02003342unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003343 hci_dev_unlock(hdev);
3344}
3345
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003346static void hci_phy_link_complete_evt(struct hci_dev *hdev,
3347 struct sk_buff *skb)
3348{
3349 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
3350 struct hci_conn *hcon, *bredr_hcon;
3351
3352 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
3353 ev->status);
3354
3355 hci_dev_lock(hdev);
3356
3357 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3358 if (!hcon) {
3359 hci_dev_unlock(hdev);
3360 return;
3361 }
3362
3363 if (ev->status) {
3364 hci_conn_del(hcon);
3365 hci_dev_unlock(hdev);
3366 return;
3367 }
3368
3369 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
3370
3371 hcon->state = BT_CONNECTED;
3372 bacpy(&hcon->dst, &bredr_hcon->dst);
3373
3374 hci_conn_hold(hcon);
3375 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003376 hci_conn_drop(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003377
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003378 hci_conn_add_sysfs(hcon);
3379
Andrei Emeltchenkocf70ff22012-10-31 15:46:36 +02003380 amp_physical_cfm(bredr_hcon, hcon);
3381
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003382 hci_dev_unlock(hdev);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003383}
3384
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003385static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3386{
3387 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
3388 struct hci_conn *hcon;
3389 struct hci_chan *hchan;
3390 struct amp_mgr *mgr;
3391
3392 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
3393 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
3394 ev->status);
3395
3396 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3397 if (!hcon)
3398 return;
3399
3400 /* Create AMP hchan */
3401 hchan = hci_chan_create(hcon);
3402 if (!hchan)
3403 return;
3404
3405 hchan->handle = le16_to_cpu(ev->handle);
3406
3407 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
3408
3409 mgr = hcon->amp_mgr;
3410 if (mgr && mgr->bredr_chan) {
3411 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
3412
3413 l2cap_chan_lock(bredr_chan);
3414
3415 bredr_chan->conn->mtu = hdev->block_mtu;
3416 l2cap_logical_cfm(bredr_chan, hchan, 0);
3417 hci_conn_hold(hcon);
3418
3419 l2cap_chan_unlock(bredr_chan);
3420 }
3421}
3422
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003423static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
3424 struct sk_buff *skb)
3425{
3426 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
3427 struct hci_chan *hchan;
3428
3429 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
3430 le16_to_cpu(ev->handle), ev->status);
3431
3432 if (ev->status)
3433 return;
3434
3435 hci_dev_lock(hdev);
3436
3437 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
3438 if (!hchan)
3439 goto unlock;
3440
3441 amp_destroy_logical_link(hchan, ev->reason);
3442
3443unlock:
3444 hci_dev_unlock(hdev);
3445}
3446
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003447static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
3448 struct sk_buff *skb)
3449{
3450 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
3451 struct hci_conn *hcon;
3452
3453 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3454
3455 if (ev->status)
3456 return;
3457
3458 hci_dev_lock(hdev);
3459
3460 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3461 if (hcon) {
3462 hcon->state = BT_CLOSED;
3463 hci_conn_del(hcon);
3464 }
3465
3466 hci_dev_unlock(hdev);
3467}
3468
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003469static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003470{
3471 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3472 struct hci_conn *conn;
3473
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003474 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003475
3476 hci_dev_lock(hdev);
3477
Andre Guedesb47a09b2012-07-27 15:10:15 -03003478 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03003479 if (!conn) {
3480 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
3481 if (!conn) {
3482 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03003483 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03003484 }
Andre Guedes29b79882011-05-31 14:20:54 -03003485
3486 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03003487
3488 if (ev->role == LE_CONN_ROLE_MASTER) {
3489 conn->out = true;
3490 conn->link_mode |= HCI_LM_MASTER;
3491 }
Ville Tervob62f3282011-02-10 22:38:50 -03003492 }
Ville Tervofcd89c02011-02-10 22:38:47 -03003493
Andre Guedescd17dec2012-07-27 15:10:16 -03003494 if (ev->status) {
3495 mgmt_connect_failed(hdev, &conn->dst, conn->type,
3496 conn->dst_type, ev->status);
3497 hci_proto_connect_cfm(conn, ev->status);
3498 conn->state = BT_CLOSED;
3499 hci_conn_del(conn);
3500 goto unlock;
3501 }
3502
Johan Hedbergb644ba32012-01-17 21:48:47 +02003503 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3504 mgmt_device_connected(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003505 conn->dst_type, 0, NULL, 0, NULL);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03003506
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03003507 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03003508 conn->handle = __le16_to_cpu(ev->handle);
3509 conn->state = BT_CONNECTED;
3510
Ville Tervofcd89c02011-02-10 22:38:47 -03003511 hci_conn_add_sysfs(conn);
3512
3513 hci_proto_connect_cfm(conn, ev->status);
3514
3515unlock:
3516 hci_dev_unlock(hdev);
3517}
3518
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003519static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03003520{
Andre Guedese95beb42011-09-26 20:48:35 -03003521 u8 num_reports = skb->data[0];
3522 void *ptr = &skb->data[1];
Andre Guedes3c9e9192012-01-10 18:20:50 -03003523 s8 rssi;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003524
Andre Guedese95beb42011-09-26 20:48:35 -03003525 while (num_reports--) {
3526 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003527
Andre Guedes3c9e9192012-01-10 18:20:50 -03003528 rssi = ev->data[ev->length];
3529 mgmt_device_found(hdev, &ev->bdaddr, LE_LINK, ev->bdaddr_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003530 NULL, rssi, 0, 1, ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03003531
Andre Guedese95beb42011-09-26 20:48:35 -03003532 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003533 }
Andre Guedes9aa04c92011-05-26 16:23:51 -03003534}
3535
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003536static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003537{
3538 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
3539 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003540 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003541 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003542 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003543
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003544 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003545
3546 hci_dev_lock(hdev);
3547
3548 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003549 if (conn == NULL)
3550 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003551
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003552 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
3553 if (ltk == NULL)
3554 goto not_found;
3555
3556 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003557 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003558
3559 if (ltk->authenticated)
3560 conn->sec_level = BT_SECURITY_HIGH;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003561
3562 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
3563
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003564 if (ltk->type & HCI_SMP_STK) {
3565 list_del(&ltk->list);
3566 kfree(ltk);
3567 }
3568
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003569 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003570
3571 return;
3572
3573not_found:
3574 neg.handle = ev->handle;
3575 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
3576 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003577}
3578
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003579static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003580{
3581 struct hci_ev_le_meta *le_ev = (void *) skb->data;
3582
3583 skb_pull(skb, sizeof(*le_ev));
3584
3585 switch (le_ev->subevent) {
3586 case HCI_EV_LE_CONN_COMPLETE:
3587 hci_le_conn_complete_evt(hdev, skb);
3588 break;
3589
Andre Guedes9aa04c92011-05-26 16:23:51 -03003590 case HCI_EV_LE_ADVERTISING_REPORT:
3591 hci_le_adv_report_evt(hdev, skb);
3592 break;
3593
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003594 case HCI_EV_LE_LTK_REQ:
3595 hci_le_ltk_request_evt(hdev, skb);
3596 break;
3597
Ville Tervofcd89c02011-02-10 22:38:47 -03003598 default:
3599 break;
3600 }
3601}
3602
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03003603static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
3604{
3605 struct hci_ev_channel_selected *ev = (void *) skb->data;
3606 struct hci_conn *hcon;
3607
3608 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
3609
3610 skb_pull(skb, sizeof(*ev));
3611
3612 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3613 if (!hcon)
3614 return;
3615
3616 amp_read_loc_assoc_final_data(hdev, hcon);
3617}
3618
Linus Torvalds1da177e2005-04-16 15:20:36 -07003619void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
3620{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003621 struct hci_event_hdr *hdr = (void *) skb->data;
3622 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003623
Johan Hedbergb6ddb632013-04-02 13:34:31 +03003624 hci_dev_lock(hdev);
3625
3626 /* Received events are (currently) only needed when a request is
3627 * ongoing so avoid unnecessary memory allocation.
3628 */
3629 if (hdev->req_status == HCI_REQ_PEND) {
3630 kfree_skb(hdev->recv_evt);
3631 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
3632 }
3633
3634 hci_dev_unlock(hdev);
3635
Linus Torvalds1da177e2005-04-16 15:20:36 -07003636 skb_pull(skb, HCI_EVENT_HDR_SIZE);
3637
Johan Hedberg02350a72013-04-03 21:50:29 +03003638 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
3639 struct hci_command_hdr *hdr = (void *) hdev->sent_cmd->data;
3640 u16 opcode = __le16_to_cpu(hdr->opcode);
3641
3642 hci_req_cmd_complete(hdev, opcode, 0);
3643 }
3644
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003645 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003646 case HCI_EV_INQUIRY_COMPLETE:
3647 hci_inquiry_complete_evt(hdev, skb);
3648 break;
3649
3650 case HCI_EV_INQUIRY_RESULT:
3651 hci_inquiry_result_evt(hdev, skb);
3652 break;
3653
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003654 case HCI_EV_CONN_COMPLETE:
3655 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02003656 break;
3657
Linus Torvalds1da177e2005-04-16 15:20:36 -07003658 case HCI_EV_CONN_REQUEST:
3659 hci_conn_request_evt(hdev, skb);
3660 break;
3661
Linus Torvalds1da177e2005-04-16 15:20:36 -07003662 case HCI_EV_DISCONN_COMPLETE:
3663 hci_disconn_complete_evt(hdev, skb);
3664 break;
3665
Linus Torvalds1da177e2005-04-16 15:20:36 -07003666 case HCI_EV_AUTH_COMPLETE:
3667 hci_auth_complete_evt(hdev, skb);
3668 break;
3669
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003670 case HCI_EV_REMOTE_NAME:
3671 hci_remote_name_evt(hdev, skb);
3672 break;
3673
Linus Torvalds1da177e2005-04-16 15:20:36 -07003674 case HCI_EV_ENCRYPT_CHANGE:
3675 hci_encrypt_change_evt(hdev, skb);
3676 break;
3677
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003678 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3679 hci_change_link_key_complete_evt(hdev, skb);
3680 break;
3681
3682 case HCI_EV_REMOTE_FEATURES:
3683 hci_remote_features_evt(hdev, skb);
3684 break;
3685
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003686 case HCI_EV_CMD_COMPLETE:
3687 hci_cmd_complete_evt(hdev, skb);
3688 break;
3689
3690 case HCI_EV_CMD_STATUS:
3691 hci_cmd_status_evt(hdev, skb);
3692 break;
3693
3694 case HCI_EV_ROLE_CHANGE:
3695 hci_role_change_evt(hdev, skb);
3696 break;
3697
3698 case HCI_EV_NUM_COMP_PKTS:
3699 hci_num_comp_pkts_evt(hdev, skb);
3700 break;
3701
3702 case HCI_EV_MODE_CHANGE:
3703 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003704 break;
3705
3706 case HCI_EV_PIN_CODE_REQ:
3707 hci_pin_code_request_evt(hdev, skb);
3708 break;
3709
3710 case HCI_EV_LINK_KEY_REQ:
3711 hci_link_key_request_evt(hdev, skb);
3712 break;
3713
3714 case HCI_EV_LINK_KEY_NOTIFY:
3715 hci_link_key_notify_evt(hdev, skb);
3716 break;
3717
3718 case HCI_EV_CLOCK_OFFSET:
3719 hci_clock_offset_evt(hdev, skb);
3720 break;
3721
Marcel Holtmanna8746412008-07-14 20:13:46 +02003722 case HCI_EV_PKT_TYPE_CHANGE:
3723 hci_pkt_type_change_evt(hdev, skb);
3724 break;
3725
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003726 case HCI_EV_PSCAN_REP_MODE:
3727 hci_pscan_rep_mode_evt(hdev, skb);
3728 break;
3729
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003730 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3731 hci_inquiry_result_with_rssi_evt(hdev, skb);
3732 break;
3733
3734 case HCI_EV_REMOTE_EXT_FEATURES:
3735 hci_remote_ext_features_evt(hdev, skb);
3736 break;
3737
3738 case HCI_EV_SYNC_CONN_COMPLETE:
3739 hci_sync_conn_complete_evt(hdev, skb);
3740 break;
3741
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003742 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3743 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003744 break;
3745
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003746 case HCI_EV_KEY_REFRESH_COMPLETE:
3747 hci_key_refresh_complete_evt(hdev, skb);
3748 break;
3749
Marcel Holtmann04936842008-07-14 20:13:48 +02003750 case HCI_EV_IO_CAPA_REQUEST:
3751 hci_io_capa_request_evt(hdev, skb);
3752 break;
3753
Johan Hedberg03b555e2011-01-04 15:40:05 +02003754 case HCI_EV_IO_CAPA_REPLY:
3755 hci_io_capa_reply_evt(hdev, skb);
3756 break;
3757
Johan Hedberga5c29682011-02-19 12:05:57 -03003758 case HCI_EV_USER_CONFIRM_REQUEST:
3759 hci_user_confirm_request_evt(hdev, skb);
3760 break;
3761
Brian Gix1143d452011-11-23 08:28:34 -08003762 case HCI_EV_USER_PASSKEY_REQUEST:
3763 hci_user_passkey_request_evt(hdev, skb);
3764 break;
3765
Johan Hedberg92a25252012-09-06 18:39:26 +03003766 case HCI_EV_USER_PASSKEY_NOTIFY:
3767 hci_user_passkey_notify_evt(hdev, skb);
3768 break;
3769
3770 case HCI_EV_KEYPRESS_NOTIFY:
3771 hci_keypress_notify_evt(hdev, skb);
3772 break;
3773
Marcel Holtmann04936842008-07-14 20:13:48 +02003774 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3775 hci_simple_pair_complete_evt(hdev, skb);
3776 break;
3777
Marcel Holtmann41a96212008-07-14 20:13:48 +02003778 case HCI_EV_REMOTE_HOST_FEATURES:
3779 hci_remote_host_features_evt(hdev, skb);
3780 break;
3781
Ville Tervofcd89c02011-02-10 22:38:47 -03003782 case HCI_EV_LE_META:
3783 hci_le_meta_evt(hdev, skb);
3784 break;
3785
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03003786 case HCI_EV_CHANNEL_SELECTED:
3787 hci_chan_selected_evt(hdev, skb);
3788 break;
3789
Szymon Janc2763eda2011-03-22 13:12:22 +01003790 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3791 hci_remote_oob_data_request_evt(hdev, skb);
3792 break;
3793
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003794 case HCI_EV_PHY_LINK_COMPLETE:
3795 hci_phy_link_complete_evt(hdev, skb);
3796 break;
3797
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003798 case HCI_EV_LOGICAL_LINK_COMPLETE:
3799 hci_loglink_complete_evt(hdev, skb);
3800 break;
3801
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003802 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
3803 hci_disconn_loglink_complete_evt(hdev, skb);
3804 break;
3805
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003806 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
3807 hci_disconn_phylink_complete_evt(hdev, skb);
3808 break;
3809
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003810 case HCI_EV_NUM_COMP_BLOCKS:
3811 hci_num_comp_blocks_evt(hdev, skb);
3812 break;
3813
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003814 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003815 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003816 break;
3817 }
3818
3819 kfree_skb(skb);
3820 hdev->stat.evt_rx++;
3821}