blob: 48db81f8a3379b509fd1175521fc84a9186ba7a6 [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 Padovan6039aa72012-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) {
Johan Hedberg416a4ae2013-09-25 13:26:08 +0300997 if (sent->le) {
Johan Hedbergcad718e2013-04-17 15:00:51 +0300998 hdev->features[1][0] |= LMP_HOST_LE;
Johan Hedberg416a4ae2013-09-25 13:26:08 +0300999 set_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1000 } else {
Johan Hedbergcad718e2013-04-17 15:00:51 +03001001 hdev->features[1][0] &= ~LMP_HOST_LE;
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001002 clear_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1003 }
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001004
1005 if (sent->simul)
Johan Hedbergcad718e2013-04-17 15:00:51 +03001006 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001007 else
Johan Hedbergcad718e2013-04-17 15:00:51 +03001008 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
Johan Hedberg8f984df2012-02-28 01:07:22 +02001009 }
Andre Guedesf9b49302011-06-30 19:20:53 -03001010}
1011
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001012static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1013 struct sk_buff *skb)
1014{
1015 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1016
1017 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1018 hdev->name, rp->status, rp->phy_handle);
1019
1020 if (rp->status)
1021 return;
1022
1023 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1024}
1025
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001026static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001027{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001028 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001029
1030 if (status) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001031 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001032 return;
1033 }
1034
Andre Guedes89352e72011-11-04 14:16:53 -03001035 set_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001036}
1037
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001038static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001040 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001041 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001042
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001043 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001044
1045 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001046 if (!cp)
1047 return;
1048
1049 hci_dev_lock(hdev);
1050
1051 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1052
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001053 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001054
1055 if (status) {
1056 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001057 if (status != 0x0c || conn->attempt > 2) {
1058 conn->state = BT_CLOSED;
1059 hci_proto_connect_cfm(conn, status);
1060 hci_conn_del(conn);
1061 } else
1062 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001063 }
1064 } else {
1065 if (!conn) {
1066 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1067 if (conn) {
Johan Hedberga0c808b2012-01-16 09:49:58 +02001068 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001069 conn->link_mode |= HCI_LM_MASTER;
1070 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001071 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001072 }
1073 }
1074
1075 hci_dev_unlock(hdev);
1076}
1077
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001078static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001079{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001080 struct hci_cp_add_sco *cp;
1081 struct hci_conn *acl, *sco;
1082 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001083
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001084 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001085
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001086 if (!status)
1087 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001089 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1090 if (!cp)
1091 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001092
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001093 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001094
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001095 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001096
1097 hci_dev_lock(hdev);
1098
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001099 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001100 if (acl) {
1101 sco = acl->link;
1102 if (sco) {
1103 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001104
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001105 hci_proto_connect_cfm(sco, status);
1106 hci_conn_del(sco);
1107 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001108 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001109
1110 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111}
1112
Marcel Holtmannf8558552008-07-14 20:13:49 +02001113static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1114{
1115 struct hci_cp_auth_requested *cp;
1116 struct hci_conn *conn;
1117
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001118 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001119
1120 if (!status)
1121 return;
1122
1123 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1124 if (!cp)
1125 return;
1126
1127 hci_dev_lock(hdev);
1128
1129 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1130 if (conn) {
1131 if (conn->state == BT_CONFIG) {
1132 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001133 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001134 }
1135 }
1136
1137 hci_dev_unlock(hdev);
1138}
1139
1140static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1141{
1142 struct hci_cp_set_conn_encrypt *cp;
1143 struct hci_conn *conn;
1144
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001145 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001146
1147 if (!status)
1148 return;
1149
1150 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1151 if (!cp)
1152 return;
1153
1154 hci_dev_lock(hdev);
1155
1156 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1157 if (conn) {
1158 if (conn->state == BT_CONFIG) {
1159 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001160 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001161 }
1162 }
1163
1164 hci_dev_unlock(hdev);
1165}
1166
Johan Hedberg127178d2010-11-18 22:22:29 +02001167static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001168 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001169{
Johan Hedberg392599b2010-11-18 22:22:28 +02001170 if (conn->state != BT_CONFIG || !conn->out)
1171 return 0;
1172
Johan Hedberg765c2a92011-01-19 12:06:52 +05301173 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001174 return 0;
1175
1176 /* Only request authentication for SSP connections or non-SSP
Vinicius Costa Gomese9bf2bf2011-09-02 14:51:20 -03001177 * devices with sec_level HIGH or if MITM protection is requested */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001178 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
1179 conn->pending_sec_level != BT_SECURITY_HIGH)
Johan Hedberg392599b2010-11-18 22:22:28 +02001180 return 0;
1181
Johan Hedberg392599b2010-11-18 22:22:28 +02001182 return 1;
1183}
1184
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001185static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001186 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001187{
1188 struct hci_cp_remote_name_req cp;
1189
1190 memset(&cp, 0, sizeof(cp));
1191
1192 bacpy(&cp.bdaddr, &e->data.bdaddr);
1193 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1194 cp.pscan_mode = e->data.pscan_mode;
1195 cp.clock_offset = e->data.clock_offset;
1196
1197 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1198}
1199
Johan Hedbergb644ba32012-01-17 21:48:47 +02001200static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001201{
1202 struct discovery_state *discov = &hdev->discovery;
1203 struct inquiry_entry *e;
1204
Johan Hedbergb644ba32012-01-17 21:48:47 +02001205 if (list_empty(&discov->resolve))
1206 return false;
1207
1208 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001209 if (!e)
1210 return false;
1211
Johan Hedbergb644ba32012-01-17 21:48:47 +02001212 if (hci_resolve_name(hdev, e) == 0) {
1213 e->name_state = NAME_PENDING;
1214 return true;
1215 }
1216
1217 return false;
1218}
1219
1220static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001221 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001222{
1223 struct discovery_state *discov = &hdev->discovery;
1224 struct inquiry_entry *e;
1225
1226 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001227 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1228 name_len, conn->dev_class);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001229
1230 if (discov->state == DISCOVERY_STOPPED)
1231 return;
1232
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001233 if (discov->state == DISCOVERY_STOPPING)
1234 goto discov_complete;
1235
1236 if (discov->state != DISCOVERY_RESOLVING)
1237 return;
1238
1239 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001240 /* If the device was not found in a list of found devices names of which
1241 * are pending. there is no need to continue resolving a next name as it
1242 * will be done upon receiving another Remote Name Request Complete
1243 * Event */
1244 if (!e)
1245 return;
1246
1247 list_del(&e->list);
1248 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001249 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001250 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1251 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001252 } else {
1253 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001254 }
1255
Johan Hedbergb644ba32012-01-17 21:48:47 +02001256 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001257 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001258
1259discov_complete:
1260 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1261}
1262
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001263static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1264{
Johan Hedberg127178d2010-11-18 22:22:29 +02001265 struct hci_cp_remote_name_req *cp;
1266 struct hci_conn *conn;
1267
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001268 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001269
1270 /* If successful wait for the name req complete event before
1271 * checking for the need to do authentication */
1272 if (!status)
1273 return;
1274
1275 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1276 if (!cp)
1277 return;
1278
1279 hci_dev_lock(hdev);
1280
1281 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001282
1283 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1284 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1285
Johan Hedberg79c6c702011-04-28 11:28:55 -07001286 if (!conn)
1287 goto unlock;
1288
1289 if (!hci_outgoing_auth_needed(hdev, conn))
1290 goto unlock;
1291
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001292 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001293 struct hci_cp_auth_requested cp;
1294 cp.handle = __cpu_to_le16(conn->handle);
1295 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1296 }
1297
Johan Hedberg79c6c702011-04-28 11:28:55 -07001298unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001299 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001300}
1301
Marcel Holtmann769be972008-07-14 20:13:49 +02001302static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1303{
1304 struct hci_cp_read_remote_features *cp;
1305 struct hci_conn *conn;
1306
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001307 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001308
1309 if (!status)
1310 return;
1311
1312 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1313 if (!cp)
1314 return;
1315
1316 hci_dev_lock(hdev);
1317
1318 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1319 if (conn) {
1320 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001321 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001322 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001323 }
1324 }
1325
1326 hci_dev_unlock(hdev);
1327}
1328
1329static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1330{
1331 struct hci_cp_read_remote_ext_features *cp;
1332 struct hci_conn *conn;
1333
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001334 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001335
1336 if (!status)
1337 return;
1338
1339 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1340 if (!cp)
1341 return;
1342
1343 hci_dev_lock(hdev);
1344
1345 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1346 if (conn) {
1347 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001348 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001349 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001350 }
1351 }
1352
1353 hci_dev_unlock(hdev);
1354}
1355
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001356static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1357{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001358 struct hci_cp_setup_sync_conn *cp;
1359 struct hci_conn *acl, *sco;
1360 __u16 handle;
1361
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001362 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001363
1364 if (!status)
1365 return;
1366
1367 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1368 if (!cp)
1369 return;
1370
1371 handle = __le16_to_cpu(cp->handle);
1372
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001373 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001374
1375 hci_dev_lock(hdev);
1376
1377 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001378 if (acl) {
1379 sco = acl->link;
1380 if (sco) {
1381 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001382
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001383 hci_proto_connect_cfm(sco, status);
1384 hci_conn_del(sco);
1385 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001386 }
1387
1388 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001389}
1390
1391static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1392{
1393 struct hci_cp_sniff_mode *cp;
1394 struct hci_conn *conn;
1395
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001396 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001397
1398 if (!status)
1399 return;
1400
1401 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1402 if (!cp)
1403 return;
1404
1405 hci_dev_lock(hdev);
1406
1407 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001408 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001409 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001410
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001411 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001412 hci_sco_setup(conn, status);
1413 }
1414
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001415 hci_dev_unlock(hdev);
1416}
1417
1418static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1419{
1420 struct hci_cp_exit_sniff_mode *cp;
1421 struct hci_conn *conn;
1422
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001423 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001424
1425 if (!status)
1426 return;
1427
1428 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1429 if (!cp)
1430 return;
1431
1432 hci_dev_lock(hdev);
1433
1434 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001435 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001436 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001437
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001438 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001439 hci_sco_setup(conn, status);
1440 }
1441
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001442 hci_dev_unlock(hdev);
1443}
1444
Johan Hedberg88c3df12012-02-09 14:27:38 +02001445static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1446{
1447 struct hci_cp_disconnect *cp;
1448 struct hci_conn *conn;
1449
1450 if (!status)
1451 return;
1452
1453 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1454 if (!cp)
1455 return;
1456
1457 hci_dev_lock(hdev);
1458
1459 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1460 if (conn)
1461 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001462 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001463
1464 hci_dev_unlock(hdev);
1465}
1466
Ville Tervofcd89c02011-02-10 22:38:47 -03001467static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1468{
Ville Tervofcd89c02011-02-10 22:38:47 -03001469 struct hci_conn *conn;
1470
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001471 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Ville Tervofcd89c02011-02-10 22:38:47 -03001472
Ville Tervofcd89c02011-02-10 22:38:47 -03001473 if (status) {
Andre Guedesf00a06a2012-07-27 15:10:13 -03001474 hci_dev_lock(hdev);
Ville Tervofcd89c02011-02-10 22:38:47 -03001475
Andre Guedes0c95ab72012-07-27 15:10:14 -03001476 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001477 if (!conn) {
1478 hci_dev_unlock(hdev);
1479 return;
1480 }
1481
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001482 BT_DBG("%s bdaddr %pMR conn %p", hdev->name, &conn->dst, conn);
Andre Guedesf00a06a2012-07-27 15:10:13 -03001483
1484 conn->state = BT_CLOSED;
Andre Guedes0c95ab72012-07-27 15:10:14 -03001485 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Andre Guedesf00a06a2012-07-27 15:10:13 -03001486 conn->dst_type, status);
1487 hci_proto_connect_cfm(conn, status);
1488 hci_conn_del(conn);
1489
1490 hci_dev_unlock(hdev);
1491 }
Ville Tervofcd89c02011-02-10 22:38:47 -03001492}
1493
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001494static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1495{
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001496 struct hci_cp_create_phy_link *cp;
1497
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001498 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001499
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001500 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1501 if (!cp)
1502 return;
1503
Andrei Emeltchenkoe58917b2012-10-31 15:46:33 +02001504 hci_dev_lock(hdev);
1505
1506 if (status) {
1507 struct hci_conn *hcon;
1508
1509 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1510 if (hcon)
1511 hci_conn_del(hcon);
1512 } else {
1513 amp_write_remote_assoc(hdev, cp->phy_handle);
1514 }
1515
1516 hci_dev_unlock(hdev);
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001517}
1518
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03001519static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1520{
1521 struct hci_cp_accept_phy_link *cp;
1522
1523 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1524
1525 if (status)
1526 return;
1527
1528 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1529 if (!cp)
1530 return;
1531
1532 amp_write_remote_assoc(hdev, cp->phy_handle);
1533}
1534
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001535static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001536{
1537 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001538 struct discovery_state *discov = &hdev->discovery;
1539 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001540
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001541 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001542
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001543 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001544
1545 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1546 return;
1547
Andre Guedes3e13fa12013-03-27 20:04:56 -03001548 smp_mb__after_clear_bit(); /* wake_up_bit advises about this barrier */
1549 wake_up_bit(&hdev->flags, HCI_INQUIRY);
1550
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001551 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001552 return;
1553
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001554 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001555
Andre Guedes343f9352012-02-17 20:39:37 -03001556 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001557 goto unlock;
1558
1559 if (list_empty(&discov->resolve)) {
1560 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1561 goto unlock;
1562 }
1563
1564 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1565 if (e && hci_resolve_name(hdev, e) == 0) {
1566 e->name_state = NAME_PENDING;
1567 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1568 } else {
1569 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1570 }
1571
1572unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001573 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001574}
1575
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001576static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001577{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001578 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001579 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001580 int num_rsp = *((__u8 *) skb->data);
1581
1582 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1583
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001584 if (!num_rsp)
1585 return;
1586
Andre Guedes1519cc12012-03-21 00:03:38 -03001587 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1588 return;
1589
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001591
Johan Hedberge17acd42011-03-30 23:57:16 +03001592 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001593 bool name_known, ssp;
Johan Hedberg31754052012-01-04 13:39:52 +02001594
Linus Torvalds1da177e2005-04-16 15:20:36 -07001595 bacpy(&data.bdaddr, &info->bdaddr);
1596 data.pscan_rep_mode = info->pscan_rep_mode;
1597 data.pscan_period_mode = info->pscan_period_mode;
1598 data.pscan_mode = info->pscan_mode;
1599 memcpy(data.dev_class, info->dev_class, 3);
1600 data.clock_offset = info->clock_offset;
1601 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001602 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02001603
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001604 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02001605 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001606 info->dev_class, 0, !name_known, ssp, NULL,
1607 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001608 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001609
Linus Torvalds1da177e2005-04-16 15:20:36 -07001610 hci_dev_unlock(hdev);
1611}
1612
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001613static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001614{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001615 struct hci_ev_conn_complete *ev = (void *) skb->data;
1616 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001618 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001619
Linus Torvalds1da177e2005-04-16 15:20:36 -07001620 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001621
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001622 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001623 if (!conn) {
1624 if (ev->link_type != SCO_LINK)
1625 goto unlock;
1626
1627 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1628 if (!conn)
1629 goto unlock;
1630
1631 conn->type = SCO_LINK;
1632 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001633
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001634 if (!ev->status) {
1635 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001636
1637 if (conn->type == ACL_LINK) {
1638 conn->state = BT_CONFIG;
1639 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02001640
1641 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1642 !hci_find_link_key(hdev, &ev->bdaddr))
1643 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1644 else
1645 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02001646 } else
1647 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001648
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001649 hci_conn_add_sysfs(conn);
1650
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001651 if (test_bit(HCI_AUTH, &hdev->flags))
1652 conn->link_mode |= HCI_LM_AUTH;
1653
1654 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1655 conn->link_mode |= HCI_LM_ENCRYPT;
1656
1657 /* Get remote features */
1658 if (conn->type == ACL_LINK) {
1659 struct hci_cp_read_remote_features cp;
1660 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02001661 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001662 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001663 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001664
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001665 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02001666 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001667 struct hci_cp_change_conn_ptype cp;
1668 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02001669 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001670 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
1671 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001672 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02001673 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001674 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02001675 if (conn->type == ACL_LINK)
Johan Hedberg744cf192011-11-08 20:40:14 +02001676 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001677 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02001678 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001679
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001680 if (conn->type == ACL_LINK)
1681 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001682
Marcel Holtmann769be972008-07-14 20:13:49 +02001683 if (ev->status) {
1684 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001685 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01001686 } else if (ev->link_type != ACL_LINK)
1687 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001688
1689unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001690 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001691
1692 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001693}
1694
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001695static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001696{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001697 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001698 int mask = hdev->link_mode;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001699 __u8 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001700
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001701 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001702 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001703
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001704 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
1705 &flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001706
Szymon Janc138d22e2011-02-17 16:44:23 +01001707 if ((mask & HCI_LM_ACCEPT) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001708 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001709 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001710 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001711 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001712
1713 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001714
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001715 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1716 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02001717 memcpy(ie->data.dev_class, ev->dev_class, 3);
1718
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03001719 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
1720 &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02001722 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1723 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001724 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001725 hci_dev_unlock(hdev);
1726 return;
1727 }
1728 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001729
Linus Torvalds1da177e2005-04-16 15:20:36 -07001730 memcpy(conn->dev_class, ev->dev_class, 3);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001731
Linus Torvalds1da177e2005-04-16 15:20:36 -07001732 hci_dev_unlock(hdev);
1733
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001734 if (ev->link_type == ACL_LINK ||
1735 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001736 struct hci_cp_accept_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001737 conn->state = BT_CONNECT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001738
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001739 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001740
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001741 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1742 cp.role = 0x00; /* Become master */
1743 else
1744 cp.role = 0x01; /* Remain slave */
1745
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001746 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
1747 &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001748 } else if (!(flags & HCI_PROTO_DEFER)) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001749 struct hci_cp_accept_sync_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001750 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001751
1752 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02001753 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001754
Andrei Emeltchenko82781e62012-05-25 11:38:27 +03001755 cp.tx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1756 cp.rx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1757 cp.max_latency = __constant_cpu_to_le16(0xffff);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001758 cp.content_format = cpu_to_le16(hdev->voice_setting);
1759 cp.retrans_effort = 0xff;
1760
1761 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001762 sizeof(cp), &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01001763 } else {
1764 conn->state = BT_CONNECT2;
1765 hci_proto_connect_cfm(conn, 0);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001766 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001767 } else {
1768 /* Connection rejected */
1769 struct hci_cp_reject_conn_req cp;
1770
1771 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02001772 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001773 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001774 }
1775}
1776
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001777static u8 hci_to_mgmt_reason(u8 err)
1778{
1779 switch (err) {
1780 case HCI_ERROR_CONNECTION_TIMEOUT:
1781 return MGMT_DEV_DISCONN_TIMEOUT;
1782 case HCI_ERROR_REMOTE_USER_TERM:
1783 case HCI_ERROR_REMOTE_LOW_RESOURCES:
1784 case HCI_ERROR_REMOTE_POWER_OFF:
1785 return MGMT_DEV_DISCONN_REMOTE;
1786 case HCI_ERROR_LOCAL_HOST_TERM:
1787 return MGMT_DEV_DISCONN_LOCAL_HOST;
1788 default:
1789 return MGMT_DEV_DISCONN_UNKNOWN;
1790 }
1791}
1792
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001793static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001794{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001795 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02001796 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001797
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001798 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001799
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800 hci_dev_lock(hdev);
1801
Marcel Holtmann04837f62006-07-03 10:02:33 +02001802 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02001803 if (!conn)
1804 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001805
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001806 if (ev->status == 0)
1807 conn->state = BT_CLOSED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001808
Johan Hedbergb644ba32012-01-17 21:48:47 +02001809 if (test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001810 (conn->type == ACL_LINK || conn->type == LE_LINK)) {
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001811 if (ev->status) {
Johan Hedberg88c3df12012-02-09 14:27:38 +02001812 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001813 conn->dst_type, ev->status);
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001814 } else {
1815 u8 reason = hci_to_mgmt_reason(ev->reason);
1816
Johan Hedbergafc747a2012-01-15 18:11:07 +02001817 mgmt_device_disconnected(hdev, &conn->dst, conn->type,
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02001818 conn->dst_type, reason);
1819 }
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001820 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001821
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001822 if (ev->status == 0) {
Vishal Agarwal6ec5bca2012-04-16 14:44:44 +05301823 if (conn->type == ACL_LINK && conn->flush_key)
1824 hci_remove_link_key(hdev, &conn->dst);
Johan Hedberg37d9ef72011-11-10 15:54:39 +02001825 hci_proto_disconn_cfm(conn, ev->reason);
1826 hci_conn_del(conn);
1827 }
Johan Hedbergf7520542011-01-20 12:34:39 +02001828
1829unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001830 hci_dev_unlock(hdev);
1831}
1832
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001833static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001834{
1835 struct hci_ev_auth_complete *ev = (void *) skb->data;
1836 struct hci_conn *conn;
1837
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001838 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001839
1840 hci_dev_lock(hdev);
1841
1842 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001843 if (!conn)
1844 goto unlock;
1845
1846 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02001847 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03001848 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001849 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03001850 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001851 conn->link_mode |= HCI_LM_AUTH;
1852 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03001853 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001854 } else {
Johan Hedbergbab73cb2012-02-09 16:07:29 +02001855 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001856 ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001857 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001858
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001859 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
1860 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001861
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001862 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02001863 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001864 struct hci_cp_set_conn_encrypt cp;
1865 cp.handle = ev->handle;
1866 cp.encrypt = 0x01;
1867 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03001868 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001869 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001870 conn->state = BT_CONNECTED;
1871 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001872 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001873 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001874 } else {
1875 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02001876
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001877 hci_conn_hold(conn);
1878 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02001879 hci_conn_drop(conn);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001880 }
1881
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001882 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001883 if (!ev->status) {
1884 struct hci_cp_set_conn_encrypt cp;
1885 cp.handle = ev->handle;
1886 cp.encrypt = 0x01;
1887 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03001888 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001889 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001890 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001891 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001892 }
1893 }
1894
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02001895unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001896 hci_dev_unlock(hdev);
1897}
1898
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001899static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001900{
Johan Hedberg127178d2010-11-18 22:22:29 +02001901 struct hci_ev_remote_name *ev = (void *) skb->data;
1902 struct hci_conn *conn;
1903
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001904 BT_DBG("%s", hdev->name);
1905
1906 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02001907
1908 hci_dev_lock(hdev);
1909
1910 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001911
1912 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
1913 goto check_auth;
1914
1915 if (ev->status == 0)
1916 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001917 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02001918 else
1919 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
1920
1921check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07001922 if (!conn)
1923 goto unlock;
1924
1925 if (!hci_outgoing_auth_needed(hdev, conn))
1926 goto unlock;
1927
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001928 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02001929 struct hci_cp_auth_requested cp;
1930 cp.handle = __cpu_to_le16(conn->handle);
1931 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1932 }
1933
Johan Hedberg79c6c702011-04-28 11:28:55 -07001934unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001935 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001936}
1937
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001938static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001939{
1940 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1941 struct hci_conn *conn;
1942
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001943 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001944
1945 hci_dev_lock(hdev);
1946
1947 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1948 if (conn) {
1949 if (!ev->status) {
Marcel Holtmannae293192008-07-14 20:13:45 +02001950 if (ev->encrypt) {
1951 /* Encryption implies authentication */
1952 conn->link_mode |= HCI_LM_AUTH;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001953 conn->link_mode |= HCI_LM_ENCRYPT;
Vinicius Costa Gomesda85e5e2011-06-09 18:50:53 -03001954 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannae293192008-07-14 20:13:45 +02001955 } else
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001956 conn->link_mode &= ~HCI_LM_ENCRYPT;
1957 }
1958
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001959 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001960
Gustavo Padovana7d77232012-05-13 03:20:07 -03001961 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03001962 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02001963 hci_conn_drop(conn);
Gustavo Padovana7d77232012-05-13 03:20:07 -03001964 goto unlock;
1965 }
1966
Marcel Holtmannf8558552008-07-14 20:13:49 +02001967 if (conn->state == BT_CONFIG) {
1968 if (!ev->status)
1969 conn->state = BT_CONNECTED;
1970
1971 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001972 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001973 } else
1974 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001975 }
1976
Gustavo Padovana7d77232012-05-13 03:20:07 -03001977unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001978 hci_dev_unlock(hdev);
1979}
1980
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001981static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
1982 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001983{
1984 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1985 struct hci_conn *conn;
1986
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001987 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001988
1989 hci_dev_lock(hdev);
1990
1991 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1992 if (conn) {
1993 if (!ev->status)
1994 conn->link_mode |= HCI_LM_SECURE;
1995
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001996 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001997
1998 hci_key_change_cfm(conn, ev->status);
1999 }
2000
2001 hci_dev_unlock(hdev);
2002}
2003
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002004static void hci_remote_features_evt(struct hci_dev *hdev,
2005 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002006{
2007 struct hci_ev_remote_features *ev = (void *) skb->data;
2008 struct hci_conn *conn;
2009
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002010 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002011
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002012 hci_dev_lock(hdev);
2013
2014 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002015 if (!conn)
2016 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002017
Johan Hedbergccd556f2010-11-10 17:11:51 +02002018 if (!ev->status)
Johan Hedbergcad718e2013-04-17 15:00:51 +03002019 memcpy(conn->features[0], ev->features, 8);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002020
2021 if (conn->state != BT_CONFIG)
2022 goto unlock;
2023
2024 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2025 struct hci_cp_read_remote_ext_features cp;
2026 cp.handle = ev->handle;
2027 cp.page = 0x01;
2028 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002029 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002030 goto unlock;
2031 }
2032
Johan Hedberg671267b2012-05-12 16:11:50 -03002033 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002034 struct hci_cp_remote_name_req cp;
2035 memset(&cp, 0, sizeof(cp));
2036 bacpy(&cp.bdaddr, &conn->dst);
2037 cp.pscan_rep_mode = 0x02;
2038 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002039 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2040 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002041 conn->dst_type, 0, NULL, 0,
2042 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002043
Johan Hedberg127178d2010-11-18 22:22:29 +02002044 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002045 conn->state = BT_CONNECTED;
2046 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002047 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002048 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002049
Johan Hedbergccd556f2010-11-10 17:11:51 +02002050unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002051 hci_dev_unlock(hdev);
2052}
2053
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002054static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002055{
2056 struct hci_ev_cmd_complete *ev = (void *) skb->data;
Johan Hedberg9238f362013-03-05 20:37:48 +02002057 u8 status = skb->data[sizeof(*ev)];
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002058 __u16 opcode;
2059
2060 skb_pull(skb, sizeof(*ev));
2061
2062 opcode = __le16_to_cpu(ev->opcode);
2063
2064 switch (opcode) {
2065 case HCI_OP_INQUIRY_CANCEL:
2066 hci_cc_inquiry_cancel(hdev, skb);
2067 break;
2068
Andre Guedes4d934832012-03-21 00:03:35 -03002069 case HCI_OP_PERIODIC_INQ:
2070 hci_cc_periodic_inq(hdev, skb);
2071 break;
2072
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002073 case HCI_OP_EXIT_PERIODIC_INQ:
2074 hci_cc_exit_periodic_inq(hdev, skb);
2075 break;
2076
2077 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2078 hci_cc_remote_name_req_cancel(hdev, skb);
2079 break;
2080
2081 case HCI_OP_ROLE_DISCOVERY:
2082 hci_cc_role_discovery(hdev, skb);
2083 break;
2084
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002085 case HCI_OP_READ_LINK_POLICY:
2086 hci_cc_read_link_policy(hdev, skb);
2087 break;
2088
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002089 case HCI_OP_WRITE_LINK_POLICY:
2090 hci_cc_write_link_policy(hdev, skb);
2091 break;
2092
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002093 case HCI_OP_READ_DEF_LINK_POLICY:
2094 hci_cc_read_def_link_policy(hdev, skb);
2095 break;
2096
2097 case HCI_OP_WRITE_DEF_LINK_POLICY:
2098 hci_cc_write_def_link_policy(hdev, skb);
2099 break;
2100
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002101 case HCI_OP_RESET:
2102 hci_cc_reset(hdev, skb);
2103 break;
2104
2105 case HCI_OP_WRITE_LOCAL_NAME:
2106 hci_cc_write_local_name(hdev, skb);
2107 break;
2108
2109 case HCI_OP_READ_LOCAL_NAME:
2110 hci_cc_read_local_name(hdev, skb);
2111 break;
2112
2113 case HCI_OP_WRITE_AUTH_ENABLE:
2114 hci_cc_write_auth_enable(hdev, skb);
2115 break;
2116
2117 case HCI_OP_WRITE_ENCRYPT_MODE:
2118 hci_cc_write_encrypt_mode(hdev, skb);
2119 break;
2120
2121 case HCI_OP_WRITE_SCAN_ENABLE:
2122 hci_cc_write_scan_enable(hdev, skb);
2123 break;
2124
2125 case HCI_OP_READ_CLASS_OF_DEV:
2126 hci_cc_read_class_of_dev(hdev, skb);
2127 break;
2128
2129 case HCI_OP_WRITE_CLASS_OF_DEV:
2130 hci_cc_write_class_of_dev(hdev, skb);
2131 break;
2132
2133 case HCI_OP_READ_VOICE_SETTING:
2134 hci_cc_read_voice_setting(hdev, skb);
2135 break;
2136
2137 case HCI_OP_WRITE_VOICE_SETTING:
2138 hci_cc_write_voice_setting(hdev, skb);
2139 break;
2140
Marcel Holtmann333140b2008-07-14 20:13:48 +02002141 case HCI_OP_WRITE_SSP_MODE:
2142 hci_cc_write_ssp_mode(hdev, skb);
2143 break;
2144
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002145 case HCI_OP_READ_LOCAL_VERSION:
2146 hci_cc_read_local_version(hdev, skb);
2147 break;
2148
2149 case HCI_OP_READ_LOCAL_COMMANDS:
2150 hci_cc_read_local_commands(hdev, skb);
2151 break;
2152
2153 case HCI_OP_READ_LOCAL_FEATURES:
2154 hci_cc_read_local_features(hdev, skb);
2155 break;
2156
Andre Guedes971e3a42011-06-30 19:20:52 -03002157 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2158 hci_cc_read_local_ext_features(hdev, skb);
2159 break;
2160
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002161 case HCI_OP_READ_BUFFER_SIZE:
2162 hci_cc_read_buffer_size(hdev, skb);
2163 break;
2164
2165 case HCI_OP_READ_BD_ADDR:
2166 hci_cc_read_bd_addr(hdev, skb);
2167 break;
2168
Johan Hedbergf332ec62013-03-15 17:07:11 -05002169 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2170 hci_cc_read_page_scan_activity(hdev, skb);
2171 break;
2172
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002173 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2174 hci_cc_write_page_scan_activity(hdev, skb);
2175 break;
2176
Johan Hedbergf332ec62013-03-15 17:07:11 -05002177 case HCI_OP_READ_PAGE_SCAN_TYPE:
2178 hci_cc_read_page_scan_type(hdev, skb);
2179 break;
2180
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002181 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2182 hci_cc_write_page_scan_type(hdev, skb);
2183 break;
2184
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002185 case HCI_OP_READ_DATA_BLOCK_SIZE:
2186 hci_cc_read_data_block_size(hdev, skb);
2187 break;
2188
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002189 case HCI_OP_READ_FLOW_CONTROL_MODE:
2190 hci_cc_read_flow_control_mode(hdev, skb);
2191 break;
2192
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002193 case HCI_OP_READ_LOCAL_AMP_INFO:
2194 hci_cc_read_local_amp_info(hdev, skb);
2195 break;
2196
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002197 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2198 hci_cc_read_local_amp_assoc(hdev, skb);
2199 break;
2200
Johan Hedbergd5859e22011-01-25 01:19:58 +02002201 case HCI_OP_READ_INQ_RSP_TX_POWER:
2202 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2203 break;
2204
Johan Hedberg980e1a52011-01-22 06:10:07 +02002205 case HCI_OP_PIN_CODE_REPLY:
2206 hci_cc_pin_code_reply(hdev, skb);
2207 break;
2208
2209 case HCI_OP_PIN_CODE_NEG_REPLY:
2210 hci_cc_pin_code_neg_reply(hdev, skb);
2211 break;
2212
Szymon Jancc35938b2011-03-22 13:12:21 +01002213 case HCI_OP_READ_LOCAL_OOB_DATA:
2214 hci_cc_read_local_oob_data_reply(hdev, skb);
2215 break;
2216
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002217 case HCI_OP_LE_READ_BUFFER_SIZE:
2218 hci_cc_le_read_buffer_size(hdev, skb);
2219 break;
2220
Johan Hedberg60e77322013-01-22 14:01:59 +02002221 case HCI_OP_LE_READ_LOCAL_FEATURES:
2222 hci_cc_le_read_local_features(hdev, skb);
2223 break;
2224
Johan Hedberg8fa19092012-10-19 20:57:49 +03002225 case HCI_OP_LE_READ_ADV_TX_POWER:
2226 hci_cc_le_read_adv_tx_power(hdev, skb);
2227 break;
2228
Johan Hedberga5c29682011-02-19 12:05:57 -03002229 case HCI_OP_USER_CONFIRM_REPLY:
2230 hci_cc_user_confirm_reply(hdev, skb);
2231 break;
2232
2233 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2234 hci_cc_user_confirm_neg_reply(hdev, skb);
2235 break;
2236
Brian Gix1143d452011-11-23 08:28:34 -08002237 case HCI_OP_USER_PASSKEY_REPLY:
2238 hci_cc_user_passkey_reply(hdev, skb);
2239 break;
2240
2241 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2242 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002243 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002244
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01002245 case HCI_OP_LE_SET_ADV_ENABLE:
2246 hci_cc_le_set_adv_enable(hdev, skb);
2247 break;
2248
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002249 case HCI_OP_LE_SET_SCAN_ENABLE:
2250 hci_cc_le_set_scan_enable(hdev, skb);
2251 break;
2252
Johan Hedbergcf1d0812013-01-22 14:02:00 +02002253 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2254 hci_cc_le_read_white_list_size(hdev, skb);
2255 break;
2256
Johan Hedberg9b008c02013-01-22 14:02:01 +02002257 case HCI_OP_LE_READ_SUPPORTED_STATES:
2258 hci_cc_le_read_supported_states(hdev, skb);
2259 break;
2260
Andre Guedesf9b49302011-06-30 19:20:53 -03002261 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2262 hci_cc_write_le_host_supported(hdev, skb);
2263 break;
2264
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03002265 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2266 hci_cc_write_remote_amp_assoc(hdev, skb);
2267 break;
2268
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002269 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002270 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002271 break;
2272 }
2273
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002274 if (opcode != HCI_OP_NOP)
Ville Tervo6bd32322011-02-16 16:32:41 +02002275 del_timer(&hdev->cmd_timer);
2276
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002277 hci_req_cmd_complete(hdev, opcode, status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002278
Szymon Jancdbccd792012-12-11 08:51:19 +01002279 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002280 atomic_set(&hdev->cmd_cnt, 1);
2281 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002282 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002283 }
2284}
2285
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002286static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002287{
2288 struct hci_ev_cmd_status *ev = (void *) skb->data;
2289 __u16 opcode;
2290
2291 skb_pull(skb, sizeof(*ev));
2292
2293 opcode = __le16_to_cpu(ev->opcode);
2294
2295 switch (opcode) {
2296 case HCI_OP_INQUIRY:
2297 hci_cs_inquiry(hdev, ev->status);
2298 break;
2299
2300 case HCI_OP_CREATE_CONN:
2301 hci_cs_create_conn(hdev, ev->status);
2302 break;
2303
2304 case HCI_OP_ADD_SCO:
2305 hci_cs_add_sco(hdev, ev->status);
2306 break;
2307
Marcel Holtmannf8558552008-07-14 20:13:49 +02002308 case HCI_OP_AUTH_REQUESTED:
2309 hci_cs_auth_requested(hdev, ev->status);
2310 break;
2311
2312 case HCI_OP_SET_CONN_ENCRYPT:
2313 hci_cs_set_conn_encrypt(hdev, ev->status);
2314 break;
2315
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002316 case HCI_OP_REMOTE_NAME_REQ:
2317 hci_cs_remote_name_req(hdev, ev->status);
2318 break;
2319
Marcel Holtmann769be972008-07-14 20:13:49 +02002320 case HCI_OP_READ_REMOTE_FEATURES:
2321 hci_cs_read_remote_features(hdev, ev->status);
2322 break;
2323
2324 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2325 hci_cs_read_remote_ext_features(hdev, ev->status);
2326 break;
2327
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002328 case HCI_OP_SETUP_SYNC_CONN:
2329 hci_cs_setup_sync_conn(hdev, ev->status);
2330 break;
2331
2332 case HCI_OP_SNIFF_MODE:
2333 hci_cs_sniff_mode(hdev, ev->status);
2334 break;
2335
2336 case HCI_OP_EXIT_SNIFF_MODE:
2337 hci_cs_exit_sniff_mode(hdev, ev->status);
2338 break;
2339
Johan Hedberg8962ee72011-01-20 12:40:27 +02002340 case HCI_OP_DISCONNECT:
Johan Hedberg88c3df12012-02-09 14:27:38 +02002341 hci_cs_disconnect(hdev, ev->status);
Johan Hedberg8962ee72011-01-20 12:40:27 +02002342 break;
2343
Ville Tervofcd89c02011-02-10 22:38:47 -03002344 case HCI_OP_LE_CREATE_CONN:
2345 hci_cs_le_create_conn(hdev, ev->status);
2346 break;
2347
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03002348 case HCI_OP_CREATE_PHY_LINK:
2349 hci_cs_create_phylink(hdev, ev->status);
2350 break;
2351
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03002352 case HCI_OP_ACCEPT_PHY_LINK:
2353 hci_cs_accept_phylink(hdev, ev->status);
2354 break;
2355
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002356 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002357 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002358 break;
2359 }
2360
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002361 if (opcode != HCI_OP_NOP)
Ville Tervo6bd32322011-02-16 16:32:41 +02002362 del_timer(&hdev->cmd_timer);
2363
Johan Hedberg02350a72013-04-03 21:50:29 +03002364 if (ev->status ||
2365 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
2366 hci_req_cmd_complete(hdev, opcode, ev->status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002367
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002368 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002369 atomic_set(&hdev->cmd_cnt, 1);
2370 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002371 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002372 }
2373}
2374
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002375static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002376{
2377 struct hci_ev_role_change *ev = (void *) skb->data;
2378 struct hci_conn *conn;
2379
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002380 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002381
2382 hci_dev_lock(hdev);
2383
2384 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2385 if (conn) {
2386 if (!ev->status) {
2387 if (ev->role)
2388 conn->link_mode &= ~HCI_LM_MASTER;
2389 else
2390 conn->link_mode |= HCI_LM_MASTER;
2391 }
2392
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002393 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002394
2395 hci_role_switch_cfm(conn, ev->status, ev->role);
2396 }
2397
2398 hci_dev_unlock(hdev);
2399}
2400
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002401static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002402{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002403 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002404 int i;
2405
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02002406 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2407 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2408 return;
2409 }
2410
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002411 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002412 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002413 BT_DBG("%s bad parameters", hdev->name);
2414 return;
2415 }
2416
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002417 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2418
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002419 for (i = 0; i < ev->num_hndl; i++) {
2420 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002421 struct hci_conn *conn;
2422 __u16 handle, count;
2423
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002424 handle = __le16_to_cpu(info->handle);
2425 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002426
2427 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002428 if (!conn)
2429 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002430
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002431 conn->sent -= count;
2432
2433 switch (conn->type) {
2434 case ACL_LINK:
2435 hdev->acl_cnt += count;
2436 if (hdev->acl_cnt > hdev->acl_pkts)
2437 hdev->acl_cnt = hdev->acl_pkts;
2438 break;
2439
2440 case LE_LINK:
2441 if (hdev->le_pkts) {
2442 hdev->le_cnt += count;
2443 if (hdev->le_cnt > hdev->le_pkts)
2444 hdev->le_cnt = hdev->le_pkts;
2445 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002446 hdev->acl_cnt += count;
2447 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002448 hdev->acl_cnt = hdev->acl_pkts;
2449 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002450 break;
2451
2452 case SCO_LINK:
2453 hdev->sco_cnt += count;
2454 if (hdev->sco_cnt > hdev->sco_pkts)
2455 hdev->sco_cnt = hdev->sco_pkts;
2456 break;
2457
2458 default:
2459 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2460 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002461 }
2462 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002463
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02002464 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002465}
2466
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002467static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
2468 __u16 handle)
2469{
2470 struct hci_chan *chan;
2471
2472 switch (hdev->dev_type) {
2473 case HCI_BREDR:
2474 return hci_conn_hash_lookup_handle(hdev, handle);
2475 case HCI_AMP:
2476 chan = hci_chan_lookup_handle(hdev, handle);
2477 if (chan)
2478 return chan->conn;
2479 break;
2480 default:
2481 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
2482 break;
2483 }
2484
2485 return NULL;
2486}
2487
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002488static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002489{
2490 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2491 int i;
2492
2493 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2494 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2495 return;
2496 }
2497
2498 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002499 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002500 BT_DBG("%s bad parameters", hdev->name);
2501 return;
2502 }
2503
2504 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002505 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002506
2507 for (i = 0; i < ev->num_hndl; i++) {
2508 struct hci_comp_blocks_info *info = &ev->handles[i];
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002509 struct hci_conn *conn = NULL;
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002510 __u16 handle, block_count;
2511
2512 handle = __le16_to_cpu(info->handle);
2513 block_count = __le16_to_cpu(info->blocks);
2514
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002515 conn = __hci_conn_lookup_handle(hdev, handle);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002516 if (!conn)
2517 continue;
2518
2519 conn->sent -= block_count;
2520
2521 switch (conn->type) {
2522 case ACL_LINK:
Andrei Emeltchenkobd1eb662012-10-10 17:38:30 +03002523 case AMP_LINK:
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002524 hdev->block_cnt += block_count;
2525 if (hdev->block_cnt > hdev->num_blocks)
2526 hdev->block_cnt = hdev->num_blocks;
2527 break;
2528
2529 default:
2530 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2531 break;
2532 }
2533 }
2534
2535 queue_work(hdev->workqueue, &hdev->tx_work);
2536}
2537
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002538static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002539{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002540 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002541 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002542
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002543 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002544
2545 hci_dev_lock(hdev);
2546
Marcel Holtmann04837f62006-07-03 10:02:33 +02002547 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2548 if (conn) {
2549 conn->mode = ev->mode;
2550 conn->interval = __le16_to_cpu(ev->interval);
2551
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002552 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2553 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02002554 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002555 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002556 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02002557 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002558 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002559
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002560 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002561 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002562 }
2563
2564 hci_dev_unlock(hdev);
2565}
2566
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002567static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002568{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002569 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2570 struct hci_conn *conn;
2571
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002572 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002573
2574 hci_dev_lock(hdev);
2575
2576 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002577 if (!conn)
2578 goto unlock;
2579
2580 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002581 hci_conn_hold(conn);
2582 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02002583 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002584 }
2585
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002586 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02002587 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002588 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002589 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002590 u8 secure;
2591
2592 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2593 secure = 1;
2594 else
2595 secure = 0;
2596
Johan Hedberg744cf192011-11-08 20:40:14 +02002597 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02002598 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02002599
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02002600unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002601 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002602}
2603
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002604static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002605{
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002606 struct hci_ev_link_key_req *ev = (void *) skb->data;
2607 struct hci_cp_link_key_reply cp;
2608 struct hci_conn *conn;
2609 struct link_key *key;
2610
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002611 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002612
Andrei Emeltchenko034cbea2013-05-14 11:44:16 +03002613 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002614 return;
2615
2616 hci_dev_lock(hdev);
2617
2618 key = hci_find_link_key(hdev, &ev->bdaddr);
2619 if (!key) {
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002620 BT_DBG("%s link key not found for %pMR", hdev->name,
2621 &ev->bdaddr);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002622 goto not_found;
2623 }
2624
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002625 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
2626 &ev->bdaddr);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002627
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002628 if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002629 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002630 BT_DBG("%s ignoring debug key", hdev->name);
2631 goto not_found;
2632 }
2633
2634 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002635 if (conn) {
2636 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002637 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002638 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2639 goto not_found;
2640 }
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002641
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002642 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002643 conn->pending_sec_level == BT_SECURITY_HIGH) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002644 BT_DBG("%s ignoring key unauthenticated for high security",
2645 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02002646 goto not_found;
2647 }
2648
2649 conn->key_type = key->type;
2650 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002651 }
2652
2653 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03002654 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002655
2656 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2657
2658 hci_dev_unlock(hdev);
2659
2660 return;
2661
2662not_found:
2663 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2664 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002665}
2666
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002667static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002668{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002669 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2670 struct hci_conn *conn;
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002671 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002672
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002673 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002674
2675 hci_dev_lock(hdev);
2676
2677 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2678 if (conn) {
2679 hci_conn_hold(conn);
2680 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02002681 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02002682
2683 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2684 conn->key_type = ev->key_type;
2685
David Herrmann76a68ba2013-04-06 20:28:37 +02002686 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002687 }
2688
Andrei Emeltchenko034cbea2013-05-14 11:44:16 +03002689 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07002690 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002691 ev->key_type, pin_len);
Johan Hedberg55ed8ca2011-01-17 14:41:05 +02002692
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002693 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002694}
2695
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002696static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02002697{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002698 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002699 struct hci_conn *conn;
2700
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002701 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002702
2703 hci_dev_lock(hdev);
2704
2705 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002706 if (conn && !ev->status) {
2707 struct inquiry_entry *ie;
2708
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002709 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2710 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002711 ie->data.clock_offset = ev->clock_offset;
2712 ie->timestamp = jiffies;
2713 }
2714 }
2715
2716 hci_dev_unlock(hdev);
2717}
2718
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002719static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02002720{
2721 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2722 struct hci_conn *conn;
2723
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002724 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02002725
2726 hci_dev_lock(hdev);
2727
2728 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2729 if (conn && !ev->status)
2730 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2731
2732 hci_dev_unlock(hdev);
2733}
2734
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002735static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002736{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002737 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002738 struct inquiry_entry *ie;
2739
2740 BT_DBG("%s", hdev->name);
2741
2742 hci_dev_lock(hdev);
2743
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002744 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2745 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07002746 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2747 ie->timestamp = jiffies;
2748 }
2749
2750 hci_dev_unlock(hdev);
2751}
2752
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002753static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
2754 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002755{
2756 struct inquiry_data data;
2757 int num_rsp = *((__u8 *) skb->data);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002758 bool name_known, ssp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002759
2760 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2761
2762 if (!num_rsp)
2763 return;
2764
Andre Guedes1519cc12012-03-21 00:03:38 -03002765 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2766 return;
2767
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002768 hci_dev_lock(hdev);
2769
2770 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01002771 struct inquiry_info_with_rssi_and_pscan_mode *info;
2772 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002773
Johan Hedberge17acd42011-03-30 23:57:16 +03002774 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002775 bacpy(&data.bdaddr, &info->bdaddr);
2776 data.pscan_rep_mode = info->pscan_rep_mode;
2777 data.pscan_period_mode = info->pscan_period_mode;
2778 data.pscan_mode = info->pscan_mode;
2779 memcpy(data.dev_class, info->dev_class, 3);
2780 data.clock_offset = info->clock_offset;
2781 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002782 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002783
2784 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002785 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002786 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002787 info->dev_class, info->rssi,
2788 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002789 }
2790 } else {
2791 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2792
Johan Hedberge17acd42011-03-30 23:57:16 +03002793 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002794 bacpy(&data.bdaddr, &info->bdaddr);
2795 data.pscan_rep_mode = info->pscan_rep_mode;
2796 data.pscan_period_mode = info->pscan_period_mode;
2797 data.pscan_mode = 0x00;
2798 memcpy(data.dev_class, info->dev_class, 3);
2799 data.clock_offset = info->clock_offset;
2800 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002801 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002802 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002803 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02002804 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002805 info->dev_class, info->rssi,
2806 !name_known, ssp, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002807 }
2808 }
2809
2810 hci_dev_unlock(hdev);
2811}
2812
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002813static void hci_remote_ext_features_evt(struct hci_dev *hdev,
2814 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002815{
Marcel Holtmann41a96212008-07-14 20:13:48 +02002816 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2817 struct hci_conn *conn;
2818
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002819 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02002820
Marcel Holtmann41a96212008-07-14 20:13:48 +02002821 hci_dev_lock(hdev);
2822
2823 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002824 if (!conn)
2825 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002826
Johan Hedbergcad718e2013-04-17 15:00:51 +03002827 if (ev->page < HCI_MAX_PAGES)
2828 memcpy(conn->features[ev->page], ev->features, 8);
2829
Johan Hedbergccd556f2010-11-10 17:11:51 +02002830 if (!ev->status && ev->page == 0x01) {
2831 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002832
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002833 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2834 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02002835 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02002836
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05302837 if (ev->features[0] & LMP_HOST_SSP) {
Johan Hedberg58a681e2012-01-16 06:47:28 +02002838 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05302839 } else {
2840 /* It is mandatory by the Bluetooth specification that
2841 * Extended Inquiry Results are only used when Secure
2842 * Simple Pairing is enabled, but some devices violate
2843 * this.
2844 *
2845 * To make these devices work, the internal SSP
2846 * enabled flag needs to be cleared if the remote host
2847 * features do not indicate SSP support */
2848 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
2849 }
Marcel Holtmann41a96212008-07-14 20:13:48 +02002850 }
2851
Johan Hedbergccd556f2010-11-10 17:11:51 +02002852 if (conn->state != BT_CONFIG)
2853 goto unlock;
2854
Johan Hedberg671267b2012-05-12 16:11:50 -03002855 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002856 struct hci_cp_remote_name_req cp;
2857 memset(&cp, 0, sizeof(cp));
2858 bacpy(&cp.bdaddr, &conn->dst);
2859 cp.pscan_rep_mode = 0x02;
2860 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002861 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2862 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002863 conn->dst_type, 0, NULL, 0,
2864 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002865
Johan Hedberg127178d2010-11-18 22:22:29 +02002866 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002867 conn->state = BT_CONNECTED;
2868 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002869 hci_conn_drop(conn);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002870 }
2871
2872unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02002873 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002874}
2875
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002876static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
2877 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002878{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002879 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2880 struct hci_conn *conn;
2881
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002882 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002883
2884 hci_dev_lock(hdev);
2885
2886 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02002887 if (!conn) {
2888 if (ev->link_type == ESCO_LINK)
2889 goto unlock;
2890
2891 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2892 if (!conn)
2893 goto unlock;
2894
2895 conn->type = SCO_LINK;
2896 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002897
Marcel Holtmann732547f2009-04-19 19:14:14 +02002898 switch (ev->status) {
2899 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002900 conn->handle = __le16_to_cpu(ev->handle);
2901 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002902
2903 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02002904 break;
2905
Frédéric Dalleau1a4c9582013-08-19 14:24:02 +02002906 case 0x0d: /* Connection Rejected due to Limited Resources */
Stephen Coe705e5712010-02-16 11:29:44 -05002907 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002908 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08002909 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02002910 case 0x1f: /* Unspecified error */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02002911 if (conn->out) {
Marcel Holtmann732547f2009-04-19 19:14:14 +02002912 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2913 (hdev->esco_type & EDR_ESCO_MASK);
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02002914 if (hci_setup_sync(conn, conn->link->handle))
2915 goto unlock;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002916 }
2917 /* fall through */
2918
2919 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002920 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02002921 break;
2922 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002923
2924 hci_proto_connect_cfm(conn, ev->status);
2925 if (ev->status)
2926 hci_conn_del(conn);
2927
2928unlock:
2929 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002930}
2931
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002932static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
2933 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002934{
2935 struct inquiry_data data;
2936 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2937 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05302938 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002939
2940 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2941
2942 if (!num_rsp)
2943 return;
2944
Andre Guedes1519cc12012-03-21 00:03:38 -03002945 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2946 return;
2947
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002948 hci_dev_lock(hdev);
2949
Johan Hedberge17acd42011-03-30 23:57:16 +03002950 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002951 bool name_known, ssp;
Johan Hedberg561aafb2012-01-04 13:31:59 +02002952
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002953 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01002954 data.pscan_rep_mode = info->pscan_rep_mode;
2955 data.pscan_period_mode = info->pscan_period_mode;
2956 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002957 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01002958 data.clock_offset = info->clock_offset;
2959 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002960 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02002961
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02002962 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02002963 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002964 sizeof(info->data),
2965 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02002966 else
2967 name_known = true;
2968
Johan Hedberg388fc8f2012-02-23 00:38:59 +02002969 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002970 &ssp);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05302971 eir_len = eir_get_length(info->data, sizeof(info->data));
Johan Hedberg48264f02011-11-09 13:58:58 +02002972 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002973 info->dev_class, info->rssi, !name_known,
Vishal Agarwal9d939d92012-04-26 19:19:56 +05302974 ssp, info->data, eir_len);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002975 }
2976
2977 hci_dev_unlock(hdev);
2978}
2979
Johan Hedberg1c2e0042012-06-08 23:31:13 +08002980static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
2981 struct sk_buff *skb)
2982{
2983 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
2984 struct hci_conn *conn;
2985
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002986 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08002987 __le16_to_cpu(ev->handle));
2988
2989 hci_dev_lock(hdev);
2990
2991 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2992 if (!conn)
2993 goto unlock;
2994
2995 if (!ev->status)
2996 conn->sec_level = conn->pending_sec_level;
2997
2998 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
2999
3000 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03003001 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02003002 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003003 goto unlock;
3004 }
3005
3006 if (conn->state == BT_CONFIG) {
3007 if (!ev->status)
3008 conn->state = BT_CONNECTED;
3009
3010 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003011 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003012 } else {
3013 hci_auth_cfm(conn, ev->status);
3014
3015 hci_conn_hold(conn);
3016 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003017 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003018 }
3019
3020unlock:
3021 hci_dev_unlock(hdev);
3022}
3023
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003024static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003025{
3026 /* If remote requests dedicated bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02003027 if (conn->remote_auth == HCI_AT_DEDICATED_BONDING ||
3028 conn->remote_auth == HCI_AT_DEDICATED_BONDING_MITM) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003029 /* If both remote and local IO capabilities allow MITM
3030 * protection then require it, otherwise don't */
Mikel Astizacabae92013-06-28 10:56:28 +02003031 if (conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT ||
3032 conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)
3033 return HCI_AT_DEDICATED_BONDING;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003034 else
Mikel Astizacabae92013-06-28 10:56:28 +02003035 return HCI_AT_DEDICATED_BONDING_MITM;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003036 }
3037
3038 /* If remote requests no-bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02003039 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3040 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003041 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003042
3043 return conn->auth_type;
3044}
3045
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003046static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003047{
3048 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3049 struct hci_conn *conn;
3050
3051 BT_DBG("%s", hdev->name);
3052
3053 hci_dev_lock(hdev);
3054
3055 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003056 if (!conn)
3057 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003058
Johan Hedberg03b555e2011-01-04 15:40:05 +02003059 hci_conn_hold(conn);
3060
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003061 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003062 goto unlock;
3063
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003064 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003065 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003066 struct hci_cp_io_capability_reply cp;
3067
3068 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303069 /* Change the IO capability from KeyboardDisplay
3070 * to DisplayYesNo as it is not supported by BT spec. */
3071 cp.capability = (conn->io_capability == 0x04) ?
Mikel Astiza7676312013-06-28 10:56:29 +02003072 HCI_IO_DISPLAY_YESNO : conn->io_capability;
Johan Hedberg7cbc9bd2011-04-28 11:29:04 -07003073 conn->auth_type = hci_get_auth_req(conn);
3074 cp.authentication = conn->auth_type;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003075
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003076 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3077 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
Szymon Jancce85ee12011-03-22 13:12:23 +01003078 cp.oob_data = 0x01;
3079 else
3080 cp.oob_data = 0x00;
3081
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003082 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003083 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003084 } else {
3085 struct hci_cp_io_capability_neg_reply cp;
3086
3087 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02003088 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003089
3090 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003091 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003092 }
3093
3094unlock:
3095 hci_dev_unlock(hdev);
3096}
3097
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003098static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02003099{
3100 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3101 struct hci_conn *conn;
3102
3103 BT_DBG("%s", hdev->name);
3104
3105 hci_dev_lock(hdev);
3106
3107 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3108 if (!conn)
3109 goto unlock;
3110
Johan Hedberg03b555e2011-01-04 15:40:05 +02003111 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003112 conn->remote_auth = ev->authentication;
Johan Hedberg58a681e2012-01-16 06:47:28 +02003113 if (ev->oob_data)
3114 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003115
3116unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003117 hci_dev_unlock(hdev);
3118}
3119
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003120static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3121 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003122{
3123 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003124 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07003125 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03003126
3127 BT_DBG("%s", hdev->name);
3128
3129 hci_dev_lock(hdev);
3130
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003131 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg7a828902011-04-28 11:28:53 -07003132 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03003133
Johan Hedberg7a828902011-04-28 11:28:53 -07003134 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3135 if (!conn)
3136 goto unlock;
3137
3138 loc_mitm = (conn->auth_type & 0x01);
3139 rem_mitm = (conn->remote_auth & 0x01);
3140
3141 /* If we require MITM but the remote device can't provide that
3142 * (it has NoInputNoOutput) then reject the confirmation
3143 * request. The only exception is when we're dedicated bonding
3144 * initiators (connect_cfm_cb set) since then we always have the MITM
3145 * bit set. */
Mikel Astiza7676312013-06-28 10:56:29 +02003146 if (!conn->connect_cfm_cb && loc_mitm &&
3147 conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
Johan Hedberg7a828902011-04-28 11:28:53 -07003148 BT_DBG("Rejecting request: remote device can't provide MITM");
3149 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003150 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003151 goto unlock;
3152 }
3153
3154 /* If no side requires MITM protection; auto-accept */
Mikel Astiza7676312013-06-28 10:56:29 +02003155 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
3156 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003157
3158 /* If we're not the initiators request authorization to
3159 * proceed from user space (mgmt_user_confirm with
3160 * confirm_hint set to 1). */
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003161 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003162 BT_DBG("Confirming auto-accept as acceptor");
3163 confirm_hint = 1;
3164 goto confirm;
3165 }
3166
Johan Hedberg9f616562011-04-28 11:28:54 -07003167 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03003168 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003169
3170 if (hdev->auto_accept_delay > 0) {
3171 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
3172 mod_timer(&conn->auto_accept_timer, jiffies + delay);
3173 goto unlock;
3174 }
3175
Johan Hedberg7a828902011-04-28 11:28:53 -07003176 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003177 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003178 goto unlock;
3179 }
3180
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003181confirm:
Johan Hedberg272d90d2012-02-09 15:26:12 +02003182 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0, ev->passkey,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003183 confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07003184
3185unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03003186 hci_dev_unlock(hdev);
3187}
3188
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003189static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3190 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08003191{
3192 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3193
3194 BT_DBG("%s", hdev->name);
3195
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003196 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02003197 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08003198}
3199
Johan Hedberg92a25252012-09-06 18:39:26 +03003200static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3201 struct sk_buff *skb)
3202{
3203 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3204 struct hci_conn *conn;
3205
3206 BT_DBG("%s", hdev->name);
3207
3208 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3209 if (!conn)
3210 return;
3211
3212 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3213 conn->passkey_entered = 0;
3214
3215 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3216 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3217 conn->dst_type, conn->passkey_notify,
3218 conn->passkey_entered);
3219}
3220
3221static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3222{
3223 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3224 struct hci_conn *conn;
3225
3226 BT_DBG("%s", hdev->name);
3227
3228 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3229 if (!conn)
3230 return;
3231
3232 switch (ev->type) {
3233 case HCI_KEYPRESS_STARTED:
3234 conn->passkey_entered = 0;
3235 return;
3236
3237 case HCI_KEYPRESS_ENTERED:
3238 conn->passkey_entered++;
3239 break;
3240
3241 case HCI_KEYPRESS_ERASED:
3242 conn->passkey_entered--;
3243 break;
3244
3245 case HCI_KEYPRESS_CLEARED:
3246 conn->passkey_entered = 0;
3247 break;
3248
3249 case HCI_KEYPRESS_COMPLETED:
3250 return;
3251 }
3252
3253 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3254 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3255 conn->dst_type, conn->passkey_notify,
3256 conn->passkey_entered);
3257}
3258
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003259static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3260 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003261{
3262 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3263 struct hci_conn *conn;
3264
3265 BT_DBG("%s", hdev->name);
3266
3267 hci_dev_lock(hdev);
3268
3269 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003270 if (!conn)
3271 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003272
Johan Hedberg2a611692011-02-19 12:06:00 -03003273 /* To avoid duplicate auth_failed events to user space we check
3274 * the HCI_CONN_AUTH_PEND flag which will be set if we
3275 * initiated the authentication. A traditional auth_complete
3276 * event gets always produced as initiator and is also mapped to
3277 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02003278 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003279 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003280 ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003281
David Herrmann76a68ba2013-04-06 20:28:37 +02003282 hci_conn_drop(conn);
Johan Hedberg2a611692011-02-19 12:06:00 -03003283
3284unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003285 hci_dev_unlock(hdev);
3286}
3287
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003288static void hci_remote_host_features_evt(struct hci_dev *hdev,
3289 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003290{
3291 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3292 struct inquiry_entry *ie;
Johan Hedbergcad718e2013-04-17 15:00:51 +03003293 struct hci_conn *conn;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003294
3295 BT_DBG("%s", hdev->name);
3296
3297 hci_dev_lock(hdev);
3298
Johan Hedbergcad718e2013-04-17 15:00:51 +03003299 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3300 if (conn)
3301 memcpy(conn->features[1], ev->features, 8);
3302
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003303 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3304 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003305 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003306
3307 hci_dev_unlock(hdev);
3308}
3309
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003310static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3311 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01003312{
3313 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3314 struct oob_data *data;
3315
3316 BT_DBG("%s", hdev->name);
3317
3318 hci_dev_lock(hdev);
3319
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003320 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Szymon Jance1ba1f12011-04-06 13:01:59 +02003321 goto unlock;
3322
Szymon Janc2763eda2011-03-22 13:12:22 +01003323 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3324 if (data) {
3325 struct hci_cp_remote_oob_data_reply cp;
3326
3327 bacpy(&cp.bdaddr, &ev->bdaddr);
3328 memcpy(cp.hash, data->hash, sizeof(cp.hash));
3329 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
3330
3331 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003332 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003333 } else {
3334 struct hci_cp_remote_oob_data_neg_reply cp;
3335
3336 bacpy(&cp.bdaddr, &ev->bdaddr);
3337 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03003338 &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003339 }
3340
Szymon Jance1ba1f12011-04-06 13:01:59 +02003341unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003342 hci_dev_unlock(hdev);
3343}
3344
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003345static void hci_phy_link_complete_evt(struct hci_dev *hdev,
3346 struct sk_buff *skb)
3347{
3348 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
3349 struct hci_conn *hcon, *bredr_hcon;
3350
3351 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
3352 ev->status);
3353
3354 hci_dev_lock(hdev);
3355
3356 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3357 if (!hcon) {
3358 hci_dev_unlock(hdev);
3359 return;
3360 }
3361
3362 if (ev->status) {
3363 hci_conn_del(hcon);
3364 hci_dev_unlock(hdev);
3365 return;
3366 }
3367
3368 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
3369
3370 hcon->state = BT_CONNECTED;
3371 bacpy(&hcon->dst, &bredr_hcon->dst);
3372
3373 hci_conn_hold(hcon);
3374 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003375 hci_conn_drop(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003376
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003377 hci_conn_add_sysfs(hcon);
3378
Andrei Emeltchenkocf70ff22012-10-31 15:46:36 +02003379 amp_physical_cfm(bredr_hcon, hcon);
3380
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003381 hci_dev_unlock(hdev);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003382}
3383
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003384static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3385{
3386 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
3387 struct hci_conn *hcon;
3388 struct hci_chan *hchan;
3389 struct amp_mgr *mgr;
3390
3391 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
3392 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
3393 ev->status);
3394
3395 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3396 if (!hcon)
3397 return;
3398
3399 /* Create AMP hchan */
3400 hchan = hci_chan_create(hcon);
3401 if (!hchan)
3402 return;
3403
3404 hchan->handle = le16_to_cpu(ev->handle);
3405
3406 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
3407
3408 mgr = hcon->amp_mgr;
3409 if (mgr && mgr->bredr_chan) {
3410 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
3411
3412 l2cap_chan_lock(bredr_chan);
3413
3414 bredr_chan->conn->mtu = hdev->block_mtu;
3415 l2cap_logical_cfm(bredr_chan, hchan, 0);
3416 hci_conn_hold(hcon);
3417
3418 l2cap_chan_unlock(bredr_chan);
3419 }
3420}
3421
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003422static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
3423 struct sk_buff *skb)
3424{
3425 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
3426 struct hci_chan *hchan;
3427
3428 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
3429 le16_to_cpu(ev->handle), ev->status);
3430
3431 if (ev->status)
3432 return;
3433
3434 hci_dev_lock(hdev);
3435
3436 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
3437 if (!hchan)
3438 goto unlock;
3439
3440 amp_destroy_logical_link(hchan, ev->reason);
3441
3442unlock:
3443 hci_dev_unlock(hdev);
3444}
3445
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003446static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
3447 struct sk_buff *skb)
3448{
3449 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
3450 struct hci_conn *hcon;
3451
3452 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3453
3454 if (ev->status)
3455 return;
3456
3457 hci_dev_lock(hdev);
3458
3459 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3460 if (hcon) {
3461 hcon->state = BT_CLOSED;
3462 hci_conn_del(hcon);
3463 }
3464
3465 hci_dev_unlock(hdev);
3466}
3467
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003468static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003469{
3470 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3471 struct hci_conn *conn;
3472
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003473 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003474
3475 hci_dev_lock(hdev);
3476
Andre Guedesb47a09b2012-07-27 15:10:15 -03003477 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03003478 if (!conn) {
3479 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
3480 if (!conn) {
3481 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03003482 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03003483 }
Andre Guedes29b79882011-05-31 14:20:54 -03003484
3485 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03003486
3487 if (ev->role == LE_CONN_ROLE_MASTER) {
3488 conn->out = true;
3489 conn->link_mode |= HCI_LM_MASTER;
3490 }
Ville Tervob62f3282011-02-10 22:38:50 -03003491 }
Ville Tervofcd89c02011-02-10 22:38:47 -03003492
Andre Guedescd17dec2012-07-27 15:10:16 -03003493 if (ev->status) {
3494 mgmt_connect_failed(hdev, &conn->dst, conn->type,
3495 conn->dst_type, ev->status);
3496 hci_proto_connect_cfm(conn, ev->status);
3497 conn->state = BT_CLOSED;
3498 hci_conn_del(conn);
3499 goto unlock;
3500 }
3501
Johan Hedbergb644ba32012-01-17 21:48:47 +02003502 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3503 mgmt_device_connected(hdev, &ev->bdaddr, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003504 conn->dst_type, 0, NULL, 0, NULL);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03003505
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03003506 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03003507 conn->handle = __le16_to_cpu(ev->handle);
3508 conn->state = BT_CONNECTED;
3509
Ville Tervofcd89c02011-02-10 22:38:47 -03003510 hci_conn_add_sysfs(conn);
3511
3512 hci_proto_connect_cfm(conn, ev->status);
3513
3514unlock:
3515 hci_dev_unlock(hdev);
3516}
3517
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003518static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03003519{
Andre Guedese95beb42011-09-26 20:48:35 -03003520 u8 num_reports = skb->data[0];
3521 void *ptr = &skb->data[1];
Andre Guedes3c9e9192012-01-10 18:20:50 -03003522 s8 rssi;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003523
Andre Guedese95beb42011-09-26 20:48:35 -03003524 while (num_reports--) {
3525 struct hci_ev_le_advertising_info *ev = ptr;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003526
Andre Guedes3c9e9192012-01-10 18:20:50 -03003527 rssi = ev->data[ev->length];
3528 mgmt_device_found(hdev, &ev->bdaddr, LE_LINK, ev->bdaddr_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003529 NULL, rssi, 0, 1, ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03003530
Andre Guedese95beb42011-09-26 20:48:35 -03003531 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03003532 }
Andre Guedes9aa04c92011-05-26 16:23:51 -03003533}
3534
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003535static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003536{
3537 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
3538 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003539 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003540 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003541 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003542
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003543 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003544
3545 hci_dev_lock(hdev);
3546
3547 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003548 if (conn == NULL)
3549 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003550
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003551 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
3552 if (ltk == NULL)
3553 goto not_found;
3554
3555 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003556 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003557
3558 if (ltk->authenticated)
3559 conn->sec_level = BT_SECURITY_HIGH;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003560
3561 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
3562
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03003563 if (ltk->type & HCI_SMP_STK) {
3564 list_del(&ltk->list);
3565 kfree(ltk);
3566 }
3567
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003568 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03003569
3570 return;
3571
3572not_found:
3573 neg.handle = ev->handle;
3574 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
3575 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003576}
3577
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003578static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003579{
3580 struct hci_ev_le_meta *le_ev = (void *) skb->data;
3581
3582 skb_pull(skb, sizeof(*le_ev));
3583
3584 switch (le_ev->subevent) {
3585 case HCI_EV_LE_CONN_COMPLETE:
3586 hci_le_conn_complete_evt(hdev, skb);
3587 break;
3588
Andre Guedes9aa04c92011-05-26 16:23:51 -03003589 case HCI_EV_LE_ADVERTISING_REPORT:
3590 hci_le_adv_report_evt(hdev, skb);
3591 break;
3592
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03003593 case HCI_EV_LE_LTK_REQ:
3594 hci_le_ltk_request_evt(hdev, skb);
3595 break;
3596
Ville Tervofcd89c02011-02-10 22:38:47 -03003597 default:
3598 break;
3599 }
3600}
3601
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03003602static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
3603{
3604 struct hci_ev_channel_selected *ev = (void *) skb->data;
3605 struct hci_conn *hcon;
3606
3607 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
3608
3609 skb_pull(skb, sizeof(*ev));
3610
3611 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3612 if (!hcon)
3613 return;
3614
3615 amp_read_loc_assoc_final_data(hdev, hcon);
3616}
3617
Linus Torvalds1da177e2005-04-16 15:20:36 -07003618void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
3619{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003620 struct hci_event_hdr *hdr = (void *) skb->data;
3621 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003622
Johan Hedbergb6ddb632013-04-02 13:34:31 +03003623 hci_dev_lock(hdev);
3624
3625 /* Received events are (currently) only needed when a request is
3626 * ongoing so avoid unnecessary memory allocation.
3627 */
3628 if (hdev->req_status == HCI_REQ_PEND) {
3629 kfree_skb(hdev->recv_evt);
3630 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
3631 }
3632
3633 hci_dev_unlock(hdev);
3634
Linus Torvalds1da177e2005-04-16 15:20:36 -07003635 skb_pull(skb, HCI_EVENT_HDR_SIZE);
3636
Johan Hedberg02350a72013-04-03 21:50:29 +03003637 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
3638 struct hci_command_hdr *hdr = (void *) hdev->sent_cmd->data;
3639 u16 opcode = __le16_to_cpu(hdr->opcode);
3640
3641 hci_req_cmd_complete(hdev, opcode, 0);
3642 }
3643
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003644 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003645 case HCI_EV_INQUIRY_COMPLETE:
3646 hci_inquiry_complete_evt(hdev, skb);
3647 break;
3648
3649 case HCI_EV_INQUIRY_RESULT:
3650 hci_inquiry_result_evt(hdev, skb);
3651 break;
3652
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003653 case HCI_EV_CONN_COMPLETE:
3654 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02003655 break;
3656
Linus Torvalds1da177e2005-04-16 15:20:36 -07003657 case HCI_EV_CONN_REQUEST:
3658 hci_conn_request_evt(hdev, skb);
3659 break;
3660
Linus Torvalds1da177e2005-04-16 15:20:36 -07003661 case HCI_EV_DISCONN_COMPLETE:
3662 hci_disconn_complete_evt(hdev, skb);
3663 break;
3664
Linus Torvalds1da177e2005-04-16 15:20:36 -07003665 case HCI_EV_AUTH_COMPLETE:
3666 hci_auth_complete_evt(hdev, skb);
3667 break;
3668
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003669 case HCI_EV_REMOTE_NAME:
3670 hci_remote_name_evt(hdev, skb);
3671 break;
3672
Linus Torvalds1da177e2005-04-16 15:20:36 -07003673 case HCI_EV_ENCRYPT_CHANGE:
3674 hci_encrypt_change_evt(hdev, skb);
3675 break;
3676
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003677 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3678 hci_change_link_key_complete_evt(hdev, skb);
3679 break;
3680
3681 case HCI_EV_REMOTE_FEATURES:
3682 hci_remote_features_evt(hdev, skb);
3683 break;
3684
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003685 case HCI_EV_CMD_COMPLETE:
3686 hci_cmd_complete_evt(hdev, skb);
3687 break;
3688
3689 case HCI_EV_CMD_STATUS:
3690 hci_cmd_status_evt(hdev, skb);
3691 break;
3692
3693 case HCI_EV_ROLE_CHANGE:
3694 hci_role_change_evt(hdev, skb);
3695 break;
3696
3697 case HCI_EV_NUM_COMP_PKTS:
3698 hci_num_comp_pkts_evt(hdev, skb);
3699 break;
3700
3701 case HCI_EV_MODE_CHANGE:
3702 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003703 break;
3704
3705 case HCI_EV_PIN_CODE_REQ:
3706 hci_pin_code_request_evt(hdev, skb);
3707 break;
3708
3709 case HCI_EV_LINK_KEY_REQ:
3710 hci_link_key_request_evt(hdev, skb);
3711 break;
3712
3713 case HCI_EV_LINK_KEY_NOTIFY:
3714 hci_link_key_notify_evt(hdev, skb);
3715 break;
3716
3717 case HCI_EV_CLOCK_OFFSET:
3718 hci_clock_offset_evt(hdev, skb);
3719 break;
3720
Marcel Holtmanna8746412008-07-14 20:13:46 +02003721 case HCI_EV_PKT_TYPE_CHANGE:
3722 hci_pkt_type_change_evt(hdev, skb);
3723 break;
3724
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003725 case HCI_EV_PSCAN_REP_MODE:
3726 hci_pscan_rep_mode_evt(hdev, skb);
3727 break;
3728
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003729 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3730 hci_inquiry_result_with_rssi_evt(hdev, skb);
3731 break;
3732
3733 case HCI_EV_REMOTE_EXT_FEATURES:
3734 hci_remote_ext_features_evt(hdev, skb);
3735 break;
3736
3737 case HCI_EV_SYNC_CONN_COMPLETE:
3738 hci_sync_conn_complete_evt(hdev, skb);
3739 break;
3740
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003741 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3742 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003743 break;
3744
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003745 case HCI_EV_KEY_REFRESH_COMPLETE:
3746 hci_key_refresh_complete_evt(hdev, skb);
3747 break;
3748
Marcel Holtmann04936842008-07-14 20:13:48 +02003749 case HCI_EV_IO_CAPA_REQUEST:
3750 hci_io_capa_request_evt(hdev, skb);
3751 break;
3752
Johan Hedberg03b555e2011-01-04 15:40:05 +02003753 case HCI_EV_IO_CAPA_REPLY:
3754 hci_io_capa_reply_evt(hdev, skb);
3755 break;
3756
Johan Hedberga5c29682011-02-19 12:05:57 -03003757 case HCI_EV_USER_CONFIRM_REQUEST:
3758 hci_user_confirm_request_evt(hdev, skb);
3759 break;
3760
Brian Gix1143d452011-11-23 08:28:34 -08003761 case HCI_EV_USER_PASSKEY_REQUEST:
3762 hci_user_passkey_request_evt(hdev, skb);
3763 break;
3764
Johan Hedberg92a25252012-09-06 18:39:26 +03003765 case HCI_EV_USER_PASSKEY_NOTIFY:
3766 hci_user_passkey_notify_evt(hdev, skb);
3767 break;
3768
3769 case HCI_EV_KEYPRESS_NOTIFY:
3770 hci_keypress_notify_evt(hdev, skb);
3771 break;
3772
Marcel Holtmann04936842008-07-14 20:13:48 +02003773 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3774 hci_simple_pair_complete_evt(hdev, skb);
3775 break;
3776
Marcel Holtmann41a96212008-07-14 20:13:48 +02003777 case HCI_EV_REMOTE_HOST_FEATURES:
3778 hci_remote_host_features_evt(hdev, skb);
3779 break;
3780
Ville Tervofcd89c02011-02-10 22:38:47 -03003781 case HCI_EV_LE_META:
3782 hci_le_meta_evt(hdev, skb);
3783 break;
3784
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03003785 case HCI_EV_CHANNEL_SELECTED:
3786 hci_chan_selected_evt(hdev, skb);
3787 break;
3788
Szymon Janc2763eda2011-03-22 13:12:22 +01003789 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3790 hci_remote_oob_data_request_evt(hdev, skb);
3791 break;
3792
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003793 case HCI_EV_PHY_LINK_COMPLETE:
3794 hci_phy_link_complete_evt(hdev, skb);
3795 break;
3796
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003797 case HCI_EV_LOGICAL_LINK_COMPLETE:
3798 hci_loglink_complete_evt(hdev, skb);
3799 break;
3800
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003801 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
3802 hci_disconn_loglink_complete_evt(hdev, skb);
3803 break;
3804
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003805 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
3806 hci_disconn_phylink_complete_evt(hdev, skb);
3807 break;
3808
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003809 case HCI_EV_NUM_COMP_BLOCKS:
3810 hci_num_comp_blocks_evt(hdev, skb);
3811 break;
3812
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003813 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003814 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003815 break;
3816 }
3817
3818 kfree_skb(skb);
3819 hdev->stat.evt_rx++;
3820}