blob: 15a0a65bf4471c522eab188385dd9a74356d737c [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>
Marcel Holtmann7ef9fbf2013-10-10 14:54:14 -070032
Marcel Holtmann70247282013-10-10 14:54:15 -070033#include "a2mp.h"
Marcel Holtmann7ef9fbf2013-10-10 14:54:14 -070034#include "amp.h"
Johan Hedberg2ceba532014-06-16 19:25:16 +030035#include "smp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070036
Linus Torvalds1da177e2005-04-16 15:20:36 -070037/* Handle HCI Event packets */
38
Marcel Holtmanna9de9242007-10-20 13:33:56 +020039static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070040{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020041 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030043 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
Andre Guedes82f47852013-04-30 15:29:34 -030045 if (status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020046 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
Andre Guedes89352e72011-11-04 14:16:53 -030048 clear_bit(HCI_INQUIRY, &hdev->flags);
Peter Zijlstra4e857c52014-03-17 18:06:10 +010049 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
Andre Guedes3e13fa12013-03-27 20:04:56 -030050 wake_up_bit(&hdev->flags, HCI_INQUIRY);
Andre Guedes89352e72011-11-04 14:16:53 -030051
Johan Hedberg50143a42014-06-10 14:05:57 +030052 hci_dev_lock(hdev);
53 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
54 hci_dev_unlock(hdev);
55
Marcel Holtmanna9de9242007-10-20 13:33:56 +020056 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070057}
58
Andre Guedes4d934832012-03-21 00:03:35 -030059static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
60{
61 __u8 status = *((__u8 *) skb->data);
62
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030063 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesae854a72012-03-21 00:03:36 -030064
65 if (status)
66 return;
67
68 set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
Andre Guedes4d934832012-03-21 00:03:35 -030069}
70
Marcel Holtmanna9de9242007-10-20 13:33:56 +020071static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070072{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020073 __u8 status = *((__u8 *) skb->data);
74
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030075 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020076
77 if (status)
78 return;
79
Andre Guedesae854a72012-03-21 00:03:36 -030080 clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
81
Marcel Holtmanna9de9242007-10-20 13:33:56 +020082 hci_conn_check_pending(hdev);
83}
84
Gustavo Padovan807deac2012-05-17 00:36:24 -030085static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
86 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020087{
88 BT_DBG("%s", hdev->name);
89}
90
91static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
92{
93 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030096 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070097
Marcel Holtmanna9de9242007-10-20 13:33:56 +020098 if (rp->status)
99 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200101 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200103 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
104 if (conn) {
105 if (rp->role)
106 conn->link_mode &= ~HCI_LM_MASTER;
107 else
108 conn->link_mode |= HCI_LM_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200110
111 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112}
113
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200114static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
115{
116 struct hci_rp_read_link_policy *rp = (void *) skb->data;
117 struct hci_conn *conn;
118
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300119 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200120
121 if (rp->status)
122 return;
123
124 hci_dev_lock(hdev);
125
126 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
127 if (conn)
128 conn->link_policy = __le16_to_cpu(rp->policy);
129
130 hci_dev_unlock(hdev);
131}
132
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200133static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200135 struct hci_rp_write_link_policy *rp = (void *) skb->data;
136 struct hci_conn *conn;
137 void *sent;
138
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300139 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200140
141 if (rp->status)
142 return;
143
144 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
145 if (!sent)
146 return;
147
148 hci_dev_lock(hdev);
149
150 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200151 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700152 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200153
154 hci_dev_unlock(hdev);
155}
156
Gustavo Padovan807deac2012-05-17 00:36:24 -0300157static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
158 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200159{
160 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
161
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300162 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200163
164 if (rp->status)
165 return;
166
167 hdev->link_policy = __le16_to_cpu(rp->policy);
168}
169
Gustavo Padovan807deac2012-05-17 00:36:24 -0300170static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
171 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200172{
173 __u8 status = *((__u8 *) skb->data);
174 void *sent;
175
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300176 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200177
178 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
179 if (!sent)
180 return;
181
182 if (!status)
183 hdev->link_policy = get_unaligned_le16(sent);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200184}
185
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200186static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
187{
188 __u8 status = *((__u8 *) skb->data);
189
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300190 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200191
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300192 clear_bit(HCI_RESET, &hdev->flags);
193
Johan Hedberga297e972012-02-21 17:55:47 +0200194 /* Reset all non-persistent flags */
Johan Hedberg2cc6fb02013-03-15 17:06:57 -0500195 hdev->dev_flags &= ~HCI_PERSISTENT_MASK;
Andre Guedes69775ff2012-02-23 16:50:05 +0200196
197 hdev->discovery.state = DISCOVERY_STOPPED;
Johan Hedbergbbaf4442012-11-08 01:22:59 +0100198 hdev->inq_tx_power = HCI_TX_POWER_INVALID;
199 hdev->adv_tx_power = HCI_TX_POWER_INVALID;
Johan Hedberg3f0f5242012-11-08 01:23:00 +0100200
201 memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
202 hdev->adv_data_len = 0;
Marcel Holtmannf8e808b2013-10-16 00:16:47 -0700203
204 memset(hdev->scan_rsp_data, 0, sizeof(hdev->scan_rsp_data));
205 hdev->scan_rsp_data_len = 0;
Marcel Holtmann06f5b772013-10-19 07:09:11 -0700206
Marcel Holtmann533553f2014-03-21 12:18:10 -0700207 hdev->le_scan_type = LE_SCAN_PASSIVE;
208
Marcel Holtmann06f5b772013-10-19 07:09:11 -0700209 hdev->ssp_debug_mode = 0;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200210}
211
212static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
213{
214 __u8 status = *((__u8 *) skb->data);
215 void *sent;
216
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300217 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200218
219 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
220 if (!sent)
221 return;
222
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200223 hci_dev_lock(hdev);
224
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200225 if (test_bit(HCI_MGMT, &hdev->dev_flags))
226 mgmt_set_local_name_complete(hdev, sent, status);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +0200227 else if (!status)
228 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200229
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200230 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200231}
232
233static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
234{
235 struct hci_rp_read_local_name *rp = (void *) skb->data;
236
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300237 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200238
239 if (rp->status)
240 return;
241
Johan Hedbergdb99b5f2012-02-22 20:14:22 +0200242 if (test_bit(HCI_SETUP, &hdev->dev_flags))
243 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200244}
245
246static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
247{
248 __u8 status = *((__u8 *) skb->data);
249 void *sent;
250
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300251 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200252
253 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
254 if (!sent)
255 return;
256
257 if (!status) {
258 __u8 param = *((__u8 *) sent);
259
260 if (param == AUTH_ENABLED)
261 set_bit(HCI_AUTH, &hdev->flags);
262 else
263 clear_bit(HCI_AUTH, &hdev->flags);
264 }
265
Johan Hedberg33ef95e2012-02-16 23:56:27 +0200266 if (test_bit(HCI_MGMT, &hdev->dev_flags))
267 mgmt_auth_enable_complete(hdev, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200268}
269
270static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
271{
272 __u8 status = *((__u8 *) skb->data);
273 void *sent;
274
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300275 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200276
277 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
278 if (!sent)
279 return;
280
281 if (!status) {
282 __u8 param = *((__u8 *) sent);
283
284 if (param)
285 set_bit(HCI_ENCRYPT, &hdev->flags);
286 else
287 clear_bit(HCI_ENCRYPT, &hdev->flags);
288 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200289}
290
291static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
292{
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200293 __u8 param, status = *((__u8 *) skb->data);
294 int old_pscan, old_iscan;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200295 void *sent;
296
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300297 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200298
299 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
300 if (!sent)
301 return;
302
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200303 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200304
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200305 hci_dev_lock(hdev);
306
Mikel Astizfa1bd912012-08-09 09:52:29 +0200307 if (status) {
Johan Hedberg744cf192011-11-08 20:40:14 +0200308 mgmt_write_scan_failed(hdev, param, status);
Johan Hedberg2d7cee52011-11-07 22:16:03 +0200309 hdev->discov_timeout = 0;
310 goto done;
311 }
312
Johan Hedberg0663ca22013-10-02 13:43:14 +0300313 /* We need to ensure that we set this back on if someone changed
314 * the scan mode through a raw HCI socket.
315 */
316 set_bit(HCI_BREDR_ENABLED, &hdev->dev_flags);
317
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200318 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
319 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200320
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200321 if (param & SCAN_INQUIRY) {
322 set_bit(HCI_ISCAN, &hdev->flags);
323 if (!old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200324 mgmt_discoverable(hdev, 1);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200325 } else if (old_iscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200326 mgmt_discoverable(hdev, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200327
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200328 if (param & SCAN_PAGE) {
329 set_bit(HCI_PSCAN, &hdev->flags);
330 if (!old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200331 mgmt_connectable(hdev, 1);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200332 } else if (old_pscan)
Johan Hedberg744cf192011-11-08 20:40:14 +0200333 mgmt_connectable(hdev, 0);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200334
335done:
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200336 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200337}
338
339static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
340{
341 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
342
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300343 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200344
345 if (rp->status)
346 return;
347
348 memcpy(hdev->dev_class, rp->dev_class, 3);
349
350 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300351 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200352}
353
354static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
355{
356 __u8 status = *((__u8 *) skb->data);
357 void *sent;
358
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300359 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200360
361 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
362 if (!sent)
363 return;
364
Marcel Holtmann7f9a9032012-02-22 18:38:01 +0100365 hci_dev_lock(hdev);
366
367 if (status == 0)
368 memcpy(hdev->dev_class, sent, 3);
369
370 if (test_bit(HCI_MGMT, &hdev->dev_flags))
371 mgmt_set_class_of_dev_complete(hdev, sent, status);
372
373 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200374}
375
376static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
377{
378 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200380
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300381 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200382
383 if (rp->status)
384 return;
385
386 setting = __le16_to_cpu(rp->voice_setting);
387
Marcel Holtmannf383f272008-07-14 20:13:47 +0200388 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200389 return;
390
391 hdev->voice_setting = setting;
392
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300393 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200394
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200395 if (hdev->notify)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200396 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200397}
398
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300399static void hci_cc_write_voice_setting(struct hci_dev *hdev,
400 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200401{
402 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200403 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 void *sent;
405
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300406 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
Marcel Holtmannf383f272008-07-14 20:13:47 +0200408 if (status)
409 return;
410
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200411 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
412 if (!sent)
413 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414
Marcel Holtmannf383f272008-07-14 20:13:47 +0200415 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416
Marcel Holtmannf383f272008-07-14 20:13:47 +0200417 if (hdev->voice_setting == setting)
418 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419
Marcel Holtmannf383f272008-07-14 20:13:47 +0200420 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300422 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200423
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200424 if (hdev->notify)
Marcel Holtmannf383f272008-07-14 20:13:47 +0200425 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426}
427
Marcel Holtmannb4cb9fb2013-10-14 13:56:16 -0700428static void hci_cc_read_num_supported_iac(struct hci_dev *hdev,
429 struct sk_buff *skb)
430{
431 struct hci_rp_read_num_supported_iac *rp = (void *) skb->data;
432
433 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
434
435 if (rp->status)
436 return;
437
438 hdev->num_iac = rp->num_iac;
439
440 BT_DBG("%s num iac %d", hdev->name, hdev->num_iac);
441}
442
Marcel Holtmann333140b2008-07-14 20:13:48 +0200443static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
444{
445 __u8 status = *((__u8 *) skb->data);
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300446 struct hci_cp_write_ssp_mode *sent;
Marcel Holtmann333140b2008-07-14 20:13:48 +0200447
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300448 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann333140b2008-07-14 20:13:48 +0200449
Marcel Holtmann333140b2008-07-14 20:13:48 +0200450 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
451 if (!sent)
452 return;
453
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300454 if (!status) {
455 if (sent->mode)
Johan Hedbergcad718e2013-04-17 15:00:51 +0300456 hdev->features[1][0] |= LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300457 else
Johan Hedbergcad718e2013-04-17 15:00:51 +0300458 hdev->features[1][0] &= ~LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300459 }
460
Johan Hedberged2c4ee2012-02-17 00:56:28 +0200461 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300462 mgmt_ssp_enable_complete(hdev, sent->mode, status);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200463 else if (!status) {
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300464 if (sent->mode)
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200465 set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
466 else
467 clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
468 }
Marcel Holtmann333140b2008-07-14 20:13:48 +0200469}
470
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800471static void hci_cc_write_sc_support(struct hci_dev *hdev, struct sk_buff *skb)
472{
473 u8 status = *((u8 *) skb->data);
474 struct hci_cp_write_sc_support *sent;
475
476 BT_DBG("%s status 0x%2.2x", hdev->name, status);
477
478 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SC_SUPPORT);
479 if (!sent)
480 return;
481
482 if (!status) {
483 if (sent->support)
484 hdev->features[1][0] |= LMP_HOST_SC;
485 else
486 hdev->features[1][0] &= ~LMP_HOST_SC;
487 }
488
489 if (test_bit(HCI_MGMT, &hdev->dev_flags))
490 mgmt_sc_enable_complete(hdev, sent->support, status);
491 else if (!status) {
492 if (sent->support)
493 set_bit(HCI_SC_ENABLED, &hdev->dev_flags);
494 else
495 clear_bit(HCI_SC_ENABLED, &hdev->dev_flags);
496 }
497}
498
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200499static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
500{
501 struct hci_rp_read_local_version *rp = (void *) skb->data;
502
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300503 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200504
505 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200506 return;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200507
Marcel Holtmann0d5551f2013-10-18 12:04:50 -0700508 if (test_bit(HCI_SETUP, &hdev->dev_flags)) {
509 hdev->hci_ver = rp->hci_ver;
510 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
511 hdev->lmp_ver = rp->lmp_ver;
512 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
513 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
514 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200515}
516
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300517static void hci_cc_read_local_commands(struct hci_dev *hdev,
518 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200519{
520 struct hci_rp_read_local_commands *rp = (void *) skb->data;
521
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300522 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200523
Marcel Holtmann6a070e62013-10-31 04:54:33 -0700524 if (rp->status)
525 return;
526
527 if (test_bit(HCI_SETUP, &hdev->dev_flags))
Johan Hedberg2177bab2013-03-05 20:37:43 +0200528 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200529}
530
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300531static void hci_cc_read_local_features(struct hci_dev *hdev,
532 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200533{
534 struct hci_rp_read_local_features *rp = (void *) skb->data;
535
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300536 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200537
538 if (rp->status)
539 return;
540
541 memcpy(hdev->features, rp->features, 8);
542
543 /* Adjust default settings according to features
544 * supported by device. */
545
Johan Hedbergcad718e2013-04-17 15:00:51 +0300546 if (hdev->features[0][0] & LMP_3SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200547 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
548
Johan Hedbergcad718e2013-04-17 15:00:51 +0300549 if (hdev->features[0][0] & LMP_5SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200550 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
551
Johan Hedbergcad718e2013-04-17 15:00:51 +0300552 if (hdev->features[0][1] & LMP_HV2) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200553 hdev->pkt_type |= (HCI_HV2);
554 hdev->esco_type |= (ESCO_HV2);
555 }
556
Johan Hedbergcad718e2013-04-17 15:00:51 +0300557 if (hdev->features[0][1] & LMP_HV3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200558 hdev->pkt_type |= (HCI_HV3);
559 hdev->esco_type |= (ESCO_HV3);
560 }
561
Andre Guedes45db810f2012-07-24 15:03:49 -0300562 if (lmp_esco_capable(hdev))
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200563 hdev->esco_type |= (ESCO_EV3);
564
Johan Hedbergcad718e2013-04-17 15:00:51 +0300565 if (hdev->features[0][4] & LMP_EV4)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200566 hdev->esco_type |= (ESCO_EV4);
567
Johan Hedbergcad718e2013-04-17 15:00:51 +0300568 if (hdev->features[0][4] & LMP_EV5)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200569 hdev->esco_type |= (ESCO_EV5);
570
Johan Hedbergcad718e2013-04-17 15:00:51 +0300571 if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100572 hdev->esco_type |= (ESCO_2EV3);
573
Johan Hedbergcad718e2013-04-17 15:00:51 +0300574 if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100575 hdev->esco_type |= (ESCO_3EV3);
576
Johan Hedbergcad718e2013-04-17 15:00:51 +0300577 if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100578 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200579}
580
Andre Guedes971e3a42011-06-30 19:20:52 -0300581static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300582 struct sk_buff *skb)
Andre Guedes971e3a42011-06-30 19:20:52 -0300583{
584 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
585
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300586 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andre Guedes971e3a42011-06-30 19:20:52 -0300587
588 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200589 return;
Andre Guedes971e3a42011-06-30 19:20:52 -0300590
Marcel Holtmann57af75a2013-10-18 12:04:47 -0700591 if (hdev->max_page < rp->max_page)
592 hdev->max_page = rp->max_page;
Johan Hedbergd2c5d772013-04-17 15:00:52 +0300593
Johan Hedbergcad718e2013-04-17 15:00:51 +0300594 if (rp->page < HCI_MAX_PAGES)
595 memcpy(hdev->features[rp->page], rp->features, 8);
Andre Guedes971e3a42011-06-30 19:20:52 -0300596}
597
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200598static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300599 struct sk_buff *skb)
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200600{
601 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
602
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300603 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200604
Johan Hedberg42c6b122013-03-05 20:37:49 +0200605 if (!rp->status)
606 hdev->flow_ctl_mode = rp->mode;
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200607}
608
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200609static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
610{
611 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
612
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300613 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200614
615 if (rp->status)
616 return;
617
618 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
619 hdev->sco_mtu = rp->sco_mtu;
620 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
621 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
622
623 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
624 hdev->sco_mtu = 64;
625 hdev->sco_pkts = 8;
626 }
627
628 hdev->acl_cnt = hdev->acl_pkts;
629 hdev->sco_cnt = hdev->sco_pkts;
630
Gustavo Padovan807deac2012-05-17 00:36:24 -0300631 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
632 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200633}
634
635static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
636{
637 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
638
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300639 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200640
641 if (!rp->status)
642 bacpy(&hdev->bdaddr, &rp->bdaddr);
Johan Hedberg23bb5762010-12-21 23:01:27 +0200643}
644
Johan Hedbergf332ec62013-03-15 17:07:11 -0500645static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
646 struct sk_buff *skb)
647{
648 struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;
649
650 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
651
652 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status) {
653 hdev->page_scan_interval = __le16_to_cpu(rp->interval);
654 hdev->page_scan_window = __le16_to_cpu(rp->window);
655 }
656}
657
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500658static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
659 struct sk_buff *skb)
660{
661 u8 status = *((u8 *) skb->data);
662 struct hci_cp_write_page_scan_activity *sent;
663
664 BT_DBG("%s status 0x%2.2x", hdev->name, status);
665
666 if (status)
667 return;
668
669 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
670 if (!sent)
671 return;
672
673 hdev->page_scan_interval = __le16_to_cpu(sent->interval);
674 hdev->page_scan_window = __le16_to_cpu(sent->window);
675}
676
Johan Hedbergf332ec62013-03-15 17:07:11 -0500677static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
678 struct sk_buff *skb)
679{
680 struct hci_rp_read_page_scan_type *rp = (void *) skb->data;
681
682 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
683
684 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status)
685 hdev->page_scan_type = rp->type;
686}
687
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500688static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
689 struct sk_buff *skb)
690{
691 u8 status = *((u8 *) skb->data);
692 u8 *type;
693
694 BT_DBG("%s status 0x%2.2x", hdev->name, status);
695
696 if (status)
697 return;
698
699 type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
700 if (type)
701 hdev->page_scan_type = *type;
702}
703
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200704static void hci_cc_read_data_block_size(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300705 struct sk_buff *skb)
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200706{
707 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
708
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300709 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200710
711 if (rp->status)
712 return;
713
714 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
715 hdev->block_len = __le16_to_cpu(rp->block_len);
716 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
717
718 hdev->block_cnt = hdev->num_blocks;
719
720 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300721 hdev->block_cnt, hdev->block_len);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200722}
723
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300724static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300725 struct sk_buff *skb)
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300726{
727 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
728
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300729 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300730
731 if (rp->status)
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300732 goto a2mp_rsp;
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300733
734 hdev->amp_status = rp->amp_status;
735 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
736 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
737 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
738 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
739 hdev->amp_type = rp->amp_type;
740 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
741 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
742 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
743 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
744
Andrei Emeltchenko8e2a0d92012-09-27 17:26:08 +0300745a2mp_rsp:
746 a2mp_send_getinfo_rsp(hdev);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300747}
748
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300749static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
750 struct sk_buff *skb)
751{
752 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
753 struct amp_assoc *assoc = &hdev->loc_assoc;
754 size_t rem_len, frag_len;
755
756 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
757
758 if (rp->status)
759 goto a2mp_rsp;
760
761 frag_len = skb->len - sizeof(*rp);
762 rem_len = __le16_to_cpu(rp->rem_len);
763
764 if (rem_len > frag_len) {
Andrei Emeltchenko2e430be32012-09-28 14:44:23 +0300765 BT_DBG("frag_len %zu rem_len %zu", frag_len, rem_len);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300766
767 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
768 assoc->offset += frag_len;
769
770 /* Read other fragments */
771 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
772
773 return;
774 }
775
776 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
777 assoc->len = assoc->offset + rem_len;
778 assoc->offset = 0;
779
780a2mp_rsp:
781 /* Send A2MP Rsp when all fragments are received */
782 a2mp_send_getampassoc_rsp(hdev, rp->status);
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +0300783 a2mp_send_create_phy_link_req(hdev, rp->status);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300784}
785
Johan Hedbergd5859e22011-01-25 01:19:58 +0200786static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300787 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200788{
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700789 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200790
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300791 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200792
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700793 if (!rp->status)
794 hdev->inq_tx_power = rp->tx_power;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200795}
796
Johan Hedberg980e1a52011-01-22 06:10:07 +0200797static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
798{
799 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
800 struct hci_cp_pin_code_reply *cp;
801 struct hci_conn *conn;
802
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300803 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200804
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200805 hci_dev_lock(hdev);
806
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200807 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200808 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200809
Mikel Astizfa1bd912012-08-09 09:52:29 +0200810 if (rp->status)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200811 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200812
813 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
814 if (!cp)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200815 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200816
817 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
818 if (conn)
819 conn->pin_length = cp->pin_len;
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200820
821unlock:
822 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200823}
824
825static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
826{
827 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
828
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300829 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200830
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200831 hci_dev_lock(hdev);
832
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200833 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200834 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300835 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200836
837 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200838}
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200839
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300840static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
841 struct sk_buff *skb)
842{
843 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
844
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300845 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300846
847 if (rp->status)
848 return;
849
850 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
851 hdev->le_pkts = rp->le_max_pkt;
852
853 hdev->le_cnt = hdev->le_pkts;
854
855 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300856}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200857
Johan Hedberg60e77322013-01-22 14:01:59 +0200858static void hci_cc_le_read_local_features(struct hci_dev *hdev,
859 struct sk_buff *skb)
860{
861 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
862
863 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
864
865 if (!rp->status)
866 memcpy(hdev->le_features, rp->features, 8);
Johan Hedberg60e77322013-01-22 14:01:59 +0200867}
868
Johan Hedberg8fa19092012-10-19 20:57:49 +0300869static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
870 struct sk_buff *skb)
871{
872 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
873
874 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
875
Johan Hedberg04b4edc2013-03-15 17:07:01 -0500876 if (!rp->status)
Johan Hedberg8fa19092012-10-19 20:57:49 +0300877 hdev->adv_tx_power = rp->tx_power;
Johan Hedberg8fa19092012-10-19 20:57:49 +0300878}
879
Johan Hedberga5c29682011-02-19 12:05:57 -0300880static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
881{
882 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
883
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300884 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300885
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200886 hci_dev_lock(hdev);
887
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200888 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300889 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
890 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200891
892 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300893}
894
895static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300896 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -0300897{
898 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
899
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300900 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300901
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200902 hci_dev_lock(hdev);
903
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200904 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg744cf192011-11-08 20:40:14 +0200905 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300906 ACL_LINK, 0, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200907
908 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300909}
910
Brian Gix1143d452011-11-23 08:28:34 -0800911static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
912{
913 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
914
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300915 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800916
917 hci_dev_lock(hdev);
918
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200919 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +0200920 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300921 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800922
923 hci_dev_unlock(hdev);
924}
925
926static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300927 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -0800928{
929 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
930
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300931 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800932
933 hci_dev_lock(hdev);
934
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200935 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Brian Gix1143d452011-11-23 08:28:34 -0800936 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300937 ACL_LINK, 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800938
939 hci_dev_unlock(hdev);
940}
941
Marcel Holtmann4d2d2792014-01-10 02:07:26 -0800942static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
943 struct sk_buff *skb)
Szymon Jancc35938b2011-03-22 13:12:21 +0100944{
945 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
946
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300947 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Szymon Jancc35938b2011-03-22 13:12:21 +0100948
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200949 hci_dev_lock(hdev);
Marcel Holtmann4d2d2792014-01-10 02:07:26 -0800950 mgmt_read_local_oob_data_complete(hdev, rp->hash, rp->randomizer,
951 NULL, NULL, rp->status);
952 hci_dev_unlock(hdev);
953}
954
955static void hci_cc_read_local_oob_ext_data(struct hci_dev *hdev,
956 struct sk_buff *skb)
957{
958 struct hci_rp_read_local_oob_ext_data *rp = (void *) skb->data;
959
960 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
961
962 hci_dev_lock(hdev);
963 mgmt_read_local_oob_data_complete(hdev, rp->hash192, rp->randomizer192,
964 rp->hash256, rp->randomizer256,
965 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200966 hci_dev_unlock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +0100967}
968
Marcel Holtmann7a4cd512014-02-19 19:52:13 -0800969
970static void hci_cc_le_set_random_addr(struct hci_dev *hdev, struct sk_buff *skb)
971{
972 __u8 status = *((__u8 *) skb->data);
973 bdaddr_t *sent;
974
975 BT_DBG("%s status 0x%2.2x", hdev->name, status);
976
977 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_RANDOM_ADDR);
978 if (!sent)
979 return;
980
981 hci_dev_lock(hdev);
982
983 if (!status)
984 bacpy(&hdev->random_addr, sent);
985
986 hci_dev_unlock(hdev);
987}
988
Johan Hedbergc1d5dc42012-11-08 01:23:01 +0100989static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
990{
991 __u8 *sent, status = *((__u8 *) skb->data);
992
993 BT_DBG("%s status 0x%2.2x", hdev->name, status);
994
995 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
996 if (!sent)
997 return;
998
Johan Hedberg3c857752014-03-25 10:30:49 +0200999 if (status)
1000 return;
1001
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001002 hci_dev_lock(hdev);
1003
Johan Hedberg3c857752014-03-25 10:30:49 +02001004 /* If we're doing connection initation as peripheral. Set a
1005 * timeout in case something goes wrong.
1006 */
1007 if (*sent) {
1008 struct hci_conn *conn;
1009
1010 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
1011 if (conn)
1012 queue_delayed_work(hdev->workqueue,
1013 &conn->le_conn_timeout,
1014 HCI_LE_CONN_TIMEOUT);
1015 }
1016
1017 mgmt_advertising(hdev, *sent);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001018
Johan Hedberg04b4edc2013-03-15 17:07:01 -05001019 hci_dev_unlock(hdev);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001020}
1021
Marcel Holtmann533553f2014-03-21 12:18:10 -07001022static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
1023{
1024 struct hci_cp_le_set_scan_param *cp;
1025 __u8 status = *((__u8 *) skb->data);
1026
1027 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1028
1029 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_PARAM);
1030 if (!cp)
1031 return;
1032
1033 hci_dev_lock(hdev);
1034
1035 if (!status)
1036 hdev->le_scan_type = cp->type;
1037
1038 hci_dev_unlock(hdev);
1039}
1040
Johan Hedbergb9a63282014-03-25 10:51:52 +02001041static bool has_pending_adv_report(struct hci_dev *hdev)
1042{
1043 struct discovery_state *d = &hdev->discovery;
1044
1045 return bacmp(&d->last_adv_addr, BDADDR_ANY);
1046}
1047
1048static void clear_pending_adv_report(struct hci_dev *hdev)
1049{
1050 struct discovery_state *d = &hdev->discovery;
1051
1052 bacpy(&d->last_adv_addr, BDADDR_ANY);
1053 d->last_adv_data_len = 0;
1054}
1055
1056static void store_pending_adv_report(struct hci_dev *hdev, bdaddr_t *bdaddr,
Johan Hedbergff5cd292014-03-25 14:40:52 +02001057 u8 bdaddr_type, s8 rssi, u8 *data, u8 len)
Johan Hedbergb9a63282014-03-25 10:51:52 +02001058{
1059 struct discovery_state *d = &hdev->discovery;
1060
1061 bacpy(&d->last_adv_addr, bdaddr);
1062 d->last_adv_addr_type = bdaddr_type;
Johan Hedbergff5cd292014-03-25 14:40:52 +02001063 d->last_adv_rssi = rssi;
Johan Hedbergb9a63282014-03-25 10:51:52 +02001064 memcpy(d->last_adv_data, data, len);
1065 d->last_adv_data_len = len;
1066}
1067
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001068static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001069 struct sk_buff *skb)
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001070{
1071 struct hci_cp_le_set_scan_enable *cp;
1072 __u8 status = *((__u8 *) skb->data);
1073
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001074 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001075
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001076 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
1077 if (!cp)
1078 return;
1079
Andre Guedes3fd319b2013-04-30 15:29:36 -03001080 if (status)
1081 return;
1082
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001083 switch (cp->enable) {
Andre Guedes76a388b2013-04-04 20:21:02 -03001084 case LE_SCAN_ENABLE:
Andre Guedesd23264a2011-11-25 20:53:38 -03001085 set_bit(HCI_LE_SCAN, &hdev->dev_flags);
Johan Hedbergb9a63282014-03-25 10:51:52 +02001086 if (hdev->le_scan_type == LE_SCAN_ACTIVE)
1087 clear_pending_adv_report(hdev);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001088 break;
1089
Andre Guedes76a388b2013-04-04 20:21:02 -03001090 case LE_SCAN_DISABLE:
Johan Hedbergb9a63282014-03-25 10:51:52 +02001091 /* We do this here instead of when setting DISCOVERY_STOPPED
1092 * since the latter would potentially require waiting for
1093 * inquiry to stop too.
1094 */
1095 if (has_pending_adv_report(hdev)) {
1096 struct discovery_state *d = &hdev->discovery;
1097
1098 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergab0aa432014-03-26 14:17:12 +02001099 d->last_adv_addr_type, NULL,
1100 d->last_adv_rssi, 0, 1,
1101 d->last_adv_data,
Johan Hedbergb9a63282014-03-25 10:51:52 +02001102 d->last_adv_data_len, NULL, 0);
1103 }
1104
Johan Hedberg317ac8c2014-02-28 20:26:12 +02001105 /* Cancel this timer so that we don't try to disable scanning
1106 * when it's already disabled.
1107 */
1108 cancel_delayed_work(&hdev->le_scan_disable);
1109
Andre Guedesd23264a2011-11-25 20:53:38 -03001110 clear_bit(HCI_LE_SCAN, &hdev->dev_flags);
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001111 /* The HCI_LE_SCAN_INTERRUPTED flag indicates that we
1112 * interrupted scanning due to a connect request. Mark
1113 * therefore discovery as stopped.
1114 */
1115 if (test_and_clear_bit(HCI_LE_SCAN_INTERRUPTED,
1116 &hdev->dev_flags))
1117 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001118 break;
1119
1120 default:
1121 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1122 break;
Andre Guedes35815082011-05-26 16:23:53 -03001123 }
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001124}
1125
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001126static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
1127 struct sk_buff *skb)
1128{
1129 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
1130
1131 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
1132
1133 if (!rp->status)
1134 hdev->le_white_list_size = rp->size;
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001135}
1136
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001137static void hci_cc_le_clear_white_list(struct hci_dev *hdev,
1138 struct sk_buff *skb)
1139{
1140 __u8 status = *((__u8 *) skb->data);
1141
1142 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1143
1144 if (!status)
1145 hci_white_list_clear(hdev);
1146}
1147
1148static void hci_cc_le_add_to_white_list(struct hci_dev *hdev,
1149 struct sk_buff *skb)
1150{
1151 struct hci_cp_le_add_to_white_list *sent;
1152 __u8 status = *((__u8 *) skb->data);
1153
1154 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1155
1156 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_WHITE_LIST);
1157 if (!sent)
1158 return;
1159
1160 if (!status)
1161 hci_white_list_add(hdev, &sent->bdaddr, sent->bdaddr_type);
1162}
1163
1164static void hci_cc_le_del_from_white_list(struct hci_dev *hdev,
1165 struct sk_buff *skb)
1166{
1167 struct hci_cp_le_del_from_white_list *sent;
1168 __u8 status = *((__u8 *) skb->data);
1169
1170 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1171
1172 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_WHITE_LIST);
1173 if (!sent)
1174 return;
1175
1176 if (!status)
1177 hci_white_list_del(hdev, &sent->bdaddr, sent->bdaddr_type);
1178}
1179
Johan Hedberg9b008c02013-01-22 14:02:01 +02001180static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
1181 struct sk_buff *skb)
1182{
1183 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
1184
1185 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1186
1187 if (!rp->status)
1188 memcpy(hdev->le_states, rp->le_states, 8);
Johan Hedberg9b008c02013-01-22 14:02:01 +02001189}
1190
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001191static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1192 struct sk_buff *skb)
Andre Guedesf9b49302011-06-30 19:20:53 -03001193{
Johan Hedberg06199cf2012-02-22 16:37:11 +02001194 struct hci_cp_write_le_host_supported *sent;
Andre Guedesf9b49302011-06-30 19:20:53 -03001195 __u8 status = *((__u8 *) skb->data);
1196
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001197 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001198
Johan Hedberg06199cf2012-02-22 16:37:11 +02001199 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001200 if (!sent)
Andre Guedesf9b49302011-06-30 19:20:53 -03001201 return;
1202
Johan Hedberg8f984df2012-02-28 01:07:22 +02001203 if (!status) {
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001204 if (sent->le) {
Johan Hedbergcad718e2013-04-17 15:00:51 +03001205 hdev->features[1][0] |= LMP_HOST_LE;
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001206 set_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1207 } else {
Johan Hedbergcad718e2013-04-17 15:00:51 +03001208 hdev->features[1][0] &= ~LMP_HOST_LE;
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001209 clear_bit(HCI_LE_ENABLED, &hdev->dev_flags);
Johan Hedbergf3d3444a2013-10-05 12:01:04 +02001210 clear_bit(HCI_ADVERTISING, &hdev->dev_flags);
Johan Hedberg416a4ae2013-09-25 13:26:08 +03001211 }
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001212
1213 if (sent->simul)
Johan Hedbergcad718e2013-04-17 15:00:51 +03001214 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
Johan Hedberg53b2caa2012-10-24 21:11:59 +03001215 else
Johan Hedbergcad718e2013-04-17 15:00:51 +03001216 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
Johan Hedberg8f984df2012-02-28 01:07:22 +02001217 }
Andre Guedesf9b49302011-06-30 19:20:53 -03001218}
1219
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02001220static void hci_cc_set_adv_param(struct hci_dev *hdev, struct sk_buff *skb)
1221{
1222 struct hci_cp_le_set_adv_param *cp;
1223 u8 status = *((u8 *) skb->data);
1224
1225 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1226
1227 if (status)
1228 return;
1229
1230 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_PARAM);
1231 if (!cp)
1232 return;
1233
1234 hci_dev_lock(hdev);
1235 hdev->adv_addr_type = cp->own_address_type;
1236 hci_dev_unlock(hdev);
1237}
1238
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001239static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1240 struct sk_buff *skb)
1241{
1242 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1243
1244 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1245 hdev->name, rp->status, rp->phy_handle);
1246
1247 if (rp->status)
1248 return;
1249
1250 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1251}
1252
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02001253static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
1254{
1255 struct hci_rp_read_rssi *rp = (void *) skb->data;
1256 struct hci_conn *conn;
1257
1258 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1259
1260 if (rp->status)
1261 return;
1262
1263 hci_dev_lock(hdev);
1264
1265 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
1266 if (conn)
1267 conn->rssi = rp->rssi;
1268
1269 hci_dev_unlock(hdev);
1270}
1271
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001272static void hci_cc_read_tx_power(struct hci_dev *hdev, struct sk_buff *skb)
1273{
1274 struct hci_cp_read_tx_power *sent;
1275 struct hci_rp_read_tx_power *rp = (void *) skb->data;
1276 struct hci_conn *conn;
1277
1278 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1279
1280 if (rp->status)
1281 return;
1282
1283 sent = hci_sent_cmd_data(hdev, HCI_OP_READ_TX_POWER);
1284 if (!sent)
1285 return;
1286
1287 hci_dev_lock(hdev);
1288
1289 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001290 if (!conn)
1291 goto unlock;
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001292
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001293 switch (sent->type) {
1294 case 0x00:
1295 conn->tx_power = rp->tx_power;
1296 break;
1297 case 0x01:
1298 conn->max_tx_power = rp->tx_power;
1299 break;
1300 }
1301
1302unlock:
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001303 hci_dev_unlock(hdev);
1304}
1305
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001306static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001307{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001308 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001309
1310 if (status) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001311 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001312 return;
1313 }
1314
Andre Guedes89352e72011-11-04 14:16:53 -03001315 set_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001316}
1317
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001318static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001320 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001323 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001324
1325 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326 if (!cp)
1327 return;
1328
1329 hci_dev_lock(hdev);
1330
1331 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1332
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001333 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001334
1335 if (status) {
1336 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001337 if (status != 0x0c || conn->attempt > 2) {
1338 conn->state = BT_CLOSED;
1339 hci_proto_connect_cfm(conn, status);
1340 hci_conn_del(conn);
1341 } else
1342 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001343 }
1344 } else {
1345 if (!conn) {
1346 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1347 if (conn) {
Johan Hedberga0c808b2012-01-16 09:49:58 +02001348 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349 conn->link_mode |= HCI_LM_MASTER;
1350 } else
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001351 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 }
1353 }
1354
1355 hci_dev_unlock(hdev);
1356}
1357
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001358static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001360 struct hci_cp_add_sco *cp;
1361 struct hci_conn *acl, *sco;
1362 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001364 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001365
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001366 if (!status)
1367 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001369 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1370 if (!cp)
1371 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001373 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001374
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001375 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001376
1377 hci_dev_lock(hdev);
1378
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001379 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001380 if (acl) {
1381 sco = acl->link;
1382 if (sco) {
1383 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001384
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001385 hci_proto_connect_cfm(sco, status);
1386 hci_conn_del(sco);
1387 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001388 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001389
1390 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391}
1392
Marcel Holtmannf8558552008-07-14 20:13:49 +02001393static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1394{
1395 struct hci_cp_auth_requested *cp;
1396 struct hci_conn *conn;
1397
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001398 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001399
1400 if (!status)
1401 return;
1402
1403 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1404 if (!cp)
1405 return;
1406
1407 hci_dev_lock(hdev);
1408
1409 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1410 if (conn) {
1411 if (conn->state == BT_CONFIG) {
1412 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001413 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001414 }
1415 }
1416
1417 hci_dev_unlock(hdev);
1418}
1419
1420static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1421{
1422 struct hci_cp_set_conn_encrypt *cp;
1423 struct hci_conn *conn;
1424
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001425 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001426
1427 if (!status)
1428 return;
1429
1430 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1431 if (!cp)
1432 return;
1433
1434 hci_dev_lock(hdev);
1435
1436 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1437 if (conn) {
1438 if (conn->state == BT_CONFIG) {
1439 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001440 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001441 }
1442 }
1443
1444 hci_dev_unlock(hdev);
1445}
1446
Johan Hedberg127178d2010-11-18 22:22:29 +02001447static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001448 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001449{
Johan Hedberg392599b2010-11-18 22:22:28 +02001450 if (conn->state != BT_CONFIG || !conn->out)
1451 return 0;
1452
Johan Hedberg765c2a92011-01-19 12:06:52 +05301453 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001454 return 0;
1455
1456 /* Only request authentication for SSP connections or non-SSP
Johan Hedberg264b8b42014-01-08 16:40:39 +02001457 * devices with sec_level MEDIUM or HIGH or if MITM protection
1458 * is requested.
1459 */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001460 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
Johan Hedberg7e3691e2014-05-30 14:45:19 +03001461 conn->pending_sec_level != BT_SECURITY_FIPS &&
Johan Hedberg264b8b42014-01-08 16:40:39 +02001462 conn->pending_sec_level != BT_SECURITY_HIGH &&
1463 conn->pending_sec_level != BT_SECURITY_MEDIUM)
Johan Hedberg392599b2010-11-18 22:22:28 +02001464 return 0;
1465
Johan Hedberg392599b2010-11-18 22:22:28 +02001466 return 1;
1467}
1468
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001469static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001470 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001471{
1472 struct hci_cp_remote_name_req cp;
1473
1474 memset(&cp, 0, sizeof(cp));
1475
1476 bacpy(&cp.bdaddr, &e->data.bdaddr);
1477 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1478 cp.pscan_mode = e->data.pscan_mode;
1479 cp.clock_offset = e->data.clock_offset;
1480
1481 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1482}
1483
Johan Hedbergb644ba32012-01-17 21:48:47 +02001484static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001485{
1486 struct discovery_state *discov = &hdev->discovery;
1487 struct inquiry_entry *e;
1488
Johan Hedbergb644ba32012-01-17 21:48:47 +02001489 if (list_empty(&discov->resolve))
1490 return false;
1491
1492 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001493 if (!e)
1494 return false;
1495
Johan Hedbergb644ba32012-01-17 21:48:47 +02001496 if (hci_resolve_name(hdev, e) == 0) {
1497 e->name_state = NAME_PENDING;
1498 return true;
1499 }
1500
1501 return false;
1502}
1503
1504static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001505 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001506{
1507 struct discovery_state *discov = &hdev->discovery;
1508 struct inquiry_entry *e;
1509
1510 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001511 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1512 name_len, conn->dev_class);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001513
1514 if (discov->state == DISCOVERY_STOPPED)
1515 return;
1516
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001517 if (discov->state == DISCOVERY_STOPPING)
1518 goto discov_complete;
1519
1520 if (discov->state != DISCOVERY_RESOLVING)
1521 return;
1522
1523 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001524 /* If the device was not found in a list of found devices names of which
1525 * are pending. there is no need to continue resolving a next name as it
1526 * will be done upon receiving another Remote Name Request Complete
1527 * Event */
1528 if (!e)
1529 return;
1530
1531 list_del(&e->list);
1532 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001533 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001534 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1535 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001536 } else {
1537 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001538 }
1539
Johan Hedbergb644ba32012-01-17 21:48:47 +02001540 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001541 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001542
1543discov_complete:
1544 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1545}
1546
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001547static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1548{
Johan Hedberg127178d2010-11-18 22:22:29 +02001549 struct hci_cp_remote_name_req *cp;
1550 struct hci_conn *conn;
1551
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001552 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001553
1554 /* If successful wait for the name req complete event before
1555 * checking for the need to do authentication */
1556 if (!status)
1557 return;
1558
1559 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1560 if (!cp)
1561 return;
1562
1563 hci_dev_lock(hdev);
1564
1565 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001566
1567 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1568 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1569
Johan Hedberg79c6c702011-04-28 11:28:55 -07001570 if (!conn)
1571 goto unlock;
1572
1573 if (!hci_outgoing_auth_needed(hdev, conn))
1574 goto unlock;
1575
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001576 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02001577 struct hci_cp_auth_requested auth_cp;
1578
1579 auth_cp.handle = __cpu_to_le16(conn->handle);
1580 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1581 sizeof(auth_cp), &auth_cp);
Johan Hedberg127178d2010-11-18 22:22:29 +02001582 }
1583
Johan Hedberg79c6c702011-04-28 11:28:55 -07001584unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001585 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001586}
1587
Marcel Holtmann769be972008-07-14 20:13:49 +02001588static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1589{
1590 struct hci_cp_read_remote_features *cp;
1591 struct hci_conn *conn;
1592
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001593 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001594
1595 if (!status)
1596 return;
1597
1598 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1599 if (!cp)
1600 return;
1601
1602 hci_dev_lock(hdev);
1603
1604 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1605 if (conn) {
1606 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001607 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001608 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001609 }
1610 }
1611
1612 hci_dev_unlock(hdev);
1613}
1614
1615static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1616{
1617 struct hci_cp_read_remote_ext_features *cp;
1618 struct hci_conn *conn;
1619
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001620 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001621
1622 if (!status)
1623 return;
1624
1625 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1626 if (!cp)
1627 return;
1628
1629 hci_dev_lock(hdev);
1630
1631 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1632 if (conn) {
1633 if (conn->state == BT_CONFIG) {
Marcel Holtmann769be972008-07-14 20:13:49 +02001634 hci_proto_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001635 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001636 }
1637 }
1638
1639 hci_dev_unlock(hdev);
1640}
1641
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001642static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1643{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001644 struct hci_cp_setup_sync_conn *cp;
1645 struct hci_conn *acl, *sco;
1646 __u16 handle;
1647
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001648 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001649
1650 if (!status)
1651 return;
1652
1653 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1654 if (!cp)
1655 return;
1656
1657 handle = __le16_to_cpu(cp->handle);
1658
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001659 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001660
1661 hci_dev_lock(hdev);
1662
1663 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001664 if (acl) {
1665 sco = acl->link;
1666 if (sco) {
1667 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001668
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001669 hci_proto_connect_cfm(sco, status);
1670 hci_conn_del(sco);
1671 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001672 }
1673
1674 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001675}
1676
1677static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1678{
1679 struct hci_cp_sniff_mode *cp;
1680 struct hci_conn *conn;
1681
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001682 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001683
1684 if (!status)
1685 return;
1686
1687 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1688 if (!cp)
1689 return;
1690
1691 hci_dev_lock(hdev);
1692
1693 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001694 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001695 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001696
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001697 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001698 hci_sco_setup(conn, status);
1699 }
1700
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001701 hci_dev_unlock(hdev);
1702}
1703
1704static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1705{
1706 struct hci_cp_exit_sniff_mode *cp;
1707 struct hci_conn *conn;
1708
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001709 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001710
1711 if (!status)
1712 return;
1713
1714 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1715 if (!cp)
1716 return;
1717
1718 hci_dev_lock(hdev);
1719
1720 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001721 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001722 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001723
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001724 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001725 hci_sco_setup(conn, status);
1726 }
1727
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001728 hci_dev_unlock(hdev);
1729}
1730
Johan Hedberg88c3df12012-02-09 14:27:38 +02001731static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1732{
1733 struct hci_cp_disconnect *cp;
1734 struct hci_conn *conn;
1735
1736 if (!status)
1737 return;
1738
1739 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1740 if (!cp)
1741 return;
1742
1743 hci_dev_lock(hdev);
1744
1745 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1746 if (conn)
1747 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001748 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001749
1750 hci_dev_unlock(hdev);
1751}
1752
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001753static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1754{
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001755 struct hci_cp_create_phy_link *cp;
1756
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001757 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001758
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001759 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1760 if (!cp)
1761 return;
1762
Andrei Emeltchenkoe58917b2012-10-31 15:46:33 +02001763 hci_dev_lock(hdev);
1764
1765 if (status) {
1766 struct hci_conn *hcon;
1767
1768 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1769 if (hcon)
1770 hci_conn_del(hcon);
1771 } else {
1772 amp_write_remote_assoc(hdev, cp->phy_handle);
1773 }
1774
1775 hci_dev_unlock(hdev);
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001776}
1777
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03001778static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1779{
1780 struct hci_cp_accept_phy_link *cp;
1781
1782 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1783
1784 if (status)
1785 return;
1786
1787 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1788 if (!cp)
1789 return;
1790
1791 amp_write_remote_assoc(hdev, cp->phy_handle);
1792}
1793
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02001794static void hci_cs_le_create_conn(struct hci_dev *hdev, u8 status)
1795{
1796 struct hci_cp_le_create_conn *cp;
1797 struct hci_conn *conn;
1798
1799 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1800
1801 /* All connection failure handling is taken care of by the
1802 * hci_le_conn_failed function which is triggered by the HCI
1803 * request completion callbacks used for connecting.
1804 */
1805 if (status)
1806 return;
1807
1808 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1809 if (!cp)
1810 return;
1811
1812 hci_dev_lock(hdev);
1813
1814 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1815 if (!conn)
1816 goto unlock;
1817
1818 /* Store the initiator and responder address information which
1819 * is needed for SMP. These values will not change during the
1820 * lifetime of the connection.
1821 */
1822 conn->init_addr_type = cp->own_address_type;
1823 if (cp->own_address_type == ADDR_LE_DEV_RANDOM)
1824 bacpy(&conn->init_addr, &hdev->random_addr);
1825 else
1826 bacpy(&conn->init_addr, &hdev->bdaddr);
1827
1828 conn->resp_addr_type = cp->peer_addr_type;
1829 bacpy(&conn->resp_addr, &cp->peer_addr);
1830
Johan Hedberg9489eca2014-02-28 17:45:46 +02001831 /* We don't want the connection attempt to stick around
1832 * indefinitely since LE doesn't have a page timeout concept
1833 * like BR/EDR. Set a timer for any connection that doesn't use
1834 * the white list for connecting.
1835 */
1836 if (cp->filter_policy == HCI_LE_USE_PEER_ADDR)
1837 queue_delayed_work(conn->hdev->workqueue,
1838 &conn->le_conn_timeout,
1839 HCI_LE_CONN_TIMEOUT);
1840
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02001841unlock:
1842 hci_dev_unlock(hdev);
1843}
1844
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02001845static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1846{
1847 struct hci_cp_le_start_enc *cp;
1848 struct hci_conn *conn;
1849
1850 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1851
1852 if (!status)
1853 return;
1854
1855 hci_dev_lock(hdev);
1856
1857 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_START_ENC);
1858 if (!cp)
1859 goto unlock;
1860
1861 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1862 if (!conn)
1863 goto unlock;
1864
1865 if (conn->state != BT_CONNECTED)
1866 goto unlock;
1867
1868 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
1869 hci_conn_drop(conn);
1870
1871unlock:
1872 hci_dev_unlock(hdev);
1873}
1874
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001875static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001876{
1877 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001878 struct discovery_state *discov = &hdev->discovery;
1879 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001880
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001881 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001882
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001883 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03001884
1885 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1886 return;
1887
Peter Zijlstra4e857c52014-03-17 18:06:10 +01001888 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
Andre Guedes3e13fa12013-03-27 20:04:56 -03001889 wake_up_bit(&hdev->flags, HCI_INQUIRY);
1890
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001891 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001892 return;
1893
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001894 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001895
Andre Guedes343f9352012-02-17 20:39:37 -03001896 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001897 goto unlock;
1898
1899 if (list_empty(&discov->resolve)) {
1900 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1901 goto unlock;
1902 }
1903
1904 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1905 if (e && hci_resolve_name(hdev, e) == 0) {
1906 e->name_state = NAME_PENDING;
1907 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1908 } else {
1909 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1910 }
1911
1912unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001913 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001914}
1915
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001916static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001917{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001918 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001919 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001920 int num_rsp = *((__u8 *) skb->data);
1921
1922 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1923
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001924 if (!num_rsp)
1925 return;
1926
Andre Guedes1519cc12012-03-21 00:03:38 -03001927 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1928 return;
1929
Linus Torvalds1da177e2005-04-16 15:20:36 -07001930 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001931
Johan Hedberge17acd42011-03-30 23:57:16 +03001932 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001933 bool name_known, ssp;
Johan Hedberg31754052012-01-04 13:39:52 +02001934
Linus Torvalds1da177e2005-04-16 15:20:36 -07001935 bacpy(&data.bdaddr, &info->bdaddr);
1936 data.pscan_rep_mode = info->pscan_rep_mode;
1937 data.pscan_period_mode = info->pscan_period_mode;
1938 data.pscan_mode = info->pscan_mode;
1939 memcpy(data.dev_class, info->dev_class, 3);
1940 data.clock_offset = info->clock_offset;
1941 data.rssi = 0x00;
Marcel Holtmann41a96212008-07-14 20:13:48 +02001942 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02001943
Johan Hedberg388fc8f2012-02-23 00:38:59 +02001944 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02001945 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001946 info->dev_class, 0, !name_known, ssp, NULL,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02001947 0, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001948 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001949
Linus Torvalds1da177e2005-04-16 15:20:36 -07001950 hci_dev_unlock(hdev);
1951}
1952
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001953static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001954{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001955 struct hci_ev_conn_complete *ev = (void *) skb->data;
1956 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001957
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001958 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001959
Linus Torvalds1da177e2005-04-16 15:20:36 -07001960 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001961
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001962 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02001963 if (!conn) {
1964 if (ev->link_type != SCO_LINK)
1965 goto unlock;
1966
1967 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1968 if (!conn)
1969 goto unlock;
1970
1971 conn->type = SCO_LINK;
1972 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07001973
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001974 if (!ev->status) {
1975 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02001976
1977 if (conn->type == ACL_LINK) {
1978 conn->state = BT_CONFIG;
1979 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02001980
1981 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1982 !hci_find_link_key(hdev, &ev->bdaddr))
1983 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1984 else
1985 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02001986 } else
1987 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001988
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02001989 hci_conn_add_sysfs(conn);
1990
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001991 if (test_bit(HCI_AUTH, &hdev->flags))
1992 conn->link_mode |= HCI_LM_AUTH;
1993
1994 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1995 conn->link_mode |= HCI_LM_ENCRYPT;
1996
1997 /* Get remote features */
1998 if (conn->type == ACL_LINK) {
1999 struct hci_cp_read_remote_features cp;
2000 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02002001 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002002 sizeof(cp), &cp);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002003 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002004
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002005 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02002006 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002007 struct hci_cp_change_conn_ptype cp;
2008 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02002009 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002010 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
2011 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002012 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02002013 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002014 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02002015 if (conn->type == ACL_LINK)
Marcel Holtmann64c7b772014-02-18 14:22:20 -08002016 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002017 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02002018 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002019
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002020 if (conn->type == ACL_LINK)
2021 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002022
Marcel Holtmann769be972008-07-14 20:13:49 +02002023 if (ev->status) {
2024 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002025 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01002026 } else if (ev->link_type != ACL_LINK)
2027 hci_proto_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002028
2029unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002030 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002031
2032 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002033}
2034
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002035static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002036{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002037 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038 int mask = hdev->link_mode;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002039 __u8 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002040
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002041 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002042 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002044 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
2045 &flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046
Szymon Janc138d22e2011-02-17 16:44:23 +01002047 if ((mask & HCI_LM_ACCEPT) &&
Marcel Holtmannb9ee0a72013-10-17 17:24:13 -07002048 !hci_blacklist_lookup(hdev, &ev->bdaddr, BDADDR_BREDR)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049 /* Connection accepted */
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02002050 struct inquiry_entry *ie;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002051 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002052
2053 hci_dev_lock(hdev);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002054
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002055 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2056 if (ie)
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02002057 memcpy(ie->data.dev_class, ev->dev_class, 3);
2058
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002059 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
2060 &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061 if (!conn) {
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02002062 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
2063 if (!conn) {
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03002064 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002065 hci_dev_unlock(hdev);
2066 return;
2067 }
2068 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002069
Linus Torvalds1da177e2005-04-16 15:20:36 -07002070 memcpy(conn->dev_class, ev->dev_class, 3);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002071
Linus Torvalds1da177e2005-04-16 15:20:36 -07002072 hci_dev_unlock(hdev);
2073
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002074 if (ev->link_type == ACL_LINK ||
2075 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002076 struct hci_cp_accept_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002077 conn->state = BT_CONNECT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002078
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002079 bacpy(&cp.bdaddr, &ev->bdaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002080
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002081 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
2082 cp.role = 0x00; /* Become master */
2083 else
2084 cp.role = 0x01; /* Remain slave */
2085
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002086 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
2087 &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002088 } else if (!(flags & HCI_PROTO_DEFER)) {
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002089 struct hci_cp_accept_sync_conn_req cp;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002090 conn->state = BT_CONNECT;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002091
2092 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +02002093 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002094
Joe Perchesdcf4adb2014-03-12 10:52:35 -07002095 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
2096 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
2097 cp.max_latency = cpu_to_le16(0xffff);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002098 cp.content_format = cpu_to_le16(hdev->voice_setting);
2099 cp.retrans_effort = 0xff;
2100
2101 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002102 sizeof(cp), &cp);
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002103 } else {
2104 conn->state = BT_CONNECT2;
2105 hci_proto_connect_cfm(conn, 0);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002106 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002107 } else {
2108 /* Connection rejected */
2109 struct hci_cp_reject_conn_req cp;
2110
2111 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02002112 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002113 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002114 }
2115}
2116
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02002117static u8 hci_to_mgmt_reason(u8 err)
2118{
2119 switch (err) {
2120 case HCI_ERROR_CONNECTION_TIMEOUT:
2121 return MGMT_DEV_DISCONN_TIMEOUT;
2122 case HCI_ERROR_REMOTE_USER_TERM:
2123 case HCI_ERROR_REMOTE_LOW_RESOURCES:
2124 case HCI_ERROR_REMOTE_POWER_OFF:
2125 return MGMT_DEV_DISCONN_REMOTE;
2126 case HCI_ERROR_LOCAL_HOST_TERM:
2127 return MGMT_DEV_DISCONN_LOCAL_HOST;
2128 default:
2129 return MGMT_DEV_DISCONN_UNKNOWN;
2130 }
2131}
2132
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002133static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002134{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002135 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Andre Guedesabf54a52013-11-07 17:36:09 -03002136 u8 reason = hci_to_mgmt_reason(ev->reason);
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002137 struct hci_conn_params *params;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002138 struct hci_conn *conn;
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002139 bool mgmt_connected;
Andre Guedes38462202013-11-07 17:36:10 -03002140 u8 type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002141
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002142 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002143
Linus Torvalds1da177e2005-04-16 15:20:36 -07002144 hci_dev_lock(hdev);
2145
Marcel Holtmann04837f62006-07-03 10:02:33 +02002146 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02002147 if (!conn)
2148 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002149
Andre Guedesabf54a52013-11-07 17:36:09 -03002150 if (ev->status) {
2151 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
2152 conn->dst_type, ev->status);
2153 goto unlock;
Johan Hedberg37d9ef72011-11-10 15:54:39 +02002154 }
Johan Hedbergf7520542011-01-20 12:34:39 +02002155
Andre Guedes38462202013-11-07 17:36:10 -03002156 conn->state = BT_CLOSED;
2157
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002158 mgmt_connected = test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags);
2159 mgmt_device_disconnected(hdev, &conn->dst, conn->type, conn->dst_type,
2160 reason, mgmt_connected);
Andre Guedesabf54a52013-11-07 17:36:09 -03002161
Andre Guedes38462202013-11-07 17:36:10 -03002162 if (conn->type == ACL_LINK && conn->flush_key)
2163 hci_remove_link_key(hdev, &conn->dst);
Johan Hedberg22102462013-10-05 12:01:06 +02002164
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002165 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
2166 if (params) {
2167 switch (params->auto_connect) {
2168 case HCI_AUTO_CONN_LINK_LOSS:
2169 if (ev->reason != HCI_ERROR_CONNECTION_TIMEOUT)
2170 break;
2171 /* Fall through */
2172
2173 case HCI_AUTO_CONN_ALWAYS:
2174 hci_pend_le_conn_add(hdev, &conn->dst, conn->dst_type);
2175 break;
2176
2177 default:
2178 break;
2179 }
2180 }
2181
Andre Guedes38462202013-11-07 17:36:10 -03002182 type = conn->type;
Johan Hedberg22102462013-10-05 12:01:06 +02002183
Andre Guedes38462202013-11-07 17:36:10 -03002184 hci_proto_disconn_cfm(conn, ev->reason);
2185 hci_conn_del(conn);
2186
2187 /* Re-enable advertising if necessary, since it might
2188 * have been disabled by the connection. From the
2189 * HCI_LE_Set_Advertise_Enable command description in
2190 * the core specification (v4.0):
2191 * "The Controller shall continue advertising until the Host
2192 * issues an LE_Set_Advertise_Enable command with
2193 * Advertising_Enable set to 0x00 (Advertising is disabled)
2194 * or until a connection is created or until the Advertising
2195 * is timed out due to Directed Advertising."
2196 */
2197 if (type == LE_LINK)
2198 mgmt_reenable_advertising(hdev);
Johan Hedbergf7520542011-01-20 12:34:39 +02002199
2200unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002201 hci_dev_unlock(hdev);
2202}
2203
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002204static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002205{
2206 struct hci_ev_auth_complete *ev = (void *) skb->data;
2207 struct hci_conn *conn;
2208
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002209 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002210
2211 hci_dev_lock(hdev);
2212
2213 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002214 if (!conn)
2215 goto unlock;
2216
2217 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002218 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002219 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002220 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03002221 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002222 conn->link_mode |= HCI_LM_AUTH;
2223 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03002224 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002225 } else {
Johan Hedbergbab73cb2012-02-09 16:07:29 +02002226 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002227 ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002228 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002229
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002230 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
2231 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002232
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002233 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002234 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002235 struct hci_cp_set_conn_encrypt cp;
2236 cp.handle = ev->handle;
2237 cp.encrypt = 0x01;
2238 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002239 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002240 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002241 conn->state = BT_CONNECTED;
2242 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002243 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002244 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002245 } else {
2246 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002247
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002248 hci_conn_hold(conn);
2249 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02002250 hci_conn_drop(conn);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002251 }
2252
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002253 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002254 if (!ev->status) {
2255 struct hci_cp_set_conn_encrypt cp;
2256 cp.handle = ev->handle;
2257 cp.encrypt = 0x01;
2258 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002259 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002260 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002261 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002262 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002263 }
2264 }
2265
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002266unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002267 hci_dev_unlock(hdev);
2268}
2269
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002270static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002271{
Johan Hedberg127178d2010-11-18 22:22:29 +02002272 struct hci_ev_remote_name *ev = (void *) skb->data;
2273 struct hci_conn *conn;
2274
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002275 BT_DBG("%s", hdev->name);
2276
2277 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02002278
2279 hci_dev_lock(hdev);
2280
2281 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002282
2283 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
2284 goto check_auth;
2285
2286 if (ev->status == 0)
2287 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002288 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02002289 else
2290 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2291
2292check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07002293 if (!conn)
2294 goto unlock;
2295
2296 if (!hci_outgoing_auth_needed(hdev, conn))
2297 goto unlock;
2298
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002299 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002300 struct hci_cp_auth_requested cp;
2301 cp.handle = __cpu_to_le16(conn->handle);
2302 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2303 }
2304
Johan Hedberg79c6c702011-04-28 11:28:55 -07002305unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02002306 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002307}
2308
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002309static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002310{
2311 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2312 struct hci_conn *conn;
2313
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002314 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002315
2316 hci_dev_lock(hdev);
2317
2318 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002319 if (!conn)
2320 goto unlock;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002321
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002322 if (!ev->status) {
2323 if (ev->encrypt) {
2324 /* Encryption implies authentication */
2325 conn->link_mode |= HCI_LM_AUTH;
2326 conn->link_mode |= HCI_LM_ENCRYPT;
2327 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002328
Marcel Holtmann914a6ff2014-02-01 11:52:02 -08002329 /* P-256 authentication key implies FIPS */
2330 if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256)
2331 conn->link_mode |= HCI_LM_FIPS;
2332
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002333 if ((conn->type == ACL_LINK && ev->encrypt == 0x02) ||
2334 conn->type == LE_LINK)
2335 set_bit(HCI_CONN_AES_CCM, &conn->flags);
2336 } else {
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002337 conn->link_mode &= ~HCI_LM_ENCRYPT;
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002338 clear_bit(HCI_CONN_AES_CCM, &conn->flags);
2339 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002340 }
2341
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002342 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
2343
2344 if (ev->status && conn->state == BT_CONNECTED) {
2345 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
2346 hci_conn_drop(conn);
2347 goto unlock;
2348 }
2349
2350 if (conn->state == BT_CONFIG) {
2351 if (!ev->status)
2352 conn->state = BT_CONNECTED;
2353
Marcel Holtmann40b552a2014-03-19 14:10:25 -07002354 /* In Secure Connections Only mode, do not allow any
2355 * connections that are not encrypted with AES-CCM
2356 * using a P-256 authenticated combination key.
2357 */
2358 if (test_bit(HCI_SC_ONLY, &hdev->dev_flags) &&
2359 (!test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
2360 conn->key_type != HCI_LK_AUTH_COMBINATION_P256)) {
2361 hci_proto_connect_cfm(conn, HCI_ERROR_AUTH_FAILURE);
2362 hci_conn_drop(conn);
2363 goto unlock;
2364 }
2365
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002366 hci_proto_connect_cfm(conn, ev->status);
2367 hci_conn_drop(conn);
2368 } else
2369 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
2370
Gustavo Padovana7d77232012-05-13 03:20:07 -03002371unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002372 hci_dev_unlock(hdev);
2373}
2374
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002375static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2376 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002377{
2378 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2379 struct hci_conn *conn;
2380
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002381 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002382
2383 hci_dev_lock(hdev);
2384
2385 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2386 if (conn) {
2387 if (!ev->status)
2388 conn->link_mode |= HCI_LM_SECURE;
2389
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002390 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002391
2392 hci_key_change_cfm(conn, ev->status);
2393 }
2394
2395 hci_dev_unlock(hdev);
2396}
2397
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002398static void hci_remote_features_evt(struct hci_dev *hdev,
2399 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002400{
2401 struct hci_ev_remote_features *ev = (void *) skb->data;
2402 struct hci_conn *conn;
2403
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002404 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002405
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002406 hci_dev_lock(hdev);
2407
2408 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002409 if (!conn)
2410 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002411
Johan Hedbergccd556f2010-11-10 17:11:51 +02002412 if (!ev->status)
Johan Hedbergcad718e2013-04-17 15:00:51 +03002413 memcpy(conn->features[0], ev->features, 8);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002414
2415 if (conn->state != BT_CONFIG)
2416 goto unlock;
2417
2418 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2419 struct hci_cp_read_remote_ext_features cp;
2420 cp.handle = ev->handle;
2421 cp.page = 0x01;
2422 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002423 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002424 goto unlock;
2425 }
2426
Johan Hedberg671267b2012-05-12 16:11:50 -03002427 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002428 struct hci_cp_remote_name_req cp;
2429 memset(&cp, 0, sizeof(cp));
2430 bacpy(&cp.bdaddr, &conn->dst);
2431 cp.pscan_rep_mode = 0x02;
2432 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002433 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2434 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002435 conn->dst_type, 0, NULL, 0,
2436 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02002437
Johan Hedberg127178d2010-11-18 22:22:29 +02002438 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002439 conn->state = BT_CONNECTED;
2440 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002441 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002442 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002443
Johan Hedbergccd556f2010-11-10 17:11:51 +02002444unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002445 hci_dev_unlock(hdev);
2446}
2447
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002448static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002449{
2450 struct hci_ev_cmd_complete *ev = (void *) skb->data;
Johan Hedberg9238f362013-03-05 20:37:48 +02002451 u8 status = skb->data[sizeof(*ev)];
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002452 __u16 opcode;
2453
2454 skb_pull(skb, sizeof(*ev));
2455
2456 opcode = __le16_to_cpu(ev->opcode);
2457
2458 switch (opcode) {
2459 case HCI_OP_INQUIRY_CANCEL:
2460 hci_cc_inquiry_cancel(hdev, skb);
2461 break;
2462
Andre Guedes4d934832012-03-21 00:03:35 -03002463 case HCI_OP_PERIODIC_INQ:
2464 hci_cc_periodic_inq(hdev, skb);
2465 break;
2466
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002467 case HCI_OP_EXIT_PERIODIC_INQ:
2468 hci_cc_exit_periodic_inq(hdev, skb);
2469 break;
2470
2471 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2472 hci_cc_remote_name_req_cancel(hdev, skb);
2473 break;
2474
2475 case HCI_OP_ROLE_DISCOVERY:
2476 hci_cc_role_discovery(hdev, skb);
2477 break;
2478
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002479 case HCI_OP_READ_LINK_POLICY:
2480 hci_cc_read_link_policy(hdev, skb);
2481 break;
2482
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002483 case HCI_OP_WRITE_LINK_POLICY:
2484 hci_cc_write_link_policy(hdev, skb);
2485 break;
2486
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002487 case HCI_OP_READ_DEF_LINK_POLICY:
2488 hci_cc_read_def_link_policy(hdev, skb);
2489 break;
2490
2491 case HCI_OP_WRITE_DEF_LINK_POLICY:
2492 hci_cc_write_def_link_policy(hdev, skb);
2493 break;
2494
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002495 case HCI_OP_RESET:
2496 hci_cc_reset(hdev, skb);
2497 break;
2498
2499 case HCI_OP_WRITE_LOCAL_NAME:
2500 hci_cc_write_local_name(hdev, skb);
2501 break;
2502
2503 case HCI_OP_READ_LOCAL_NAME:
2504 hci_cc_read_local_name(hdev, skb);
2505 break;
2506
2507 case HCI_OP_WRITE_AUTH_ENABLE:
2508 hci_cc_write_auth_enable(hdev, skb);
2509 break;
2510
2511 case HCI_OP_WRITE_ENCRYPT_MODE:
2512 hci_cc_write_encrypt_mode(hdev, skb);
2513 break;
2514
2515 case HCI_OP_WRITE_SCAN_ENABLE:
2516 hci_cc_write_scan_enable(hdev, skb);
2517 break;
2518
2519 case HCI_OP_READ_CLASS_OF_DEV:
2520 hci_cc_read_class_of_dev(hdev, skb);
2521 break;
2522
2523 case HCI_OP_WRITE_CLASS_OF_DEV:
2524 hci_cc_write_class_of_dev(hdev, skb);
2525 break;
2526
2527 case HCI_OP_READ_VOICE_SETTING:
2528 hci_cc_read_voice_setting(hdev, skb);
2529 break;
2530
2531 case HCI_OP_WRITE_VOICE_SETTING:
2532 hci_cc_write_voice_setting(hdev, skb);
2533 break;
2534
Marcel Holtmannb4cb9fb2013-10-14 13:56:16 -07002535 case HCI_OP_READ_NUM_SUPPORTED_IAC:
2536 hci_cc_read_num_supported_iac(hdev, skb);
2537 break;
2538
Marcel Holtmann333140b2008-07-14 20:13:48 +02002539 case HCI_OP_WRITE_SSP_MODE:
2540 hci_cc_write_ssp_mode(hdev, skb);
2541 break;
2542
Marcel Holtmanneac83dc2014-01-10 02:07:23 -08002543 case HCI_OP_WRITE_SC_SUPPORT:
2544 hci_cc_write_sc_support(hdev, skb);
2545 break;
2546
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002547 case HCI_OP_READ_LOCAL_VERSION:
2548 hci_cc_read_local_version(hdev, skb);
2549 break;
2550
2551 case HCI_OP_READ_LOCAL_COMMANDS:
2552 hci_cc_read_local_commands(hdev, skb);
2553 break;
2554
2555 case HCI_OP_READ_LOCAL_FEATURES:
2556 hci_cc_read_local_features(hdev, skb);
2557 break;
2558
Andre Guedes971e3a42011-06-30 19:20:52 -03002559 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2560 hci_cc_read_local_ext_features(hdev, skb);
2561 break;
2562
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002563 case HCI_OP_READ_BUFFER_SIZE:
2564 hci_cc_read_buffer_size(hdev, skb);
2565 break;
2566
2567 case HCI_OP_READ_BD_ADDR:
2568 hci_cc_read_bd_addr(hdev, skb);
2569 break;
2570
Johan Hedbergf332ec62013-03-15 17:07:11 -05002571 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2572 hci_cc_read_page_scan_activity(hdev, skb);
2573 break;
2574
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002575 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2576 hci_cc_write_page_scan_activity(hdev, skb);
2577 break;
2578
Johan Hedbergf332ec62013-03-15 17:07:11 -05002579 case HCI_OP_READ_PAGE_SCAN_TYPE:
2580 hci_cc_read_page_scan_type(hdev, skb);
2581 break;
2582
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002583 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2584 hci_cc_write_page_scan_type(hdev, skb);
2585 break;
2586
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002587 case HCI_OP_READ_DATA_BLOCK_SIZE:
2588 hci_cc_read_data_block_size(hdev, skb);
2589 break;
2590
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002591 case HCI_OP_READ_FLOW_CONTROL_MODE:
2592 hci_cc_read_flow_control_mode(hdev, skb);
2593 break;
2594
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002595 case HCI_OP_READ_LOCAL_AMP_INFO:
2596 hci_cc_read_local_amp_info(hdev, skb);
2597 break;
2598
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002599 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2600 hci_cc_read_local_amp_assoc(hdev, skb);
2601 break;
2602
Johan Hedbergd5859e22011-01-25 01:19:58 +02002603 case HCI_OP_READ_INQ_RSP_TX_POWER:
2604 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2605 break;
2606
Johan Hedberg980e1a52011-01-22 06:10:07 +02002607 case HCI_OP_PIN_CODE_REPLY:
2608 hci_cc_pin_code_reply(hdev, skb);
2609 break;
2610
2611 case HCI_OP_PIN_CODE_NEG_REPLY:
2612 hci_cc_pin_code_neg_reply(hdev, skb);
2613 break;
2614
Szymon Jancc35938b2011-03-22 13:12:21 +01002615 case HCI_OP_READ_LOCAL_OOB_DATA:
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08002616 hci_cc_read_local_oob_data(hdev, skb);
2617 break;
2618
2619 case HCI_OP_READ_LOCAL_OOB_EXT_DATA:
2620 hci_cc_read_local_oob_ext_data(hdev, skb);
Szymon Jancc35938b2011-03-22 13:12:21 +01002621 break;
2622
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002623 case HCI_OP_LE_READ_BUFFER_SIZE:
2624 hci_cc_le_read_buffer_size(hdev, skb);
2625 break;
2626
Johan Hedberg60e77322013-01-22 14:01:59 +02002627 case HCI_OP_LE_READ_LOCAL_FEATURES:
2628 hci_cc_le_read_local_features(hdev, skb);
2629 break;
2630
Johan Hedberg8fa19092012-10-19 20:57:49 +03002631 case HCI_OP_LE_READ_ADV_TX_POWER:
2632 hci_cc_le_read_adv_tx_power(hdev, skb);
2633 break;
2634
Johan Hedberga5c29682011-02-19 12:05:57 -03002635 case HCI_OP_USER_CONFIRM_REPLY:
2636 hci_cc_user_confirm_reply(hdev, skb);
2637 break;
2638
2639 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2640 hci_cc_user_confirm_neg_reply(hdev, skb);
2641 break;
2642
Brian Gix1143d452011-11-23 08:28:34 -08002643 case HCI_OP_USER_PASSKEY_REPLY:
2644 hci_cc_user_passkey_reply(hdev, skb);
2645 break;
2646
2647 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2648 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002649 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002650
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08002651 case HCI_OP_LE_SET_RANDOM_ADDR:
2652 hci_cc_le_set_random_addr(hdev, skb);
2653 break;
2654
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01002655 case HCI_OP_LE_SET_ADV_ENABLE:
2656 hci_cc_le_set_adv_enable(hdev, skb);
2657 break;
2658
Marcel Holtmann533553f2014-03-21 12:18:10 -07002659 case HCI_OP_LE_SET_SCAN_PARAM:
2660 hci_cc_le_set_scan_param(hdev, skb);
2661 break;
2662
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002663 case HCI_OP_LE_SET_SCAN_ENABLE:
2664 hci_cc_le_set_scan_enable(hdev, skb);
2665 break;
2666
Johan Hedbergcf1d0812013-01-22 14:02:00 +02002667 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2668 hci_cc_le_read_white_list_size(hdev, skb);
2669 break;
2670
Marcel Holtmann0f36b582014-02-27 20:37:31 -08002671 case HCI_OP_LE_CLEAR_WHITE_LIST:
2672 hci_cc_le_clear_white_list(hdev, skb);
2673 break;
2674
2675 case HCI_OP_LE_ADD_TO_WHITE_LIST:
2676 hci_cc_le_add_to_white_list(hdev, skb);
2677 break;
2678
2679 case HCI_OP_LE_DEL_FROM_WHITE_LIST:
2680 hci_cc_le_del_from_white_list(hdev, skb);
2681 break;
2682
Johan Hedberg9b008c02013-01-22 14:02:01 +02002683 case HCI_OP_LE_READ_SUPPORTED_STATES:
2684 hci_cc_le_read_supported_states(hdev, skb);
2685 break;
2686
Andre Guedesf9b49302011-06-30 19:20:53 -03002687 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2688 hci_cc_write_le_host_supported(hdev, skb);
2689 break;
2690
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02002691 case HCI_OP_LE_SET_ADV_PARAM:
2692 hci_cc_set_adv_param(hdev, skb);
2693 break;
2694
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03002695 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2696 hci_cc_write_remote_amp_assoc(hdev, skb);
2697 break;
2698
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02002699 case HCI_OP_READ_RSSI:
2700 hci_cc_read_rssi(hdev, skb);
2701 break;
2702
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02002703 case HCI_OP_READ_TX_POWER:
2704 hci_cc_read_tx_power(hdev, skb);
2705 break;
2706
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002707 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002708 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002709 break;
2710 }
2711
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002712 if (opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02002713 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02002714
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002715 hci_req_cmd_complete(hdev, opcode, status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002716
Szymon Jancdbccd792012-12-11 08:51:19 +01002717 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002718 atomic_set(&hdev->cmd_cnt, 1);
2719 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002720 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002721 }
2722}
2723
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002724static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002725{
2726 struct hci_ev_cmd_status *ev = (void *) skb->data;
2727 __u16 opcode;
2728
2729 skb_pull(skb, sizeof(*ev));
2730
2731 opcode = __le16_to_cpu(ev->opcode);
2732
2733 switch (opcode) {
2734 case HCI_OP_INQUIRY:
2735 hci_cs_inquiry(hdev, ev->status);
2736 break;
2737
2738 case HCI_OP_CREATE_CONN:
2739 hci_cs_create_conn(hdev, ev->status);
2740 break;
2741
2742 case HCI_OP_ADD_SCO:
2743 hci_cs_add_sco(hdev, ev->status);
2744 break;
2745
Marcel Holtmannf8558552008-07-14 20:13:49 +02002746 case HCI_OP_AUTH_REQUESTED:
2747 hci_cs_auth_requested(hdev, ev->status);
2748 break;
2749
2750 case HCI_OP_SET_CONN_ENCRYPT:
2751 hci_cs_set_conn_encrypt(hdev, ev->status);
2752 break;
2753
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002754 case HCI_OP_REMOTE_NAME_REQ:
2755 hci_cs_remote_name_req(hdev, ev->status);
2756 break;
2757
Marcel Holtmann769be972008-07-14 20:13:49 +02002758 case HCI_OP_READ_REMOTE_FEATURES:
2759 hci_cs_read_remote_features(hdev, ev->status);
2760 break;
2761
2762 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2763 hci_cs_read_remote_ext_features(hdev, ev->status);
2764 break;
2765
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002766 case HCI_OP_SETUP_SYNC_CONN:
2767 hci_cs_setup_sync_conn(hdev, ev->status);
2768 break;
2769
2770 case HCI_OP_SNIFF_MODE:
2771 hci_cs_sniff_mode(hdev, ev->status);
2772 break;
2773
2774 case HCI_OP_EXIT_SNIFF_MODE:
2775 hci_cs_exit_sniff_mode(hdev, ev->status);
2776 break;
2777
Johan Hedberg8962ee72011-01-20 12:40:27 +02002778 case HCI_OP_DISCONNECT:
Johan Hedberg88c3df12012-02-09 14:27:38 +02002779 hci_cs_disconnect(hdev, ev->status);
Johan Hedberg8962ee72011-01-20 12:40:27 +02002780 break;
2781
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03002782 case HCI_OP_CREATE_PHY_LINK:
2783 hci_cs_create_phylink(hdev, ev->status);
2784 break;
2785
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03002786 case HCI_OP_ACCEPT_PHY_LINK:
2787 hci_cs_accept_phylink(hdev, ev->status);
2788 break;
2789
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02002790 case HCI_OP_LE_CREATE_CONN:
2791 hci_cs_le_create_conn(hdev, ev->status);
2792 break;
2793
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02002794 case HCI_OP_LE_START_ENC:
2795 hci_cs_le_start_enc(hdev, ev->status);
2796 break;
2797
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002798 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002799 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002800 break;
2801 }
2802
Johan Hedbergad82cdd2013-03-09 09:53:50 +02002803 if (opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02002804 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02002805
Johan Hedberg02350a72013-04-03 21:50:29 +03002806 if (ev->status ||
2807 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
2808 hci_req_cmd_complete(hdev, opcode, ev->status);
Johan Hedberg9238f362013-03-05 20:37:48 +02002809
Gustavo F. Padovan10572132011-03-16 15:36:29 -03002810 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002811 atomic_set(&hdev->cmd_cnt, 1);
2812 if (!skb_queue_empty(&hdev->cmd_q))
Gustavo F. Padovanc347b762011-12-14 23:53:47 -02002813 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002814 }
2815}
2816
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002817static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002818{
2819 struct hci_ev_role_change *ev = (void *) skb->data;
2820 struct hci_conn *conn;
2821
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002822 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002823
2824 hci_dev_lock(hdev);
2825
2826 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2827 if (conn) {
2828 if (!ev->status) {
2829 if (ev->role)
2830 conn->link_mode &= ~HCI_LM_MASTER;
2831 else
2832 conn->link_mode |= HCI_LM_MASTER;
2833 }
2834
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002835 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002836
2837 hci_role_switch_cfm(conn, ev->status, ev->role);
2838 }
2839
2840 hci_dev_unlock(hdev);
2841}
2842
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002843static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002844{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002845 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002846 int i;
2847
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02002848 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2849 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2850 return;
2851 }
2852
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002853 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002854 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002855 BT_DBG("%s bad parameters", hdev->name);
2856 return;
2857 }
2858
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02002859 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2860
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002861 for (i = 0; i < ev->num_hndl; i++) {
2862 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002863 struct hci_conn *conn;
2864 __u16 handle, count;
2865
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02002866 handle = __le16_to_cpu(info->handle);
2867 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002868
2869 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002870 if (!conn)
2871 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002872
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002873 conn->sent -= count;
2874
2875 switch (conn->type) {
2876 case ACL_LINK:
2877 hdev->acl_cnt += count;
2878 if (hdev->acl_cnt > hdev->acl_pkts)
2879 hdev->acl_cnt = hdev->acl_pkts;
2880 break;
2881
2882 case LE_LINK:
2883 if (hdev->le_pkts) {
2884 hdev->le_cnt += count;
2885 if (hdev->le_cnt > hdev->le_pkts)
2886 hdev->le_cnt = hdev->le_pkts;
2887 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02002888 hdev->acl_cnt += count;
2889 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002890 hdev->acl_cnt = hdev->acl_pkts;
2891 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02002892 break;
2893
2894 case SCO_LINK:
2895 hdev->sco_cnt += count;
2896 if (hdev->sco_cnt > hdev->sco_pkts)
2897 hdev->sco_cnt = hdev->sco_pkts;
2898 break;
2899
2900 default:
2901 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2902 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002903 }
2904 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002905
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02002906 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002907}
2908
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002909static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
2910 __u16 handle)
2911{
2912 struct hci_chan *chan;
2913
2914 switch (hdev->dev_type) {
2915 case HCI_BREDR:
2916 return hci_conn_hash_lookup_handle(hdev, handle);
2917 case HCI_AMP:
2918 chan = hci_chan_lookup_handle(hdev, handle);
2919 if (chan)
2920 return chan->conn;
2921 break;
2922 default:
2923 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
2924 break;
2925 }
2926
2927 return NULL;
2928}
2929
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002930static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002931{
2932 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2933 int i;
2934
2935 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2936 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2937 return;
2938 }
2939
2940 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03002941 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002942 BT_DBG("%s bad parameters", hdev->name);
2943 return;
2944 }
2945
2946 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002947 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002948
2949 for (i = 0; i < ev->num_hndl; i++) {
2950 struct hci_comp_blocks_info *info = &ev->handles[i];
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002951 struct hci_conn *conn = NULL;
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002952 __u16 handle, block_count;
2953
2954 handle = __le16_to_cpu(info->handle);
2955 block_count = __le16_to_cpu(info->blocks);
2956
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03002957 conn = __hci_conn_lookup_handle(hdev, handle);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002958 if (!conn)
2959 continue;
2960
2961 conn->sent -= block_count;
2962
2963 switch (conn->type) {
2964 case ACL_LINK:
Andrei Emeltchenkobd1eb662012-10-10 17:38:30 +03002965 case AMP_LINK:
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02002966 hdev->block_cnt += block_count;
2967 if (hdev->block_cnt > hdev->num_blocks)
2968 hdev->block_cnt = hdev->num_blocks;
2969 break;
2970
2971 default:
2972 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2973 break;
2974 }
2975 }
2976
2977 queue_work(hdev->workqueue, &hdev->tx_work);
2978}
2979
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002980static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002981{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002982 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002983 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002984
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002985 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002986
2987 hci_dev_lock(hdev);
2988
Marcel Holtmann04837f62006-07-03 10:02:33 +02002989 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2990 if (conn) {
2991 conn->mode = ev->mode;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002992
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03002993 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2994 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02002995 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02002996 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002997 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02002998 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02002999 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003000
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003001 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003002 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003003 }
3004
3005 hci_dev_unlock(hdev);
3006}
3007
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003008static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003009{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003010 struct hci_ev_pin_code_req *ev = (void *) skb->data;
3011 struct hci_conn *conn;
3012
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003013 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003014
3015 hci_dev_lock(hdev);
3016
3017 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003018 if (!conn)
3019 goto unlock;
3020
3021 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003022 hci_conn_hold(conn);
3023 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003024 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003025 }
3026
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003027 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003028 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003029 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003030 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003031 u8 secure;
3032
3033 if (conn->pending_sec_level == BT_SECURITY_HIGH)
3034 secure = 1;
3035 else
3036 secure = 0;
3037
Johan Hedberg744cf192011-11-08 20:40:14 +02003038 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003039 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02003040
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003041unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003042 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003043}
3044
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003045static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003046{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003047 struct hci_ev_link_key_req *ev = (void *) skb->data;
3048 struct hci_cp_link_key_reply cp;
3049 struct hci_conn *conn;
3050 struct link_key *key;
3051
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003052 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003053
Andrei Emeltchenko034cbea2013-05-14 11:44:16 +03003054 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003055 return;
3056
3057 hci_dev_lock(hdev);
3058
3059 key = hci_find_link_key(hdev, &ev->bdaddr);
3060 if (!key) {
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003061 BT_DBG("%s link key not found for %pMR", hdev->name,
3062 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003063 goto not_found;
3064 }
3065
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003066 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
3067 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003068
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003069 if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003070 key->type == HCI_LK_DEBUG_COMBINATION) {
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003071 BT_DBG("%s ignoring debug key", hdev->name);
3072 goto not_found;
3073 }
3074
3075 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003076 if (conn) {
Marcel Holtmann66138ce2014-01-10 02:07:20 -08003077 if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
3078 key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003079 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003080 BT_DBG("%s ignoring unauthenticated key", hdev->name);
3081 goto not_found;
3082 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003083
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003084 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Johan Hedbergf3fb0b52014-06-02 10:12:44 +03003085 (conn->pending_sec_level == BT_SECURITY_HIGH ||
3086 conn->pending_sec_level == BT_SECURITY_FIPS)) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003087 BT_DBG("%s ignoring key unauthenticated for high security",
3088 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003089 goto not_found;
3090 }
3091
3092 conn->key_type = key->type;
3093 conn->pin_length = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003094 }
3095
3096 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03003097 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003098
3099 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
3100
3101 hci_dev_unlock(hdev);
3102
3103 return;
3104
3105not_found:
3106 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
3107 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003108}
3109
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003110static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003111{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003112 struct hci_ev_link_key_notify *ev = (void *) skb->data;
3113 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003114 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003115
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003116 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003117
3118 hci_dev_lock(hdev);
3119
3120 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3121 if (conn) {
3122 hci_conn_hold(conn);
3123 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Johan Hedberg980e1a52011-01-22 06:10:07 +02003124 pin_len = conn->pin_length;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02003125
3126 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
3127 conn->key_type = ev->key_type;
3128
David Herrmann76a68ba2013-04-06 20:28:37 +02003129 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003130 }
3131
Andrei Emeltchenko034cbea2013-05-14 11:44:16 +03003132 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedbergd25e28a2011-04-28 11:28:59 -07003133 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003134 ev->key_type, pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003135
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003136 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003137}
3138
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003139static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02003140{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003141 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003142 struct hci_conn *conn;
3143
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003144 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003145
3146 hci_dev_lock(hdev);
3147
3148 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003149 if (conn && !ev->status) {
3150 struct inquiry_entry *ie;
3151
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003152 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3153 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003154 ie->data.clock_offset = ev->clock_offset;
3155 ie->timestamp = jiffies;
3156 }
3157 }
3158
3159 hci_dev_unlock(hdev);
3160}
3161
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003162static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02003163{
3164 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
3165 struct hci_conn *conn;
3166
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003167 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02003168
3169 hci_dev_lock(hdev);
3170
3171 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3172 if (conn && !ev->status)
3173 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
3174
3175 hci_dev_unlock(hdev);
3176}
3177
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003178static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003179{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003180 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003181 struct inquiry_entry *ie;
3182
3183 BT_DBG("%s", hdev->name);
3184
3185 hci_dev_lock(hdev);
3186
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003187 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3188 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003189 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
3190 ie->timestamp = jiffies;
3191 }
3192
3193 hci_dev_unlock(hdev);
3194}
3195
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003196static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
3197 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003198{
3199 struct inquiry_data data;
3200 int num_rsp = *((__u8 *) skb->data);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003201 bool name_known, ssp;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003202
3203 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3204
3205 if (!num_rsp)
3206 return;
3207
Andre Guedes1519cc12012-03-21 00:03:38 -03003208 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3209 return;
3210
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003211 hci_dev_lock(hdev);
3212
3213 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01003214 struct inquiry_info_with_rssi_and_pscan_mode *info;
3215 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003216
Johan Hedberge17acd42011-03-30 23:57:16 +03003217 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003218 bacpy(&data.bdaddr, &info->bdaddr);
3219 data.pscan_rep_mode = info->pscan_rep_mode;
3220 data.pscan_period_mode = info->pscan_period_mode;
3221 data.pscan_mode = info->pscan_mode;
3222 memcpy(data.dev_class, info->dev_class, 3);
3223 data.clock_offset = info->clock_offset;
3224 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003225 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02003226
3227 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003228 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02003229 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003230 info->dev_class, info->rssi,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02003231 !name_known, ssp, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003232 }
3233 } else {
3234 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
3235
Johan Hedberge17acd42011-03-30 23:57:16 +03003236 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003237 bacpy(&data.bdaddr, &info->bdaddr);
3238 data.pscan_rep_mode = info->pscan_rep_mode;
3239 data.pscan_period_mode = info->pscan_period_mode;
3240 data.pscan_mode = 0x00;
3241 memcpy(data.dev_class, info->dev_class, 3);
3242 data.clock_offset = info->clock_offset;
3243 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003244 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02003245 name_known = hci_inquiry_cache_update(hdev, &data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003246 false, &ssp);
Johan Hedberg48264f02011-11-09 13:58:58 +02003247 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003248 info->dev_class, info->rssi,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02003249 !name_known, ssp, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003250 }
3251 }
3252
3253 hci_dev_unlock(hdev);
3254}
3255
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003256static void hci_remote_ext_features_evt(struct hci_dev *hdev,
3257 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003258{
Marcel Holtmann41a96212008-07-14 20:13:48 +02003259 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
3260 struct hci_conn *conn;
3261
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003262 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003263
Marcel Holtmann41a96212008-07-14 20:13:48 +02003264 hci_dev_lock(hdev);
3265
3266 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02003267 if (!conn)
3268 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003269
Johan Hedbergcad718e2013-04-17 15:00:51 +03003270 if (ev->page < HCI_MAX_PAGES)
3271 memcpy(conn->features[ev->page], ev->features, 8);
3272
Johan Hedbergccd556f2010-11-10 17:11:51 +02003273 if (!ev->status && ev->page == 0x01) {
3274 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003275
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003276 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3277 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003278 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02003279
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303280 if (ev->features[0] & LMP_HOST_SSP) {
Johan Hedberg58a681e2012-01-16 06:47:28 +02003281 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303282 } else {
3283 /* It is mandatory by the Bluetooth specification that
3284 * Extended Inquiry Results are only used when Secure
3285 * Simple Pairing is enabled, but some devices violate
3286 * this.
3287 *
3288 * To make these devices work, the internal SSP
3289 * enabled flag needs to be cleared if the remote host
3290 * features do not indicate SSP support */
3291 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
3292 }
Marcel Holtmanneb9a8f32014-01-15 22:37:38 -08003293
3294 if (ev->features[0] & LMP_HOST_SC)
3295 set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003296 }
3297
Johan Hedbergccd556f2010-11-10 17:11:51 +02003298 if (conn->state != BT_CONFIG)
3299 goto unlock;
3300
Johan Hedberg671267b2012-05-12 16:11:50 -03003301 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02003302 struct hci_cp_remote_name_req cp;
3303 memset(&cp, 0, sizeof(cp));
3304 bacpy(&cp.bdaddr, &conn->dst);
3305 cp.pscan_rep_mode = 0x02;
3306 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003307 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3308 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003309 conn->dst_type, 0, NULL, 0,
3310 conn->dev_class);
Johan Hedberg392599b2010-11-18 22:22:28 +02003311
Johan Hedberg127178d2010-11-18 22:22:29 +02003312 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02003313 conn->state = BT_CONNECTED;
3314 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003315 hci_conn_drop(conn);
Johan Hedbergccd556f2010-11-10 17:11:51 +02003316 }
3317
3318unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02003319 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003320}
3321
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003322static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3323 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003324{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003325 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3326 struct hci_conn *conn;
3327
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003328 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003329
3330 hci_dev_lock(hdev);
3331
3332 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003333 if (!conn) {
3334 if (ev->link_type == ESCO_LINK)
3335 goto unlock;
3336
3337 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3338 if (!conn)
3339 goto unlock;
3340
3341 conn->type = SCO_LINK;
3342 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003343
Marcel Holtmann732547f2009-04-19 19:14:14 +02003344 switch (ev->status) {
3345 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003346 conn->handle = __le16_to_cpu(ev->handle);
3347 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003348
3349 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02003350 break;
3351
Frédéric Dalleau1a4c9582013-08-19 14:24:02 +02003352 case 0x0d: /* Connection Rejected due to Limited Resources */
Stephen Coe705e5712010-02-16 11:29:44 -05003353 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003354 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08003355 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003356 case 0x1f: /* Unspecified error */
Andrew Earl27539bc2014-03-10 10:31:04 +00003357 case 0x20: /* Unsupported LMP Parameter value */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003358 if (conn->out) {
Marcel Holtmann732547f2009-04-19 19:14:14 +02003359 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3360 (hdev->esco_type & EDR_ESCO_MASK);
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003361 if (hci_setup_sync(conn, conn->link->handle))
3362 goto unlock;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003363 }
3364 /* fall through */
3365
3366 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003367 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003368 break;
3369 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003370
3371 hci_proto_connect_cfm(conn, ev->status);
3372 if (ev->status)
3373 hci_conn_del(conn);
3374
3375unlock:
3376 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003377}
3378
Marcel Holtmannefdcf8e2013-10-15 10:31:12 -07003379static inline size_t eir_get_length(u8 *eir, size_t eir_len)
3380{
3381 size_t parsed = 0;
3382
3383 while (parsed < eir_len) {
3384 u8 field_len = eir[0];
3385
3386 if (field_len == 0)
3387 return parsed;
3388
3389 parsed += field_len + 1;
3390 eir += field_len + 1;
3391 }
3392
3393 return eir_len;
3394}
3395
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003396static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3397 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003398{
3399 struct inquiry_data data;
3400 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3401 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303402 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003403
3404 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3405
3406 if (!num_rsp)
3407 return;
3408
Andre Guedes1519cc12012-03-21 00:03:38 -03003409 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3410 return;
3411
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003412 hci_dev_lock(hdev);
3413
Johan Hedberge17acd42011-03-30 23:57:16 +03003414 for (; num_rsp; num_rsp--, info++) {
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003415 bool name_known, ssp;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003416
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003417 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01003418 data.pscan_rep_mode = info->pscan_rep_mode;
3419 data.pscan_period_mode = info->pscan_period_mode;
3420 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003421 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01003422 data.clock_offset = info->clock_offset;
3423 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003424 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003425
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003426 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02003427 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003428 sizeof(info->data),
3429 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02003430 else
3431 name_known = true;
3432
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003433 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003434 &ssp);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303435 eir_len = eir_get_length(info->data, sizeof(info->data));
Johan Hedberg48264f02011-11-09 13:58:58 +02003436 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003437 info->dev_class, info->rssi, !name_known,
Johan Hedberg5d2e9fa2014-03-25 10:30:47 +02003438 ssp, info->data, eir_len, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003439 }
3440
3441 hci_dev_unlock(hdev);
3442}
3443
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003444static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3445 struct sk_buff *skb)
3446{
3447 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3448 struct hci_conn *conn;
3449
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003450 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003451 __le16_to_cpu(ev->handle));
3452
3453 hci_dev_lock(hdev);
3454
3455 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3456 if (!conn)
3457 goto unlock;
3458
Johan Hedberg9eb1fbf2014-04-11 12:02:31 -07003459 /* For BR/EDR the necessary steps are taken through the
3460 * auth_complete event.
3461 */
3462 if (conn->type != LE_LINK)
3463 goto unlock;
3464
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003465 if (!ev->status)
3466 conn->sec_level = conn->pending_sec_level;
3467
3468 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3469
3470 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03003471 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02003472 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003473 goto unlock;
3474 }
3475
3476 if (conn->state == BT_CONFIG) {
3477 if (!ev->status)
3478 conn->state = BT_CONNECTED;
3479
3480 hci_proto_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003481 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003482 } else {
3483 hci_auth_cfm(conn, ev->status);
3484
3485 hci_conn_hold(conn);
3486 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003487 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003488 }
3489
3490unlock:
3491 hci_dev_unlock(hdev);
3492}
3493
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003494static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003495{
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003496 /* If remote requests no-bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02003497 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3498 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003499 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003500
Mikel Astizb7f94c82014-04-08 14:21:31 +02003501 /* If both remote and local have enough IO capabilities, require
3502 * MITM protection
3503 */
3504 if (conn->remote_cap != HCI_IO_NO_INPUT_OUTPUT &&
3505 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT)
3506 return conn->remote_auth | 0x01;
3507
Timo Mueller7e741702014-04-08 14:21:33 +02003508 /* No MITM protection possible so ignore remote requirement */
3509 return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003510}
3511
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003512static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003513{
3514 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3515 struct hci_conn *conn;
3516
3517 BT_DBG("%s", hdev->name);
3518
3519 hci_dev_lock(hdev);
3520
3521 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003522 if (!conn)
3523 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003524
Johan Hedberg03b555e2011-01-04 15:40:05 +02003525 hci_conn_hold(conn);
3526
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003527 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003528 goto unlock;
3529
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003530 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003531 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003532 struct hci_cp_io_capability_reply cp;
3533
3534 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303535 /* Change the IO capability from KeyboardDisplay
3536 * to DisplayYesNo as it is not supported by BT spec. */
3537 cp.capability = (conn->io_capability == 0x04) ?
Mikel Astiza7676312013-06-28 10:56:29 +02003538 HCI_IO_DISPLAY_YESNO : conn->io_capability;
Mikel Astizb7f94c82014-04-08 14:21:31 +02003539
3540 /* If we are initiators, there is no remote information yet */
3541 if (conn->remote_auth == 0xff) {
3542 cp.authentication = conn->auth_type;
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003543
Mikel Astizb16c6602014-04-08 14:21:34 +02003544 /* Request MITM protection if our IO caps allow it
Johan Hedberg4ad51a72014-06-09 14:41:25 +03003545 * except for the no-bonding case.
3546 * conn->auth_type is not updated here since
3547 * that might cause the user confirmation to be
3548 * rejected in case the remote doesn't have the
3549 * IO capabilities for MITM.
Mikel Astizb16c6602014-04-08 14:21:34 +02003550 */
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003551 if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
Mikel Astizb16c6602014-04-08 14:21:34 +02003552 cp.authentication != HCI_AT_NO_BONDING)
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003553 cp.authentication |= 0x01;
Mikel Astizb7f94c82014-04-08 14:21:31 +02003554 } else {
3555 conn->auth_type = hci_get_auth_req(conn);
3556 cp.authentication = conn->auth_type;
3557 }
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003558
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003559 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3560 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
Szymon Jancce85ee12011-03-22 13:12:23 +01003561 cp.oob_data = 0x01;
3562 else
3563 cp.oob_data = 0x00;
3564
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003565 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003566 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003567 } else {
3568 struct hci_cp_io_capability_neg_reply cp;
3569
3570 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02003571 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003572
3573 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003574 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003575 }
3576
3577unlock:
3578 hci_dev_unlock(hdev);
3579}
3580
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003581static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02003582{
3583 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3584 struct hci_conn *conn;
3585
3586 BT_DBG("%s", hdev->name);
3587
3588 hci_dev_lock(hdev);
3589
3590 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3591 if (!conn)
3592 goto unlock;
3593
Johan Hedberg03b555e2011-01-04 15:40:05 +02003594 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02003595 conn->remote_auth = ev->authentication;
Johan Hedberg58a681e2012-01-16 06:47:28 +02003596 if (ev->oob_data)
3597 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003598
3599unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003600 hci_dev_unlock(hdev);
3601}
3602
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003603static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3604 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03003605{
3606 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003607 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07003608 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03003609
3610 BT_DBG("%s", hdev->name);
3611
3612 hci_dev_lock(hdev);
3613
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003614 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg7a828902011-04-28 11:28:53 -07003615 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03003616
Johan Hedberg7a828902011-04-28 11:28:53 -07003617 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3618 if (!conn)
3619 goto unlock;
3620
3621 loc_mitm = (conn->auth_type & 0x01);
3622 rem_mitm = (conn->remote_auth & 0x01);
3623
3624 /* If we require MITM but the remote device can't provide that
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003625 * (it has NoInputNoOutput) then reject the confirmation request
3626 */
3627 if (loc_mitm && conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
Johan Hedberg7a828902011-04-28 11:28:53 -07003628 BT_DBG("Rejecting request: remote device can't provide MITM");
3629 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003630 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003631 goto unlock;
3632 }
3633
3634 /* If no side requires MITM protection; auto-accept */
Mikel Astiza7676312013-06-28 10:56:29 +02003635 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
3636 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003637
3638 /* If we're not the initiators request authorization to
3639 * proceed from user space (mgmt_user_confirm with
Johan Hedbergba15a582014-06-09 13:58:14 +03003640 * confirm_hint set to 1). The exception is if neither
3641 * side had MITM in which case we do auto-accept.
3642 */
3643 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
3644 (loc_mitm || rem_mitm)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003645 BT_DBG("Confirming auto-accept as acceptor");
3646 confirm_hint = 1;
3647 goto confirm;
3648 }
3649
Johan Hedberg9f616562011-04-28 11:28:54 -07003650 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03003651 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003652
3653 if (hdev->auto_accept_delay > 0) {
3654 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
Johan Hedberg7bc18d92013-10-16 18:11:39 +03003655 queue_delayed_work(conn->hdev->workqueue,
3656 &conn->auto_accept_work, delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07003657 goto unlock;
3658 }
3659
Johan Hedberg7a828902011-04-28 11:28:53 -07003660 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003661 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07003662 goto unlock;
3663 }
3664
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003665confirm:
Johan Hedberg39adbff2014-03-20 08:18:14 +02003666 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
3667 le32_to_cpu(ev->passkey), confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07003668
3669unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03003670 hci_dev_unlock(hdev);
3671}
3672
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003673static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3674 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08003675{
3676 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3677
3678 BT_DBG("%s", hdev->name);
3679
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003680 if (test_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg272d90d2012-02-09 15:26:12 +02003681 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08003682}
3683
Johan Hedberg92a25252012-09-06 18:39:26 +03003684static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3685 struct sk_buff *skb)
3686{
3687 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3688 struct hci_conn *conn;
3689
3690 BT_DBG("%s", hdev->name);
3691
3692 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3693 if (!conn)
3694 return;
3695
3696 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3697 conn->passkey_entered = 0;
3698
3699 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3700 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3701 conn->dst_type, conn->passkey_notify,
3702 conn->passkey_entered);
3703}
3704
3705static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3706{
3707 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3708 struct hci_conn *conn;
3709
3710 BT_DBG("%s", hdev->name);
3711
3712 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3713 if (!conn)
3714 return;
3715
3716 switch (ev->type) {
3717 case HCI_KEYPRESS_STARTED:
3718 conn->passkey_entered = 0;
3719 return;
3720
3721 case HCI_KEYPRESS_ENTERED:
3722 conn->passkey_entered++;
3723 break;
3724
3725 case HCI_KEYPRESS_ERASED:
3726 conn->passkey_entered--;
3727 break;
3728
3729 case HCI_KEYPRESS_CLEARED:
3730 conn->passkey_entered = 0;
3731 break;
3732
3733 case HCI_KEYPRESS_COMPLETED:
3734 return;
3735 }
3736
3737 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3738 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3739 conn->dst_type, conn->passkey_notify,
3740 conn->passkey_entered);
3741}
3742
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003743static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3744 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003745{
3746 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3747 struct hci_conn *conn;
3748
3749 BT_DBG("%s", hdev->name);
3750
3751 hci_dev_lock(hdev);
3752
3753 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03003754 if (!conn)
3755 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003756
Johan Hedberg2a611692011-02-19 12:06:00 -03003757 /* To avoid duplicate auth_failed events to user space we check
3758 * the HCI_CONN_AUTH_PEND flag which will be set if we
3759 * initiated the authentication. A traditional auth_complete
3760 * event gets always produced as initiator and is also mapped to
3761 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02003762 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003763 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003764 ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003765
David Herrmann76a68ba2013-04-06 20:28:37 +02003766 hci_conn_drop(conn);
Johan Hedberg2a611692011-02-19 12:06:00 -03003767
3768unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02003769 hci_dev_unlock(hdev);
3770}
3771
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003772static void hci_remote_host_features_evt(struct hci_dev *hdev,
3773 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02003774{
3775 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3776 struct inquiry_entry *ie;
Johan Hedbergcad718e2013-04-17 15:00:51 +03003777 struct hci_conn *conn;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003778
3779 BT_DBG("%s", hdev->name);
3780
3781 hci_dev_lock(hdev);
3782
Johan Hedbergcad718e2013-04-17 15:00:51 +03003783 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3784 if (conn)
3785 memcpy(conn->features[1], ev->features, 8);
3786
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003787 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3788 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003789 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003790
3791 hci_dev_unlock(hdev);
3792}
3793
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003794static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3795 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01003796{
3797 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3798 struct oob_data *data;
3799
3800 BT_DBG("%s", hdev->name);
3801
3802 hci_dev_lock(hdev);
3803
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02003804 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
Szymon Jance1ba1f12011-04-06 13:01:59 +02003805 goto unlock;
3806
Szymon Janc2763eda2011-03-22 13:12:22 +01003807 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3808 if (data) {
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003809 if (test_bit(HCI_SC_ENABLED, &hdev->dev_flags)) {
3810 struct hci_cp_remote_oob_ext_data_reply cp;
Szymon Janc2763eda2011-03-22 13:12:22 +01003811
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003812 bacpy(&cp.bdaddr, &ev->bdaddr);
3813 memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
3814 memcpy(cp.randomizer192, data->randomizer192,
3815 sizeof(cp.randomizer192));
3816 memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
3817 memcpy(cp.randomizer256, data->randomizer256,
3818 sizeof(cp.randomizer256));
Szymon Janc2763eda2011-03-22 13:12:22 +01003819
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003820 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
3821 sizeof(cp), &cp);
3822 } else {
3823 struct hci_cp_remote_oob_data_reply cp;
3824
3825 bacpy(&cp.bdaddr, &ev->bdaddr);
3826 memcpy(cp.hash, data->hash192, sizeof(cp.hash));
3827 memcpy(cp.randomizer, data->randomizer192,
3828 sizeof(cp.randomizer));
3829
3830 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
3831 sizeof(cp), &cp);
3832 }
Szymon Janc2763eda2011-03-22 13:12:22 +01003833 } else {
3834 struct hci_cp_remote_oob_data_neg_reply cp;
3835
3836 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08003837 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
3838 sizeof(cp), &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01003839 }
3840
Szymon Jance1ba1f12011-04-06 13:01:59 +02003841unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01003842 hci_dev_unlock(hdev);
3843}
3844
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003845static void hci_phy_link_complete_evt(struct hci_dev *hdev,
3846 struct sk_buff *skb)
3847{
3848 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
3849 struct hci_conn *hcon, *bredr_hcon;
3850
3851 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
3852 ev->status);
3853
3854 hci_dev_lock(hdev);
3855
3856 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3857 if (!hcon) {
3858 hci_dev_unlock(hdev);
3859 return;
3860 }
3861
3862 if (ev->status) {
3863 hci_conn_del(hcon);
3864 hci_dev_unlock(hdev);
3865 return;
3866 }
3867
3868 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
3869
3870 hcon->state = BT_CONNECTED;
3871 bacpy(&hcon->dst, &bredr_hcon->dst);
3872
3873 hci_conn_hold(hcon);
3874 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003875 hci_conn_drop(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003876
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003877 hci_conn_add_sysfs(hcon);
3878
Andrei Emeltchenkocf70ff22012-10-31 15:46:36 +02003879 amp_physical_cfm(bredr_hcon, hcon);
3880
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003881 hci_dev_unlock(hdev);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03003882}
3883
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03003884static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3885{
3886 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
3887 struct hci_conn *hcon;
3888 struct hci_chan *hchan;
3889 struct amp_mgr *mgr;
3890
3891 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
3892 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
3893 ev->status);
3894
3895 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3896 if (!hcon)
3897 return;
3898
3899 /* Create AMP hchan */
3900 hchan = hci_chan_create(hcon);
3901 if (!hchan)
3902 return;
3903
3904 hchan->handle = le16_to_cpu(ev->handle);
3905
3906 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
3907
3908 mgr = hcon->amp_mgr;
3909 if (mgr && mgr->bredr_chan) {
3910 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
3911
3912 l2cap_chan_lock(bredr_chan);
3913
3914 bredr_chan->conn->mtu = hdev->block_mtu;
3915 l2cap_logical_cfm(bredr_chan, hchan, 0);
3916 hci_conn_hold(hcon);
3917
3918 l2cap_chan_unlock(bredr_chan);
3919 }
3920}
3921
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02003922static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
3923 struct sk_buff *skb)
3924{
3925 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
3926 struct hci_chan *hchan;
3927
3928 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
3929 le16_to_cpu(ev->handle), ev->status);
3930
3931 if (ev->status)
3932 return;
3933
3934 hci_dev_lock(hdev);
3935
3936 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
3937 if (!hchan)
3938 goto unlock;
3939
3940 amp_destroy_logical_link(hchan, ev->reason);
3941
3942unlock:
3943 hci_dev_unlock(hdev);
3944}
3945
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02003946static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
3947 struct sk_buff *skb)
3948{
3949 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
3950 struct hci_conn *hcon;
3951
3952 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3953
3954 if (ev->status)
3955 return;
3956
3957 hci_dev_lock(hdev);
3958
3959 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3960 if (hcon) {
3961 hcon->state = BT_CLOSED;
3962 hci_conn_del(hcon);
3963 }
3964
3965 hci_dev_unlock(hdev);
3966}
3967
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003968static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03003969{
3970 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3971 struct hci_conn *conn;
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02003972 struct smp_irk *irk;
Ville Tervofcd89c02011-02-10 22:38:47 -03003973
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003974 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03003975
3976 hci_dev_lock(hdev);
3977
Andre Guedesb47a09b2012-07-27 15:10:15 -03003978 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03003979 if (!conn) {
3980 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
3981 if (!conn) {
3982 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03003983 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03003984 }
Andre Guedes29b79882011-05-31 14:20:54 -03003985
3986 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03003987
3988 if (ev->role == LE_CONN_ROLE_MASTER) {
3989 conn->out = true;
3990 conn->link_mode |= HCI_LM_MASTER;
3991 }
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02003992
3993 /* If we didn't have a hci_conn object previously
3994 * but we're in master role this must be something
3995 * initiated using a white list. Since white list based
3996 * connections are not "first class citizens" we don't
3997 * have full tracking of them. Therefore, we go ahead
3998 * with a "best effort" approach of determining the
3999 * initiator address based on the HCI_PRIVACY flag.
4000 */
4001 if (conn->out) {
4002 conn->resp_addr_type = ev->bdaddr_type;
4003 bacpy(&conn->resp_addr, &ev->bdaddr);
4004 if (test_bit(HCI_PRIVACY, &hdev->dev_flags)) {
4005 conn->init_addr_type = ADDR_LE_DEV_RANDOM;
4006 bacpy(&conn->init_addr, &hdev->rpa);
4007 } else {
4008 hci_copy_identity_address(hdev,
4009 &conn->init_addr,
4010 &conn->init_addr_type);
4011 }
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004012 }
Johan Hedberg9489eca2014-02-28 17:45:46 +02004013 } else {
4014 cancel_delayed_work(&conn->le_conn_timeout);
Ville Tervob62f3282011-02-10 22:38:50 -03004015 }
Ville Tervofcd89c02011-02-10 22:38:47 -03004016
Johan Hedberg80c24ab2014-03-24 20:21:51 +02004017 if (!conn->out) {
4018 /* Set the responder (our side) address type based on
4019 * the advertising address type.
4020 */
4021 conn->resp_addr_type = hdev->adv_addr_type;
4022 if (hdev->adv_addr_type == ADDR_LE_DEV_RANDOM)
4023 bacpy(&conn->resp_addr, &hdev->random_addr);
4024 else
4025 bacpy(&conn->resp_addr, &hdev->bdaddr);
4026
4027 conn->init_addr_type = ev->bdaddr_type;
4028 bacpy(&conn->init_addr, &ev->bdaddr);
4029 }
Johan Hedberg7be2edb2014-02-23 19:42:17 +02004030
Marcel Holtmannedb4b462014-02-18 15:13:43 -08004031 /* Lookup the identity address from the stored connection
4032 * address and address type.
4033 *
4034 * When establishing connections to an identity address, the
4035 * connection procedure will store the resolvable random
4036 * address first. Now if it can be converted back into the
4037 * identity address, start using the identity address from
4038 * now on.
4039 */
4040 irk = hci_get_irk(hdev, &conn->dst, conn->dst_type);
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02004041 if (irk) {
4042 bacpy(&conn->dst, &irk->bdaddr);
4043 conn->dst_type = irk->addr_type;
4044 }
4045
Andre Guedescd17dec2012-07-27 15:10:16 -03004046 if (ev->status) {
Andre Guedes06c053f2014-02-26 20:21:41 -03004047 hci_le_conn_failed(conn, ev->status);
Andre Guedescd17dec2012-07-27 15:10:16 -03004048 goto unlock;
4049 }
4050
Johan Hedbergb644ba32012-01-17 21:48:47 +02004051 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Marcel Holtmann01fdb0f2014-02-18 14:22:19 -08004052 mgmt_device_connected(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03004053 conn->dst_type, 0, NULL, 0, NULL);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03004054
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03004055 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03004056 conn->handle = __le16_to_cpu(ev->handle);
4057 conn->state = BT_CONNECTED;
4058
Jukka Rissanen18722c22013-12-11 17:05:37 +02004059 if (test_bit(HCI_6LOWPAN_ENABLED, &hdev->dev_flags))
4060 set_bit(HCI_CONN_6LOWPAN, &conn->flags);
4061
Ville Tervofcd89c02011-02-10 22:38:47 -03004062 hci_conn_add_sysfs(conn);
4063
4064 hci_proto_connect_cfm(conn, ev->status);
4065
Andre Guedesa4790db2014-02-26 20:21:47 -03004066 hci_pend_le_conn_del(hdev, &conn->dst, conn->dst_type);
4067
Ville Tervofcd89c02011-02-10 22:38:47 -03004068unlock:
4069 hci_dev_unlock(hdev);
4070}
4071
Andre Guedesa4790db2014-02-26 20:21:47 -03004072/* This function requires the caller holds hdev->lock */
4073static void check_pending_le_conn(struct hci_dev *hdev, bdaddr_t *addr,
4074 u8 addr_type)
4075{
4076 struct hci_conn *conn;
Andre Guedes5b906a82014-02-26 20:21:53 -03004077 struct smp_irk *irk;
4078
4079 /* If this is a resolvable address, we should resolve it and then
4080 * update address and address type variables.
4081 */
4082 irk = hci_get_irk(hdev, addr, addr_type);
4083 if (irk) {
4084 addr = &irk->bdaddr;
4085 addr_type = irk->addr_type;
4086 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004087
4088 if (!hci_pend_le_conn_lookup(hdev, addr, addr_type))
4089 return;
4090
4091 conn = hci_connect_le(hdev, addr, addr_type, BT_SECURITY_LOW,
4092 HCI_AT_NO_BONDING);
4093 if (!IS_ERR(conn))
4094 return;
4095
4096 switch (PTR_ERR(conn)) {
4097 case -EBUSY:
4098 /* If hci_connect() returns -EBUSY it means there is already
4099 * an LE connection attempt going on. Since controllers don't
4100 * support more than one connection attempt at the time, we
4101 * don't consider this an error case.
4102 */
4103 break;
4104 default:
4105 BT_DBG("Failed to connect: err %ld", PTR_ERR(conn));
4106 }
4107}
4108
Johan Hedberg4af605d2014-03-24 10:48:00 +02004109static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
4110 u8 bdaddr_type, s8 rssi, u8 *data, u8 len)
4111{
Johan Hedbergb9a63282014-03-25 10:51:52 +02004112 struct discovery_state *d = &hdev->discovery;
Johan Hedberg474ee062014-03-25 14:34:59 +02004113 bool match;
Johan Hedbergb9a63282014-03-25 10:51:52 +02004114
Johan Hedbergca5c4be2014-03-25 10:30:46 +02004115 /* Passive scanning shouldn't trigger any device found events */
4116 if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
4117 if (type == LE_ADV_IND || type == LE_ADV_DIRECT_IND)
4118 check_pending_le_conn(hdev, bdaddr, bdaddr_type);
4119 return;
4120 }
Johan Hedberg4af605d2014-03-24 10:48:00 +02004121
Johan Hedbergb9a63282014-03-25 10:51:52 +02004122 /* If there's nothing pending either store the data from this
4123 * event or send an immediate device found event if the data
4124 * should not be stored for later.
4125 */
4126 if (!has_pending_adv_report(hdev)) {
4127 /* If the report will trigger a SCAN_REQ store it for
4128 * later merging.
4129 */
4130 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4131 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004132 rssi, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004133 return;
4134 }
4135
4136 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4137 rssi, 0, 1, data, len, NULL, 0);
4138 return;
4139 }
4140
Johan Hedberg474ee062014-03-25 14:34:59 +02004141 /* Check if the pending report is for the same device as the new one */
4142 match = (!bacmp(bdaddr, &d->last_adv_addr) &&
4143 bdaddr_type == d->last_adv_addr_type);
4144
Johan Hedbergb9a63282014-03-25 10:51:52 +02004145 /* If the pending data doesn't match this report or this isn't a
4146 * scan response (e.g. we got a duplicate ADV_IND) then force
4147 * sending of the pending data.
4148 */
Johan Hedberg474ee062014-03-25 14:34:59 +02004149 if (type != LE_ADV_SCAN_RSP || !match) {
4150 /* Send out whatever is in the cache, but skip duplicates */
4151 if (!match)
4152 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004153 d->last_adv_addr_type, NULL,
4154 d->last_adv_rssi, 0, 1,
4155 d->last_adv_data,
Johan Hedberg474ee062014-03-25 14:34:59 +02004156 d->last_adv_data_len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004157
4158 /* If the new report will trigger a SCAN_REQ store it for
4159 * later merging.
4160 */
4161 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4162 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004163 rssi, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004164 return;
4165 }
4166
4167 /* The advertising reports cannot be merged, so clear
4168 * the pending report and send out a device found event.
4169 */
4170 clear_pending_adv_report(hdev);
Johan Hedberg5c5b93e2014-03-29 08:39:53 +02004171 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4172 rssi, 0, 1, data, len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004173 return;
4174 }
4175
4176 /* If we get here we've got a pending ADV_IND or ADV_SCAN_IND and
4177 * the new event is a SCAN_RSP. We can therefore proceed with
4178 * sending a merged device found event.
4179 */
4180 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
4181 d->last_adv_addr_type, NULL, rssi, 0, 1, data, len,
4182 d->last_adv_data, d->last_adv_data_len);
4183 clear_pending_adv_report(hdev);
Johan Hedberg4af605d2014-03-24 10:48:00 +02004184}
4185
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004186static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03004187{
Andre Guedese95beb42011-09-26 20:48:35 -03004188 u8 num_reports = skb->data[0];
4189 void *ptr = &skb->data[1];
Andre Guedes9aa04c92011-05-26 16:23:51 -03004190
Andre Guedesa4790db2014-02-26 20:21:47 -03004191 hci_dev_lock(hdev);
4192
Andre Guedese95beb42011-09-26 20:48:35 -03004193 while (num_reports--) {
4194 struct hci_ev_le_advertising_info *ev = ptr;
Johan Hedberg4af605d2014-03-24 10:48:00 +02004195 s8 rssi;
Andre Guedesa4790db2014-02-26 20:21:47 -03004196
Andre Guedes3c9e9192012-01-10 18:20:50 -03004197 rssi = ev->data[ev->length];
Johan Hedberg4af605d2014-03-24 10:48:00 +02004198 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
4199 ev->bdaddr_type, rssi, ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03004200
Andre Guedese95beb42011-09-26 20:48:35 -03004201 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03004202 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004203
4204 hci_dev_unlock(hdev);
Andre Guedes9aa04c92011-05-26 16:23:51 -03004205}
4206
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004207static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004208{
4209 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
4210 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004211 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004212 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004213 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004214
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03004215 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004216
4217 hci_dev_lock(hdev);
4218
4219 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004220 if (conn == NULL)
4221 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004222
Marcel Holtmannfe39c7b2014-02-27 16:00:28 -08004223 ltk = hci_find_ltk(hdev, ev->ediv, ev->rand, conn->out);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004224 if (ltk == NULL)
4225 goto not_found;
4226
4227 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004228 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004229
4230 if (ltk->authenticated)
Andre Guedesf8776212013-07-31 16:25:28 -03004231 conn->pending_sec_level = BT_SECURITY_HIGH;
4232 else
4233 conn->pending_sec_level = BT_SECURITY_MEDIUM;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004234
Andre Guedes89cbb4d2013-07-31 16:25:29 -03004235 conn->enc_key_size = ltk->enc_size;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004236
4237 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
4238
Claudio Takahasi5981a882013-07-25 16:34:24 -03004239 /* Ref. Bluetooth Core SPEC pages 1975 and 2004. STK is a
4240 * temporary key used to encrypt a connection following
4241 * pairing. It is used during the Encrypted Session Setup to
4242 * distribute the keys. Later, security can be re-established
4243 * using a distributed LTK.
4244 */
Johan Hedberg2ceba532014-06-16 19:25:16 +03004245 if (ltk->type == SMP_STK) {
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004246 list_del(&ltk->list);
4247 kfree(ltk);
4248 }
4249
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004250 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004251
4252 return;
4253
4254not_found:
4255 neg.handle = ev->handle;
4256 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
4257 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004258}
4259
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004260static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03004261{
4262 struct hci_ev_le_meta *le_ev = (void *) skb->data;
4263
4264 skb_pull(skb, sizeof(*le_ev));
4265
4266 switch (le_ev->subevent) {
4267 case HCI_EV_LE_CONN_COMPLETE:
4268 hci_le_conn_complete_evt(hdev, skb);
4269 break;
4270
Andre Guedes9aa04c92011-05-26 16:23:51 -03004271 case HCI_EV_LE_ADVERTISING_REPORT:
4272 hci_le_adv_report_evt(hdev, skb);
4273 break;
4274
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004275 case HCI_EV_LE_LTK_REQ:
4276 hci_le_ltk_request_evt(hdev, skb);
4277 break;
4278
Ville Tervofcd89c02011-02-10 22:38:47 -03004279 default:
4280 break;
4281 }
4282}
4283
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03004284static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
4285{
4286 struct hci_ev_channel_selected *ev = (void *) skb->data;
4287 struct hci_conn *hcon;
4288
4289 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
4290
4291 skb_pull(skb, sizeof(*ev));
4292
4293 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4294 if (!hcon)
4295 return;
4296
4297 amp_read_loc_assoc_final_data(hdev, hcon);
4298}
4299
Linus Torvalds1da177e2005-04-16 15:20:36 -07004300void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
4301{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004302 struct hci_event_hdr *hdr = (void *) skb->data;
4303 __u8 event = hdr->evt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004304
Johan Hedbergb6ddb632013-04-02 13:34:31 +03004305 hci_dev_lock(hdev);
4306
4307 /* Received events are (currently) only needed when a request is
4308 * ongoing so avoid unnecessary memory allocation.
4309 */
4310 if (hdev->req_status == HCI_REQ_PEND) {
4311 kfree_skb(hdev->recv_evt);
4312 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
4313 }
4314
4315 hci_dev_unlock(hdev);
4316
Linus Torvalds1da177e2005-04-16 15:20:36 -07004317 skb_pull(skb, HCI_EVENT_HDR_SIZE);
4318
Johan Hedberg02350a72013-04-03 21:50:29 +03004319 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02004320 struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
4321 u16 opcode = __le16_to_cpu(cmd_hdr->opcode);
Johan Hedberg02350a72013-04-03 21:50:29 +03004322
4323 hci_req_cmd_complete(hdev, opcode, 0);
4324 }
4325
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004326 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004327 case HCI_EV_INQUIRY_COMPLETE:
4328 hci_inquiry_complete_evt(hdev, skb);
4329 break;
4330
4331 case HCI_EV_INQUIRY_RESULT:
4332 hci_inquiry_result_evt(hdev, skb);
4333 break;
4334
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004335 case HCI_EV_CONN_COMPLETE:
4336 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02004337 break;
4338
Linus Torvalds1da177e2005-04-16 15:20:36 -07004339 case HCI_EV_CONN_REQUEST:
4340 hci_conn_request_evt(hdev, skb);
4341 break;
4342
Linus Torvalds1da177e2005-04-16 15:20:36 -07004343 case HCI_EV_DISCONN_COMPLETE:
4344 hci_disconn_complete_evt(hdev, skb);
4345 break;
4346
Linus Torvalds1da177e2005-04-16 15:20:36 -07004347 case HCI_EV_AUTH_COMPLETE:
4348 hci_auth_complete_evt(hdev, skb);
4349 break;
4350
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004351 case HCI_EV_REMOTE_NAME:
4352 hci_remote_name_evt(hdev, skb);
4353 break;
4354
Linus Torvalds1da177e2005-04-16 15:20:36 -07004355 case HCI_EV_ENCRYPT_CHANGE:
4356 hci_encrypt_change_evt(hdev, skb);
4357 break;
4358
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004359 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
4360 hci_change_link_key_complete_evt(hdev, skb);
4361 break;
4362
4363 case HCI_EV_REMOTE_FEATURES:
4364 hci_remote_features_evt(hdev, skb);
4365 break;
4366
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004367 case HCI_EV_CMD_COMPLETE:
4368 hci_cmd_complete_evt(hdev, skb);
4369 break;
4370
4371 case HCI_EV_CMD_STATUS:
4372 hci_cmd_status_evt(hdev, skb);
4373 break;
4374
4375 case HCI_EV_ROLE_CHANGE:
4376 hci_role_change_evt(hdev, skb);
4377 break;
4378
4379 case HCI_EV_NUM_COMP_PKTS:
4380 hci_num_comp_pkts_evt(hdev, skb);
4381 break;
4382
4383 case HCI_EV_MODE_CHANGE:
4384 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004385 break;
4386
4387 case HCI_EV_PIN_CODE_REQ:
4388 hci_pin_code_request_evt(hdev, skb);
4389 break;
4390
4391 case HCI_EV_LINK_KEY_REQ:
4392 hci_link_key_request_evt(hdev, skb);
4393 break;
4394
4395 case HCI_EV_LINK_KEY_NOTIFY:
4396 hci_link_key_notify_evt(hdev, skb);
4397 break;
4398
4399 case HCI_EV_CLOCK_OFFSET:
4400 hci_clock_offset_evt(hdev, skb);
4401 break;
4402
Marcel Holtmanna8746412008-07-14 20:13:46 +02004403 case HCI_EV_PKT_TYPE_CHANGE:
4404 hci_pkt_type_change_evt(hdev, skb);
4405 break;
4406
Marcel Holtmann85a1e932005-08-09 20:28:02 -07004407 case HCI_EV_PSCAN_REP_MODE:
4408 hci_pscan_rep_mode_evt(hdev, skb);
4409 break;
4410
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004411 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
4412 hci_inquiry_result_with_rssi_evt(hdev, skb);
4413 break;
4414
4415 case HCI_EV_REMOTE_EXT_FEATURES:
4416 hci_remote_ext_features_evt(hdev, skb);
4417 break;
4418
4419 case HCI_EV_SYNC_CONN_COMPLETE:
4420 hci_sync_conn_complete_evt(hdev, skb);
4421 break;
4422
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004423 case HCI_EV_EXTENDED_INQUIRY_RESULT:
4424 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004425 break;
4426
Johan Hedberg1c2e0042012-06-08 23:31:13 +08004427 case HCI_EV_KEY_REFRESH_COMPLETE:
4428 hci_key_refresh_complete_evt(hdev, skb);
4429 break;
4430
Marcel Holtmann04936842008-07-14 20:13:48 +02004431 case HCI_EV_IO_CAPA_REQUEST:
4432 hci_io_capa_request_evt(hdev, skb);
4433 break;
4434
Johan Hedberg03b555e2011-01-04 15:40:05 +02004435 case HCI_EV_IO_CAPA_REPLY:
4436 hci_io_capa_reply_evt(hdev, skb);
4437 break;
4438
Johan Hedberga5c29682011-02-19 12:05:57 -03004439 case HCI_EV_USER_CONFIRM_REQUEST:
4440 hci_user_confirm_request_evt(hdev, skb);
4441 break;
4442
Brian Gix1143d452011-11-23 08:28:34 -08004443 case HCI_EV_USER_PASSKEY_REQUEST:
4444 hci_user_passkey_request_evt(hdev, skb);
4445 break;
4446
Johan Hedberg92a25252012-09-06 18:39:26 +03004447 case HCI_EV_USER_PASSKEY_NOTIFY:
4448 hci_user_passkey_notify_evt(hdev, skb);
4449 break;
4450
4451 case HCI_EV_KEYPRESS_NOTIFY:
4452 hci_keypress_notify_evt(hdev, skb);
4453 break;
4454
Marcel Holtmann04936842008-07-14 20:13:48 +02004455 case HCI_EV_SIMPLE_PAIR_COMPLETE:
4456 hci_simple_pair_complete_evt(hdev, skb);
4457 break;
4458
Marcel Holtmann41a96212008-07-14 20:13:48 +02004459 case HCI_EV_REMOTE_HOST_FEATURES:
4460 hci_remote_host_features_evt(hdev, skb);
4461 break;
4462
Ville Tervofcd89c02011-02-10 22:38:47 -03004463 case HCI_EV_LE_META:
4464 hci_le_meta_evt(hdev, skb);
4465 break;
4466
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +03004467 case HCI_EV_CHANNEL_SELECTED:
4468 hci_chan_selected_evt(hdev, skb);
4469 break;
4470
Szymon Janc2763eda2011-03-22 13:12:22 +01004471 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
4472 hci_remote_oob_data_request_evt(hdev, skb);
4473 break;
4474
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004475 case HCI_EV_PHY_LINK_COMPLETE:
4476 hci_phy_link_complete_evt(hdev, skb);
4477 break;
4478
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03004479 case HCI_EV_LOGICAL_LINK_COMPLETE:
4480 hci_loglink_complete_evt(hdev, skb);
4481 break;
4482
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02004483 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
4484 hci_disconn_loglink_complete_evt(hdev, skb);
4485 break;
4486
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02004487 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
4488 hci_disconn_phylink_complete_evt(hdev, skb);
4489 break;
4490
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02004491 case HCI_EV_NUM_COMP_BLOCKS:
4492 hci_num_comp_blocks_evt(hdev, skb);
4493 break;
4494
Marcel Holtmanna9de9242007-10-20 13:33:56 +02004495 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03004496 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004497 break;
4498 }
4499
4500 kfree_skb(skb);
4501 hdev->stat.evt_rx++;
4502}