blob: 36b23101d651998718ef80c2837ee3f7556adebb [file] [log] [blame]
Johan Hedberg03811012010-12-08 00:21:06 +02001/*
2 BlueZ - Bluetooth protocol stack for Linux
Johan Hedbergea585ab2012-02-17 14:50:39 +02003
Johan Hedberg03811012010-12-08 00:21:06 +02004 Copyright (C) 2010 Nokia Corporation
Johan Hedbergea585ab2012-02-17 14:50:39 +02005 Copyright (C) 2011-2012 Intel Corporation
Johan Hedberg03811012010-12-08 00:21:06 +02006
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
15 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
18 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
20 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
22 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI Management interface */
26
Paul Gortmaker3a9a2312011-05-27 09:12:25 -040027#include <linux/module.h>
Johan Hedberg03811012010-12-08 00:21:06 +020028#include <asm/unaligned.h>
29
30#include <net/bluetooth/bluetooth.h>
31#include <net/bluetooth/hci_core.h>
32#include <net/bluetooth/mgmt.h>
Brian Gix5fe57d92011-12-21 16:12:13 -080033#include <net/bluetooth/smp.h>
Johan Hedberg03811012010-12-08 00:21:06 +020034
Marcel Holtmannd7b7e792012-02-20 21:47:49 +010035bool enable_hs;
Marcel Holtmannd7b7e792012-02-20 21:47:49 +010036
Johan Hedberg2da9c552012-02-17 14:39:28 +020037#define MGMT_VERSION 1
Johan Hedberg23b3b132012-09-06 18:39:27 +030038#define MGMT_REVISION 2
Johan Hedberg02d98122010-12-13 21:07:04 +020039
Johan Hedberge70bb2e2012-02-13 16:59:33 +020040static const u16 mgmt_commands[] = {
41 MGMT_OP_READ_INDEX_LIST,
42 MGMT_OP_READ_INFO,
43 MGMT_OP_SET_POWERED,
44 MGMT_OP_SET_DISCOVERABLE,
45 MGMT_OP_SET_CONNECTABLE,
46 MGMT_OP_SET_FAST_CONNECTABLE,
47 MGMT_OP_SET_PAIRABLE,
48 MGMT_OP_SET_LINK_SECURITY,
49 MGMT_OP_SET_SSP,
50 MGMT_OP_SET_HS,
51 MGMT_OP_SET_LE,
52 MGMT_OP_SET_DEV_CLASS,
53 MGMT_OP_SET_LOCAL_NAME,
54 MGMT_OP_ADD_UUID,
55 MGMT_OP_REMOVE_UUID,
56 MGMT_OP_LOAD_LINK_KEYS,
57 MGMT_OP_LOAD_LONG_TERM_KEYS,
58 MGMT_OP_DISCONNECT,
59 MGMT_OP_GET_CONNECTIONS,
60 MGMT_OP_PIN_CODE_REPLY,
61 MGMT_OP_PIN_CODE_NEG_REPLY,
62 MGMT_OP_SET_IO_CAPABILITY,
63 MGMT_OP_PAIR_DEVICE,
64 MGMT_OP_CANCEL_PAIR_DEVICE,
65 MGMT_OP_UNPAIR_DEVICE,
66 MGMT_OP_USER_CONFIRM_REPLY,
67 MGMT_OP_USER_CONFIRM_NEG_REPLY,
68 MGMT_OP_USER_PASSKEY_REPLY,
69 MGMT_OP_USER_PASSKEY_NEG_REPLY,
70 MGMT_OP_READ_LOCAL_OOB_DATA,
71 MGMT_OP_ADD_REMOTE_OOB_DATA,
72 MGMT_OP_REMOVE_REMOTE_OOB_DATA,
73 MGMT_OP_START_DISCOVERY,
74 MGMT_OP_STOP_DISCOVERY,
75 MGMT_OP_CONFIRM_NAME,
76 MGMT_OP_BLOCK_DEVICE,
77 MGMT_OP_UNBLOCK_DEVICE,
Marcel Holtmanncdbaccc2012-03-11 20:00:29 -070078 MGMT_OP_SET_DEVICE_ID,
Johan Hedberge70bb2e2012-02-13 16:59:33 +020079};
80
81static const u16 mgmt_events[] = {
82 MGMT_EV_CONTROLLER_ERROR,
83 MGMT_EV_INDEX_ADDED,
84 MGMT_EV_INDEX_REMOVED,
85 MGMT_EV_NEW_SETTINGS,
86 MGMT_EV_CLASS_OF_DEV_CHANGED,
87 MGMT_EV_LOCAL_NAME_CHANGED,
88 MGMT_EV_NEW_LINK_KEY,
89 MGMT_EV_NEW_LONG_TERM_KEY,
90 MGMT_EV_DEVICE_CONNECTED,
91 MGMT_EV_DEVICE_DISCONNECTED,
92 MGMT_EV_CONNECT_FAILED,
93 MGMT_EV_PIN_CODE_REQUEST,
94 MGMT_EV_USER_CONFIRM_REQUEST,
95 MGMT_EV_USER_PASSKEY_REQUEST,
96 MGMT_EV_AUTH_FAILED,
97 MGMT_EV_DEVICE_FOUND,
98 MGMT_EV_DISCOVERING,
99 MGMT_EV_DEVICE_BLOCKED,
100 MGMT_EV_DEVICE_UNBLOCKED,
101 MGMT_EV_DEVICE_UNPAIRED,
Johan Hedberg92a25252012-09-06 18:39:26 +0300102 MGMT_EV_PASSKEY_NOTIFY,
Johan Hedberge70bb2e2012-02-13 16:59:33 +0200103};
104
Andre Guedes3fd24152012-02-03 17:48:01 -0300105/*
106 * These LE scan and inquiry parameters were chosen according to LE General
107 * Discovery Procedure specification.
108 */
109#define LE_SCAN_TYPE 0x01
110#define LE_SCAN_WIN 0x12
111#define LE_SCAN_INT 0x12
112#define LE_SCAN_TIMEOUT_LE_ONLY 10240 /* TGAP(gen_disc_scan_min) */
Andre Guedes5e0452c2012-02-17 20:39:38 -0300113#define LE_SCAN_TIMEOUT_BREDR_LE 5120 /* TGAP(100)/2 */
Andre Guedes3fd24152012-02-03 17:48:01 -0300114
Andre Guedese8777522012-02-03 17:48:02 -0300115#define INQUIRY_LEN_BREDR 0x08 /* TGAP(100) */
Andre Guedes5e0452c2012-02-17 20:39:38 -0300116#define INQUIRY_LEN_BREDR_LE 0x04 /* TGAP(100)/2 */
Andre Guedes2519a1f2011-11-07 11:45:24 -0300117
Marcel Holtmann17b02e62012-03-01 14:32:37 -0800118#define CACHE_TIMEOUT msecs_to_jiffies(2 * 1000)
Johan Hedberg7d785252011-12-15 00:47:39 +0200119
Johan Hedberg4b34ee782012-02-21 14:13:02 +0200120#define hdev_is_powered(hdev) (test_bit(HCI_UP, &hdev->flags) && \
121 !test_bit(HCI_AUTO_OFF, &hdev->dev_flags))
122
Johan Hedbergeec8d2b2010-12-16 10:17:38 +0200123struct pending_cmd {
124 struct list_head list;
Johan Hedbergfc2f4b12011-11-09 13:58:56 +0200125 u16 opcode;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +0200126 int index;
Szymon Jancc68fb7f2011-03-22 13:12:19 +0100127 void *param;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +0200128 struct sock *sk;
Johan Hedberge9a416b2011-02-19 12:05:56 -0300129 void *user_data;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +0200130};
131
Johan Hedbergca69b792011-11-11 18:10:00 +0200132/* HCI to MGMT error code conversion table */
133static u8 mgmt_status_table[] = {
134 MGMT_STATUS_SUCCESS,
135 MGMT_STATUS_UNKNOWN_COMMAND, /* Unknown Command */
136 MGMT_STATUS_NOT_CONNECTED, /* No Connection */
137 MGMT_STATUS_FAILED, /* Hardware Failure */
138 MGMT_STATUS_CONNECT_FAILED, /* Page Timeout */
139 MGMT_STATUS_AUTH_FAILED, /* Authentication Failed */
140 MGMT_STATUS_NOT_PAIRED, /* PIN or Key Missing */
141 MGMT_STATUS_NO_RESOURCES, /* Memory Full */
142 MGMT_STATUS_TIMEOUT, /* Connection Timeout */
143 MGMT_STATUS_NO_RESOURCES, /* Max Number of Connections */
144 MGMT_STATUS_NO_RESOURCES, /* Max Number of SCO Connections */
145 MGMT_STATUS_ALREADY_CONNECTED, /* ACL Connection Exists */
146 MGMT_STATUS_BUSY, /* Command Disallowed */
147 MGMT_STATUS_NO_RESOURCES, /* Rejected Limited Resources */
148 MGMT_STATUS_REJECTED, /* Rejected Security */
149 MGMT_STATUS_REJECTED, /* Rejected Personal */
150 MGMT_STATUS_TIMEOUT, /* Host Timeout */
151 MGMT_STATUS_NOT_SUPPORTED, /* Unsupported Feature */
152 MGMT_STATUS_INVALID_PARAMS, /* Invalid Parameters */
153 MGMT_STATUS_DISCONNECTED, /* OE User Ended Connection */
154 MGMT_STATUS_NO_RESOURCES, /* OE Low Resources */
155 MGMT_STATUS_DISCONNECTED, /* OE Power Off */
156 MGMT_STATUS_DISCONNECTED, /* Connection Terminated */
157 MGMT_STATUS_BUSY, /* Repeated Attempts */
158 MGMT_STATUS_REJECTED, /* Pairing Not Allowed */
159 MGMT_STATUS_FAILED, /* Unknown LMP PDU */
160 MGMT_STATUS_NOT_SUPPORTED, /* Unsupported Remote Feature */
161 MGMT_STATUS_REJECTED, /* SCO Offset Rejected */
162 MGMT_STATUS_REJECTED, /* SCO Interval Rejected */
163 MGMT_STATUS_REJECTED, /* Air Mode Rejected */
164 MGMT_STATUS_INVALID_PARAMS, /* Invalid LMP Parameters */
165 MGMT_STATUS_FAILED, /* Unspecified Error */
166 MGMT_STATUS_NOT_SUPPORTED, /* Unsupported LMP Parameter Value */
167 MGMT_STATUS_FAILED, /* Role Change Not Allowed */
168 MGMT_STATUS_TIMEOUT, /* LMP Response Timeout */
169 MGMT_STATUS_FAILED, /* LMP Error Transaction Collision */
170 MGMT_STATUS_FAILED, /* LMP PDU Not Allowed */
171 MGMT_STATUS_REJECTED, /* Encryption Mode Not Accepted */
172 MGMT_STATUS_FAILED, /* Unit Link Key Used */
173 MGMT_STATUS_NOT_SUPPORTED, /* QoS Not Supported */
174 MGMT_STATUS_TIMEOUT, /* Instant Passed */
175 MGMT_STATUS_NOT_SUPPORTED, /* Pairing Not Supported */
176 MGMT_STATUS_FAILED, /* Transaction Collision */
177 MGMT_STATUS_INVALID_PARAMS, /* Unacceptable Parameter */
178 MGMT_STATUS_REJECTED, /* QoS Rejected */
179 MGMT_STATUS_NOT_SUPPORTED, /* Classification Not Supported */
180 MGMT_STATUS_REJECTED, /* Insufficient Security */
181 MGMT_STATUS_INVALID_PARAMS, /* Parameter Out Of Range */
182 MGMT_STATUS_BUSY, /* Role Switch Pending */
183 MGMT_STATUS_FAILED, /* Slot Violation */
184 MGMT_STATUS_FAILED, /* Role Switch Failed */
185 MGMT_STATUS_INVALID_PARAMS, /* EIR Too Large */
186 MGMT_STATUS_NOT_SUPPORTED, /* Simple Pairing Not Supported */
187 MGMT_STATUS_BUSY, /* Host Busy Pairing */
188 MGMT_STATUS_REJECTED, /* Rejected, No Suitable Channel */
189 MGMT_STATUS_BUSY, /* Controller Busy */
190 MGMT_STATUS_INVALID_PARAMS, /* Unsuitable Connection Interval */
191 MGMT_STATUS_TIMEOUT, /* Directed Advertising Timeout */
192 MGMT_STATUS_AUTH_FAILED, /* Terminated Due to MIC Failure */
193 MGMT_STATUS_CONNECT_FAILED, /* Connection Establishment Failed */
194 MGMT_STATUS_CONNECT_FAILED, /* MAC Connection Failed */
195};
196
Andrei Emeltchenkobb4b2a92012-07-19 17:03:40 +0300197bool mgmt_valid_hdev(struct hci_dev *hdev)
198{
199 return hdev->dev_type == HCI_BREDR;
200}
201
Johan Hedbergca69b792011-11-11 18:10:00 +0200202static u8 mgmt_status(u8 hci_status)
203{
204 if (hci_status < ARRAY_SIZE(mgmt_status_table))
205 return mgmt_status_table[hci_status];
206
207 return MGMT_STATUS_FAILED;
208}
209
Szymon Janc4e51eae2011-02-25 19:05:48 +0100210static int cmd_status(struct sock *sk, u16 index, u16 cmd, u8 status)
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200211{
212 struct sk_buff *skb;
213 struct mgmt_hdr *hdr;
214 struct mgmt_ev_cmd_status *ev;
Gustavo F. Padovan56b7d132011-10-14 19:20:01 -0300215 int err;
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200216
Szymon Janc34eb5252011-02-28 14:10:08 +0100217 BT_DBG("sock %p, index %u, cmd %u, status %u", sk, index, cmd, status);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200218
Andre Guedes790eff42012-06-07 19:05:46 -0300219 skb = alloc_skb(sizeof(*hdr) + sizeof(*ev), GFP_KERNEL);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200220 if (!skb)
221 return -ENOMEM;
222
223 hdr = (void *) skb_put(skb, sizeof(*hdr));
224
Syam Sidhardhan612dfce2012-10-29 22:37:36 +0530225 hdr->opcode = __constant_cpu_to_le16(MGMT_EV_CMD_STATUS);
Szymon Janc4e51eae2011-02-25 19:05:48 +0100226 hdr->index = cpu_to_le16(index);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200227 hdr->len = cpu_to_le16(sizeof(*ev));
228
229 ev = (void *) skb_put(skb, sizeof(*ev));
230 ev->status = status;
Marcel Holtmanneb55ef02012-03-14 18:08:46 +0200231 ev->opcode = cpu_to_le16(cmd);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200232
Gustavo F. Padovan56b7d132011-10-14 19:20:01 -0300233 err = sock_queue_rcv_skb(sk, skb);
234 if (err < 0)
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200235 kfree_skb(skb);
236
Gustavo F. Padovan56b7d132011-10-14 19:20:01 -0300237 return err;
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200238}
239
Johan Hedbergaee9b212012-02-18 15:07:59 +0200240static int cmd_complete(struct sock *sk, u16 index, u16 cmd, u8 status,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300241 void *rp, size_t rp_len)
Johan Hedberg02d98122010-12-13 21:07:04 +0200242{
243 struct sk_buff *skb;
244 struct mgmt_hdr *hdr;
245 struct mgmt_ev_cmd_complete *ev;
Gustavo F. Padovan56b7d132011-10-14 19:20:01 -0300246 int err;
Johan Hedberg02d98122010-12-13 21:07:04 +0200247
248 BT_DBG("sock %p", sk);
249
Andre Guedes790eff42012-06-07 19:05:46 -0300250 skb = alloc_skb(sizeof(*hdr) + sizeof(*ev) + rp_len, GFP_KERNEL);
Johan Hedberg02d98122010-12-13 21:07:04 +0200251 if (!skb)
252 return -ENOMEM;
253
254 hdr = (void *) skb_put(skb, sizeof(*hdr));
Johan Hedberga38528f2011-01-22 06:46:43 +0200255
Syam Sidhardhan612dfce2012-10-29 22:37:36 +0530256 hdr->opcode = __constant_cpu_to_le16(MGMT_EV_CMD_COMPLETE);
Szymon Janc4e51eae2011-02-25 19:05:48 +0100257 hdr->index = cpu_to_le16(index);
Johan Hedberga38528f2011-01-22 06:46:43 +0200258 hdr->len = cpu_to_le16(sizeof(*ev) + rp_len);
Johan Hedberg02d98122010-12-13 21:07:04 +0200259
Johan Hedberga38528f2011-01-22 06:46:43 +0200260 ev = (void *) skb_put(skb, sizeof(*ev) + rp_len);
Marcel Holtmanneb55ef02012-03-14 18:08:46 +0200261 ev->opcode = cpu_to_le16(cmd);
Johan Hedbergaee9b212012-02-18 15:07:59 +0200262 ev->status = status;
Szymon Janc8020c162011-02-28 14:09:50 +0100263
264 if (rp)
265 memcpy(ev->data, rp, rp_len);
Johan Hedberg02d98122010-12-13 21:07:04 +0200266
Gustavo F. Padovan56b7d132011-10-14 19:20:01 -0300267 err = sock_queue_rcv_skb(sk, skb);
268 if (err < 0)
Johan Hedberg02d98122010-12-13 21:07:04 +0200269 kfree_skb(skb);
270
Marcel Holtmanne5f0e152012-02-22 11:59:01 +0100271 return err;
Johan Hedberg02d98122010-12-13 21:07:04 +0200272}
273
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300274static int read_version(struct sock *sk, struct hci_dev *hdev, void *data,
275 u16 data_len)
Johan Hedberga38528f2011-01-22 06:46:43 +0200276{
277 struct mgmt_rp_read_version rp;
278
279 BT_DBG("sock %p", sk);
280
281 rp.version = MGMT_VERSION;
Marcel Holtmanneb55ef02012-03-14 18:08:46 +0200282 rp.revision = __constant_cpu_to_le16(MGMT_REVISION);
Johan Hedberga38528f2011-01-22 06:46:43 +0200283
Johan Hedbergaee9b212012-02-18 15:07:59 +0200284 return cmd_complete(sk, MGMT_INDEX_NONE, MGMT_OP_READ_VERSION, 0, &rp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300285 sizeof(rp));
Johan Hedberga38528f2011-01-22 06:46:43 +0200286}
287
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300288static int read_commands(struct sock *sk, struct hci_dev *hdev, void *data,
289 u16 data_len)
Johan Hedberge70bb2e2012-02-13 16:59:33 +0200290{
291 struct mgmt_rp_read_commands *rp;
Marcel Holtmanneb55ef02012-03-14 18:08:46 +0200292 const u16 num_commands = ARRAY_SIZE(mgmt_commands);
293 const u16 num_events = ARRAY_SIZE(mgmt_events);
Andrei Emeltchenko2e3c35e2012-03-14 18:54:15 +0200294 __le16 *opcode;
Johan Hedberge70bb2e2012-02-13 16:59:33 +0200295 size_t rp_size;
296 int i, err;
297
298 BT_DBG("sock %p", sk);
299
300 rp_size = sizeof(*rp) + ((num_commands + num_events) * sizeof(u16));
301
302 rp = kmalloc(rp_size, GFP_KERNEL);
303 if (!rp)
304 return -ENOMEM;
305
Marcel Holtmanneb55ef02012-03-14 18:08:46 +0200306 rp->num_commands = __constant_cpu_to_le16(num_commands);
307 rp->num_events = __constant_cpu_to_le16(num_events);
Johan Hedberge70bb2e2012-02-13 16:59:33 +0200308
309 for (i = 0, opcode = rp->opcodes; i < num_commands; i++, opcode++)
310 put_unaligned_le16(mgmt_commands[i], opcode);
311
312 for (i = 0; i < num_events; i++, opcode++)
313 put_unaligned_le16(mgmt_events[i], opcode);
314
Johan Hedbergaee9b212012-02-18 15:07:59 +0200315 err = cmd_complete(sk, MGMT_INDEX_NONE, MGMT_OP_READ_COMMANDS, 0, rp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300316 rp_size);
Johan Hedberge70bb2e2012-02-13 16:59:33 +0200317 kfree(rp);
318
319 return err;
320}
321
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300322static int read_index_list(struct sock *sk, struct hci_dev *hdev, void *data,
323 u16 data_len)
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200324{
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200325 struct mgmt_rp_read_index_list *rp;
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +0200326 struct hci_dev *d;
Johan Hedberga38528f2011-01-22 06:46:43 +0200327 size_t rp_len;
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200328 u16 count;
Johan Hedberg476e44c2012-10-19 20:10:46 +0300329 int err;
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200330
331 BT_DBG("sock %p", sk);
332
333 read_lock(&hci_dev_list_lock);
334
335 count = 0;
Andrei Emeltchenkobb4b2a92012-07-19 17:03:40 +0300336 list_for_each_entry(d, &hci_dev_list, list) {
337 if (!mgmt_valid_hdev(d))
338 continue;
339
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200340 count++;
341 }
342
Johan Hedberga38528f2011-01-22 06:46:43 +0200343 rp_len = sizeof(*rp) + (2 * count);
344 rp = kmalloc(rp_len, GFP_ATOMIC);
345 if (!rp) {
Jesper Juhlb2c60d42011-01-14 00:18:49 +0100346 read_unlock(&hci_dev_list_lock);
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200347 return -ENOMEM;
Jesper Juhlb2c60d42011-01-14 00:18:49 +0100348 }
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200349
Johan Hedberg476e44c2012-10-19 20:10:46 +0300350 count = 0;
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +0200351 list_for_each_entry(d, &hci_dev_list, list) {
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200352 if (test_bit(HCI_SETUP, &d->dev_flags))
Johan Hedbergab81cbf2010-12-15 13:53:18 +0200353 continue;
354
Andrei Emeltchenkobb4b2a92012-07-19 17:03:40 +0300355 if (!mgmt_valid_hdev(d))
356 continue;
357
Johan Hedberg476e44c2012-10-19 20:10:46 +0300358 rp->index[count++] = cpu_to_le16(d->id);
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200359 BT_DBG("Added hci%u", d->id);
360 }
361
Johan Hedberg476e44c2012-10-19 20:10:46 +0300362 rp->num_controllers = cpu_to_le16(count);
363 rp_len = sizeof(*rp) + (2 * count);
364
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200365 read_unlock(&hci_dev_list_lock);
366
Johan Hedbergaee9b212012-02-18 15:07:59 +0200367 err = cmd_complete(sk, MGMT_INDEX_NONE, MGMT_OP_READ_INDEX_LIST, 0, rp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300368 rp_len);
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200369
Johan Hedberga38528f2011-01-22 06:46:43 +0200370 kfree(rp);
371
372 return err;
Johan Hedbergfaba42e2010-12-13 21:07:05 +0200373}
374
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200375static u32 get_supported_settings(struct hci_dev *hdev)
Johan Hedberg03811012010-12-08 00:21:06 +0200376{
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200377 u32 settings = 0;
Johan Hedberg03811012010-12-08 00:21:06 +0200378
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200379 settings |= MGMT_SETTING_POWERED;
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200380 settings |= MGMT_SETTING_PAIRABLE;
Johan Hedberg03811012010-12-08 00:21:06 +0200381
Andre Guedes9a1a1992012-07-24 15:03:48 -0300382 if (lmp_ssp_capable(hdev))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200383 settings |= MGMT_SETTING_SSP;
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200384
Andre Guedesed3fa312012-07-24 15:03:46 -0300385 if (lmp_bredr_capable(hdev)) {
Johan Hedberg33c525c2012-10-24 21:11:58 +0300386 settings |= MGMT_SETTING_CONNECTABLE;
387 settings |= MGMT_SETTING_FAST_CONNECTABLE;
388 settings |= MGMT_SETTING_DISCOVERABLE;
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200389 settings |= MGMT_SETTING_BREDR;
390 settings |= MGMT_SETTING_LINK_SECURITY;
391 }
Johan Hedbergab81cbf2010-12-15 13:53:18 +0200392
Marcel Holtmannd7b7e792012-02-20 21:47:49 +0100393 if (enable_hs)
394 settings |= MGMT_SETTING_HS;
395
Andre Guedesc383ddc2012-07-24 15:03:47 -0300396 if (lmp_le_capable(hdev))
Marcel Holtmann9d428202012-05-03 07:12:31 +0200397 settings |= MGMT_SETTING_LE;
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200398
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200399 return settings;
400}
Johan Hedbergebc99fe2011-01-04 11:54:26 +0200401
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200402static u32 get_current_settings(struct hci_dev *hdev)
403{
404 u32 settings = 0;
Johan Hedbergdc4fe302011-03-16 14:29:36 +0200405
Johan Hedbergf1f0eb02012-02-21 17:15:41 +0200406 if (hdev_is_powered(hdev))
Marcel Holtmannf0d4b782012-02-21 12:14:25 +0100407 settings |= MGMT_SETTING_POWERED;
408
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200409 if (test_bit(HCI_CONNECTABLE, &hdev->dev_flags))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200410 settings |= MGMT_SETTING_CONNECTABLE;
411
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200412 if (test_bit(HCI_DISCOVERABLE, &hdev->dev_flags))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200413 settings |= MGMT_SETTING_DISCOVERABLE;
414
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200415 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200416 settings |= MGMT_SETTING_PAIRABLE;
417
Andre Guedesed3fa312012-07-24 15:03:46 -0300418 if (lmp_bredr_capable(hdev))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200419 settings |= MGMT_SETTING_BREDR;
420
Johan Hedberg06199cf2012-02-22 16:37:11 +0200421 if (test_bit(HCI_LE_ENABLED, &hdev->dev_flags))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200422 settings |= MGMT_SETTING_LE;
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200423
Johan Hedberg47990ea2012-02-22 11:58:37 +0200424 if (test_bit(HCI_LINK_SECURITY, &hdev->dev_flags))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200425 settings |= MGMT_SETTING_LINK_SECURITY;
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200426
Johan Hedberg84bde9d6c2012-01-25 14:21:06 +0200427 if (test_bit(HCI_SSP_ENABLED, &hdev->dev_flags))
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200428 settings |= MGMT_SETTING_SSP;
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200429
Johan Hedberg6d80dfd2012-02-20 23:50:38 +0200430 if (test_bit(HCI_HS_ENABLED, &hdev->dev_flags))
431 settings |= MGMT_SETTING_HS;
432
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200433 return settings;
Johan Hedbergc542a062011-01-26 13:11:03 +0200434}
435
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300436#define PNP_INFO_SVCLASS_ID 0x1200
437
438static u8 bluetooth_base_uuid[] = {
439 0xFB, 0x34, 0x9B, 0x5F, 0x80, 0x00, 0x00, 0x80,
440 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
441};
442
443static u16 get_uuid16(u8 *uuid128)
444{
445 u32 val;
446 int i;
447
448 for (i = 0; i < 12; i++) {
449 if (bluetooth_base_uuid[i] != uuid128[i])
450 return 0;
451 }
452
Andrei Emeltchenko3e9fb6d2012-03-20 10:32:25 +0200453 val = get_unaligned_le32(&uuid128[12]);
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300454 if (val > 0xffff)
455 return 0;
456
457 return (u16) val;
458}
459
460static void create_eir(struct hci_dev *hdev, u8 *data)
461{
462 u8 *ptr = data;
463 u16 eir_len = 0;
464 u16 uuid16_list[HCI_MAX_EIR_LENGTH / sizeof(u16)];
465 int i, truncated = 0;
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +0200466 struct bt_uuid *uuid;
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300467 size_t name_len;
468
469 name_len = strlen(hdev->dev_name);
470
471 if (name_len > 0) {
472 /* EIR Data type */
473 if (name_len > 48) {
474 name_len = 48;
475 ptr[1] = EIR_NAME_SHORT;
476 } else
477 ptr[1] = EIR_NAME_COMPLETE;
478
479 /* EIR Data length */
480 ptr[0] = name_len + 1;
481
482 memcpy(ptr + 2, hdev->dev_name, name_len);
483
484 eir_len += (name_len + 2);
485 ptr += (name_len + 2);
486 }
487
Johan Hedbergbbaf4442012-11-08 01:22:59 +0100488 if (hdev->inq_tx_power != HCI_TX_POWER_INVALID) {
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700489 ptr[0] = 2;
490 ptr[1] = EIR_TX_POWER;
491 ptr[2] = (u8) hdev->inq_tx_power;
492
493 eir_len += 3;
494 ptr += 3;
495 }
496
Marcel Holtmann2b9be132012-03-11 19:32:12 -0700497 if (hdev->devid_source > 0) {
498 ptr[0] = 9;
499 ptr[1] = EIR_DEVICE_ID;
500
501 put_unaligned_le16(hdev->devid_source, ptr + 2);
502 put_unaligned_le16(hdev->devid_vendor, ptr + 4);
503 put_unaligned_le16(hdev->devid_product, ptr + 6);
504 put_unaligned_le16(hdev->devid_version, ptr + 8);
505
506 eir_len += 10;
507 ptr += 10;
508 }
509
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300510 memset(uuid16_list, 0, sizeof(uuid16_list));
511
512 /* Group all UUID16 types */
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +0200513 list_for_each_entry(uuid, &hdev->uuids, list) {
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300514 u16 uuid16;
515
516 uuid16 = get_uuid16(uuid->uuid);
517 if (uuid16 == 0)
518 return;
519
520 if (uuid16 < 0x1100)
521 continue;
522
523 if (uuid16 == PNP_INFO_SVCLASS_ID)
524 continue;
525
526 /* Stop if not enough space to put next UUID */
527 if (eir_len + 2 + sizeof(u16) > HCI_MAX_EIR_LENGTH) {
528 truncated = 1;
529 break;
530 }
531
532 /* Check for duplicates */
533 for (i = 0; uuid16_list[i] != 0; i++)
534 if (uuid16_list[i] == uuid16)
535 break;
536
537 if (uuid16_list[i] == 0) {
538 uuid16_list[i] = uuid16;
539 eir_len += sizeof(u16);
540 }
541 }
542
543 if (uuid16_list[0] != 0) {
544 u8 *length = ptr;
545
546 /* EIR Data type */
547 ptr[1] = truncated ? EIR_UUID16_SOME : EIR_UUID16_ALL;
548
549 ptr += 2;
550 eir_len += 2;
551
552 for (i = 0; uuid16_list[i] != 0; i++) {
553 *ptr++ = (uuid16_list[i] & 0x00ff);
554 *ptr++ = (uuid16_list[i] & 0xff00) >> 8;
555 }
556
557 /* EIR Data length */
558 *length = (i * sizeof(u16)) + 1;
559 }
560}
561
562static int update_eir(struct hci_dev *hdev)
563{
564 struct hci_cp_write_eir cp;
565
Johan Hedberg504c8dc2012-02-23 13:30:41 +0200566 if (!hdev_is_powered(hdev))
Johan Hedberg7770c4a2012-02-22 22:06:38 +0200567 return 0;
568
Johan Hedberg976eb202012-10-24 21:12:01 +0300569 if (!lmp_ext_inq_capable(hdev))
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300570 return 0;
571
Johan Hedberg84bde9d6c2012-01-25 14:21:06 +0200572 if (!test_bit(HCI_SSP_ENABLED, &hdev->dev_flags))
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300573 return 0;
574
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200575 if (test_bit(HCI_SERVICE_CACHE, &hdev->dev_flags))
Johan Hedberg80a1e1d2011-03-28 14:07:23 +0300576 return 0;
577
578 memset(&cp, 0, sizeof(cp));
579
580 create_eir(hdev, cp.data);
581
582 if (memcmp(cp.data, hdev->eir, sizeof(cp.data)) == 0)
583 return 0;
584
585 memcpy(hdev->eir, cp.data, sizeof(cp.data));
586
587 return hci_send_cmd(hdev, HCI_OP_WRITE_EIR, sizeof(cp), &cp);
588}
589
Johan Hedberg1aff6f02011-01-13 21:56:52 +0200590static u8 get_service_classes(struct hci_dev *hdev)
591{
Gustavo F. Padovan12dc0742011-10-14 19:32:56 -0300592 struct bt_uuid *uuid;
Johan Hedberg1aff6f02011-01-13 21:56:52 +0200593 u8 val = 0;
594
Gustavo F. Padovan12dc0742011-10-14 19:32:56 -0300595 list_for_each_entry(uuid, &hdev->uuids, list)
Johan Hedberg1aff6f02011-01-13 21:56:52 +0200596 val |= uuid->svc_hint;
Johan Hedberg1aff6f02011-01-13 21:56:52 +0200597
598 return val;
599}
600
601static int update_class(struct hci_dev *hdev)
602{
603 u8 cod[3];
Johan Hedbergc95f0ba2012-02-23 22:54:38 +0200604 int err;
Johan Hedberg1aff6f02011-01-13 21:56:52 +0200605
606 BT_DBG("%s", hdev->name);
607
Johan Hedberg504c8dc2012-02-23 13:30:41 +0200608 if (!hdev_is_powered(hdev))
Johan Hedberg7770c4a2012-02-22 22:06:38 +0200609 return 0;
610
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200611 if (test_bit(HCI_SERVICE_CACHE, &hdev->dev_flags))
Johan Hedberg1aff6f02011-01-13 21:56:52 +0200612 return 0;
613
614 cod[0] = hdev->minor_class;
615 cod[1] = hdev->major_class;
616 cod[2] = get_service_classes(hdev);
617
618 if (memcmp(cod, hdev->dev_class, 3) == 0)
619 return 0;
620
Johan Hedbergc95f0ba2012-02-23 22:54:38 +0200621 err = hci_send_cmd(hdev, HCI_OP_WRITE_CLASS_OF_DEV, sizeof(cod), cod);
622 if (err == 0)
623 set_bit(HCI_PENDING_CLASS, &hdev->dev_flags);
624
625 return err;
Johan Hedberg1aff6f02011-01-13 21:56:52 +0200626}
627
Johan Hedberg7d785252011-12-15 00:47:39 +0200628static void service_cache_off(struct work_struct *work)
629{
630 struct hci_dev *hdev = container_of(work, struct hci_dev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300631 service_cache.work);
Johan Hedberg7d785252011-12-15 00:47:39 +0200632
Johan Hedberga8b2d5c2012-01-08 23:11:15 +0200633 if (!test_and_clear_bit(HCI_SERVICE_CACHE, &hdev->dev_flags))
Johan Hedberg7d785252011-12-15 00:47:39 +0200634 return;
635
636 hci_dev_lock(hdev);
637
638 update_eir(hdev);
639 update_class(hdev);
640
641 hci_dev_unlock(hdev);
642}
643
Johan Hedberg6a919082012-02-28 06:17:26 +0200644static void mgmt_init_hdev(struct sock *sk, struct hci_dev *hdev)
Johan Hedberg7d785252011-12-15 00:47:39 +0200645{
Johan Hedberg4f87da82012-03-02 19:55:56 +0200646 if (test_and_set_bit(HCI_MGMT, &hdev->dev_flags))
Johan Hedberg6a919082012-02-28 06:17:26 +0200647 return;
648
Johan Hedberg4f87da82012-03-02 19:55:56 +0200649 INIT_DELAYED_WORK(&hdev->service_cache, service_cache_off);
Johan Hedberg7d785252011-12-15 00:47:39 +0200650
Johan Hedberg4f87da82012-03-02 19:55:56 +0200651 /* Non-mgmt controlled devices get this bit set
652 * implicitly so that pairing works for them, however
653 * for mgmt we require user-space to explicitly enable
654 * it
655 */
656 clear_bit(HCI_PAIRABLE, &hdev->dev_flags);
Johan Hedberg7d785252011-12-15 00:47:39 +0200657}
658
Johan Hedberg0f4e68c2012-02-28 17:18:30 +0200659static int read_controller_info(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300660 void *data, u16 data_len)
Johan Hedberg03811012010-12-08 00:21:06 +0200661{
662 struct mgmt_rp_read_info rp;
Johan Hedberg03811012010-12-08 00:21:06 +0200663
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200664 BT_DBG("sock %p %s", sk, hdev->name);
Johan Hedberg03811012010-12-08 00:21:06 +0200665
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -0300666 hci_dev_lock(hdev);
Johan Hedberg03811012010-12-08 00:21:06 +0200667
Johan Hedberg03811012010-12-08 00:21:06 +0200668 memset(&rp, 0, sizeof(rp));
669
Johan Hedberg03811012010-12-08 00:21:06 +0200670 bacpy(&rp.bdaddr, &hdev->bdaddr);
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200671
672 rp.version = hdev->hci_ver;
Marcel Holtmanneb55ef02012-03-14 18:08:46 +0200673 rp.manufacturer = cpu_to_le16(hdev->manufacturer);
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200674
675 rp.supported_settings = cpu_to_le32(get_supported_settings(hdev));
676 rp.current_settings = cpu_to_le32(get_current_settings(hdev));
677
678 memcpy(rp.dev_class, hdev->dev_class, 3);
Johan Hedberg03811012010-12-08 00:21:06 +0200679
680 memcpy(rp.name, hdev->dev_name, sizeof(hdev->dev_name));
Johan Hedberg27fcc362012-02-22 21:46:22 +0200681 memcpy(rp.short_name, hdev->short_name, sizeof(hdev->short_name));
Johan Hedberg03811012010-12-08 00:21:06 +0200682
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -0300683 hci_dev_unlock(hdev);
Johan Hedberg03811012010-12-08 00:21:06 +0200684
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200685 return cmd_complete(sk, hdev->id, MGMT_OP_READ_INFO, 0, &rp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300686 sizeof(rp));
Johan Hedberg03811012010-12-08 00:21:06 +0200687}
688
689static void mgmt_pending_free(struct pending_cmd *cmd)
690{
691 sock_put(cmd->sk);
692 kfree(cmd->param);
693 kfree(cmd);
694}
695
696static struct pending_cmd *mgmt_pending_add(struct sock *sk, u16 opcode,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300697 struct hci_dev *hdev, void *data,
698 u16 len)
Johan Hedberg03811012010-12-08 00:21:06 +0200699{
700 struct pending_cmd *cmd;
701
Andre Guedes12b94562012-06-07 19:05:45 -0300702 cmd = kmalloc(sizeof(*cmd), GFP_KERNEL);
Johan Hedberg03811012010-12-08 00:21:06 +0200703 if (!cmd)
704 return NULL;
705
706 cmd->opcode = opcode;
707 cmd->index = hdev->id;
708
Andre Guedes12b94562012-06-07 19:05:45 -0300709 cmd->param = kmalloc(len, GFP_KERNEL);
Johan Hedberg03811012010-12-08 00:21:06 +0200710 if (!cmd->param) {
711 kfree(cmd);
712 return NULL;
713 }
714
715 if (data)
716 memcpy(cmd->param, data, len);
717
718 cmd->sk = sk;
719 sock_hold(sk);
720
721 list_add(&cmd->list, &hdev->mgmt_pending);
722
723 return cmd;
724}
725
726static void mgmt_pending_foreach(u16 opcode, struct hci_dev *hdev,
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300727 void (*cb)(struct pending_cmd *cmd,
728 void *data),
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300729 void *data)
Johan Hedberg03811012010-12-08 00:21:06 +0200730{
731 struct list_head *p, *n;
732
733 list_for_each_safe(p, n, &hdev->mgmt_pending) {
734 struct pending_cmd *cmd;
735
736 cmd = list_entry(p, struct pending_cmd, list);
737
738 if (opcode > 0 && cmd->opcode != opcode)
739 continue;
740
741 cb(cmd, data);
742 }
743}
744
745static struct pending_cmd *mgmt_pending_find(u16 opcode, struct hci_dev *hdev)
746{
747 struct pending_cmd *cmd;
748
749 list_for_each_entry(cmd, &hdev->mgmt_pending, list) {
750 if (cmd->opcode == opcode)
751 return cmd;
752 }
753
754 return NULL;
755}
756
757static void mgmt_pending_remove(struct pending_cmd *cmd)
758{
759 list_del(&cmd->list);
760 mgmt_pending_free(cmd);
761}
762
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200763static int send_settings_rsp(struct sock *sk, u16 opcode, struct hci_dev *hdev)
Johan Hedberg86805702011-11-11 16:18:52 +0200764{
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200765 __le32 settings = cpu_to_le32(get_current_settings(hdev));
Johan Hedberg86805702011-11-11 16:18:52 +0200766
Johan Hedbergaee9b212012-02-18 15:07:59 +0200767 return cmd_complete(sk, hdev->id, opcode, 0, &settings,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300768 sizeof(settings));
Johan Hedberg86805702011-11-11 16:18:52 +0200769}
770
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200771static int set_powered(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300772 u16 len)
Johan Hedberg03811012010-12-08 00:21:06 +0200773{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -0300774 struct mgmt_mode *cp = data;
Johan Hedberg03811012010-12-08 00:21:06 +0200775 struct pending_cmd *cmd;
Johan Hedberg4b34ee782012-02-21 14:13:02 +0200776 int err;
Johan Hedberg03811012010-12-08 00:21:06 +0200777
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200778 BT_DBG("request for %s", hdev->name);
Johan Hedberg03811012010-12-08 00:21:06 +0200779
Johan Hedberga7e80f22013-01-09 16:05:19 +0200780 if (cp->val != 0x00 && cp->val != 0x01)
781 return cmd_status(sk, hdev->id, MGMT_OP_SET_POWERED,
782 MGMT_STATUS_INVALID_PARAMS);
783
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -0300784 hci_dev_lock(hdev);
Johan Hedberg03811012010-12-08 00:21:06 +0200785
Marcel Holtmannf0d4b782012-02-21 12:14:25 +0100786 if (test_and_clear_bit(HCI_AUTO_OFF, &hdev->dev_flags)) {
787 cancel_delayed_work(&hdev->power_off);
788
789 if (cp->val) {
Johan Hedberga1d70452013-01-09 15:29:40 +0200790 mgmt_pending_add(sk, MGMT_OP_SET_POWERED, hdev,
791 data, len);
792 err = mgmt_powered(hdev, 1);
Marcel Holtmannf0d4b782012-02-21 12:14:25 +0100793 goto failed;
794 }
795 }
796
Johan Hedberg4b34ee782012-02-21 14:13:02 +0200797 if (!!cp->val == hdev_is_powered(hdev)) {
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200798 err = send_settings_rsp(sk, MGMT_OP_SET_POWERED, hdev);
Johan Hedberg03811012010-12-08 00:21:06 +0200799 goto failed;
800 }
801
802 if (mgmt_pending_find(MGMT_OP_SET_POWERED, hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200803 err = cmd_status(sk, hdev->id, MGMT_OP_SET_POWERED,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300804 MGMT_STATUS_BUSY);
Johan Hedberg03811012010-12-08 00:21:06 +0200805 goto failed;
806 }
807
808 cmd = mgmt_pending_add(sk, MGMT_OP_SET_POWERED, hdev, data, len);
809 if (!cmd) {
810 err = -ENOMEM;
811 goto failed;
812 }
813
814 if (cp->val)
Johan Hedberg19202572013-01-14 22:33:51 +0200815 queue_work(hdev->req_workqueue, &hdev->power_on);
Johan Hedberg03811012010-12-08 00:21:06 +0200816 else
Johan Hedberg19202572013-01-14 22:33:51 +0200817 queue_work(hdev->req_workqueue, &hdev->power_off.work);
Johan Hedberg03811012010-12-08 00:21:06 +0200818
819 err = 0;
820
821failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -0300822 hci_dev_unlock(hdev);
Johan Hedberg03811012010-12-08 00:21:06 +0200823 return err;
824}
825
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300826static int mgmt_event(u16 event, struct hci_dev *hdev, void *data, u16 data_len,
827 struct sock *skip_sk)
Johan Hedbergbeadb2b2012-02-21 16:55:31 +0200828{
829 struct sk_buff *skb;
830 struct mgmt_hdr *hdr;
831
Andre Guedes790eff42012-06-07 19:05:46 -0300832 skb = alloc_skb(sizeof(*hdr) + data_len, GFP_KERNEL);
Johan Hedbergbeadb2b2012-02-21 16:55:31 +0200833 if (!skb)
834 return -ENOMEM;
835
836 hdr = (void *) skb_put(skb, sizeof(*hdr));
837 hdr->opcode = cpu_to_le16(event);
838 if (hdev)
839 hdr->index = cpu_to_le16(hdev->id);
840 else
Syam Sidhardhan612dfce2012-10-29 22:37:36 +0530841 hdr->index = __constant_cpu_to_le16(MGMT_INDEX_NONE);
Johan Hedbergbeadb2b2012-02-21 16:55:31 +0200842 hdr->len = cpu_to_le16(data_len);
843
844 if (data)
845 memcpy(skb_put(skb, data_len), data, data_len);
846
Marcel Holtmann97e0bde2012-02-22 13:49:28 +0100847 /* Time stamp */
848 __net_timestamp(skb);
849
Johan Hedbergbeadb2b2012-02-21 16:55:31 +0200850 hci_send_to_control(skb, skip_sk);
851 kfree_skb(skb);
852
853 return 0;
854}
855
856static int new_settings(struct hci_dev *hdev, struct sock *skip)
857{
858 __le32 ev;
859
860 ev = cpu_to_le32(get_current_settings(hdev));
861
862 return mgmt_event(MGMT_EV_NEW_SETTINGS, hdev, &ev, sizeof(ev), skip);
863}
864
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200865static int set_discoverable(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300866 u16 len)
Johan Hedberg03811012010-12-08 00:21:06 +0200867{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -0300868 struct mgmt_cp_set_discoverable *cp = data;
Johan Hedberg03811012010-12-08 00:21:06 +0200869 struct pending_cmd *cmd;
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200870 u16 timeout;
Johan Hedberg03811012010-12-08 00:21:06 +0200871 u8 scan;
872 int err;
873
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200874 BT_DBG("request for %s", hdev->name);
Johan Hedberg03811012010-12-08 00:21:06 +0200875
Johan Hedberg33c525c2012-10-24 21:11:58 +0300876 if (!lmp_bredr_capable(hdev))
877 return cmd_status(sk, hdev->id, MGMT_OP_SET_DISCOVERABLE,
878 MGMT_STATUS_NOT_SUPPORTED);
879
Johan Hedberga7e80f22013-01-09 16:05:19 +0200880 if (cp->val != 0x00 && cp->val != 0x01)
881 return cmd_status(sk, hdev->id, MGMT_OP_SET_DISCOVERABLE,
882 MGMT_STATUS_INVALID_PARAMS);
883
Marcel Holtmann1f350c82012-03-12 20:31:08 -0700884 timeout = __le16_to_cpu(cp->timeout);
Marcel Holtmann24c54a92012-02-22 18:06:34 +0100885 if (!cp->val && timeout > 0)
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200886 return cmd_status(sk, hdev->id, MGMT_OP_SET_DISCOVERABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300887 MGMT_STATUS_INVALID_PARAMS);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200888
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -0300889 hci_dev_lock(hdev);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200890
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200891 if (!hdev_is_powered(hdev) && timeout > 0) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200892 err = cmd_status(sk, hdev->id, MGMT_OP_SET_DISCOVERABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300893 MGMT_STATUS_NOT_POWERED);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200894 goto failed;
895 }
896
897 if (mgmt_pending_find(MGMT_OP_SET_DISCOVERABLE, hdev) ||
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -0300898 mgmt_pending_find(MGMT_OP_SET_CONNECTABLE, hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200899 err = cmd_status(sk, hdev->id, MGMT_OP_SET_DISCOVERABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300900 MGMT_STATUS_BUSY);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200901 goto failed;
902 }
903
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200904 if (!test_bit(HCI_CONNECTABLE, &hdev->dev_flags)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200905 err = cmd_status(sk, hdev->id, MGMT_OP_SET_DISCOVERABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300906 MGMT_STATUS_REJECTED);
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200907 goto failed;
908 }
909
910 if (!hdev_is_powered(hdev)) {
Johan Hedberg0224d2f2012-02-21 19:40:05 +0200911 bool changed = false;
912
913 if (!!cp->val != test_bit(HCI_DISCOVERABLE, &hdev->dev_flags)) {
914 change_bit(HCI_DISCOVERABLE, &hdev->dev_flags);
915 changed = true;
916 }
917
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200918 err = send_settings_rsp(sk, MGMT_OP_SET_DISCOVERABLE, hdev);
Johan Hedberg0224d2f2012-02-21 19:40:05 +0200919 if (err < 0)
920 goto failed;
921
922 if (changed)
923 err = new_settings(hdev, sk);
924
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200925 goto failed;
926 }
927
928 if (!!cp->val == test_bit(HCI_DISCOVERABLE, &hdev->dev_flags)) {
Marcel Holtmann955638e2012-02-22 18:21:00 +0100929 if (hdev->discov_timeout > 0) {
930 cancel_delayed_work(&hdev->discov_off);
931 hdev->discov_timeout = 0;
932 }
933
934 if (cp->val && timeout > 0) {
935 hdev->discov_timeout = timeout;
936 queue_delayed_work(hdev->workqueue, &hdev->discov_off,
937 msecs_to_jiffies(hdev->discov_timeout * 1000));
938 }
939
Johan Hedberg69ab39e2011-12-15 00:47:35 +0200940 err = send_settings_rsp(sk, MGMT_OP_SET_DISCOVERABLE, hdev);
Johan Hedbergf7b64e692010-12-13 21:07:06 +0200941 goto failed;
942 }
943
944 cmd = mgmt_pending_add(sk, MGMT_OP_SET_DISCOVERABLE, hdev, data, len);
945 if (!cmd) {
946 err = -ENOMEM;
947 goto failed;
948 }
949
950 scan = SCAN_PAGE;
951
952 if (cp->val)
953 scan |= SCAN_INQUIRY;
954 else
955 cancel_delayed_work(&hdev->discov_off);
956
957 err = hci_send_cmd(hdev, HCI_OP_WRITE_SCAN_ENABLE, 1, &scan);
958 if (err < 0)
959 mgmt_pending_remove(cmd);
960
Johan Hedberg03811012010-12-08 00:21:06 +0200961 if (cp->val)
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200962 hdev->discov_timeout = timeout;
Johan Hedberg03811012010-12-08 00:21:06 +0200963
964failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -0300965 hci_dev_unlock(hdev);
Johan Hedberg03811012010-12-08 00:21:06 +0200966 return err;
967}
968
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200969static int set_connectable(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300970 u16 len)
Johan Hedberg03811012010-12-08 00:21:06 +0200971{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -0300972 struct mgmt_mode *cp = data;
Johan Hedberg03811012010-12-08 00:21:06 +0200973 struct pending_cmd *cmd;
974 u8 scan;
975 int err;
976
Johan Hedbergbdb6d972012-02-28 06:13:32 +0200977 BT_DBG("request for %s", hdev->name);
Johan Hedberge41d8b42010-12-13 21:07:03 +0200978
Johan Hedberg33c525c2012-10-24 21:11:58 +0300979 if (!lmp_bredr_capable(hdev))
980 return cmd_status(sk, hdev->id, MGMT_OP_SET_CONNECTABLE,
981 MGMT_STATUS_NOT_SUPPORTED);
982
Johan Hedberga7e80f22013-01-09 16:05:19 +0200983 if (cp->val != 0x00 && cp->val != 0x01)
984 return cmd_status(sk, hdev->id, MGMT_OP_SET_CONNECTABLE,
985 MGMT_STATUS_INVALID_PARAMS);
986
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -0300987 hci_dev_lock(hdev);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +0200988
Johan Hedberg4b34ee782012-02-21 14:13:02 +0200989 if (!hdev_is_powered(hdev)) {
Johan Hedberg0224d2f2012-02-21 19:40:05 +0200990 bool changed = false;
991
992 if (!!cp->val != test_bit(HCI_CONNECTABLE, &hdev->dev_flags))
993 changed = true;
994
Andrei Emeltchenko6bf0e462012-02-22 13:21:16 +0200995 if (cp->val) {
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200996 set_bit(HCI_CONNECTABLE, &hdev->dev_flags);
Andrei Emeltchenko6bf0e462012-02-22 13:21:16 +0200997 } else {
Johan Hedberg5e5282b2012-02-21 16:01:30 +0200998 clear_bit(HCI_CONNECTABLE, &hdev->dev_flags);
999 clear_bit(HCI_DISCOVERABLE, &hdev->dev_flags);
1000 }
Johan Hedberg0224d2f2012-02-21 19:40:05 +02001001
Johan Hedberg5e5282b2012-02-21 16:01:30 +02001002 err = send_settings_rsp(sk, MGMT_OP_SET_CONNECTABLE, hdev);
Johan Hedberg0224d2f2012-02-21 19:40:05 +02001003 if (err < 0)
1004 goto failed;
1005
1006 if (changed)
1007 err = new_settings(hdev, sk);
1008
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001009 goto failed;
1010 }
1011
1012 if (mgmt_pending_find(MGMT_OP_SET_DISCOVERABLE, hdev) ||
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001013 mgmt_pending_find(MGMT_OP_SET_CONNECTABLE, hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001014 err = cmd_status(sk, hdev->id, MGMT_OP_SET_CONNECTABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001015 MGMT_STATUS_BUSY);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001016 goto failed;
1017 }
1018
Johan Hedberg5e5282b2012-02-21 16:01:30 +02001019 if (!!cp->val == test_bit(HCI_PSCAN, &hdev->flags)) {
Johan Hedberg69ab39e2011-12-15 00:47:35 +02001020 err = send_settings_rsp(sk, MGMT_OP_SET_CONNECTABLE, hdev);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001021 goto failed;
1022 }
1023
1024 cmd = mgmt_pending_add(sk, MGMT_OP_SET_CONNECTABLE, hdev, data, len);
1025 if (!cmd) {
1026 err = -ENOMEM;
1027 goto failed;
1028 }
1029
Andrei Emeltchenko6bf0e462012-02-22 13:21:16 +02001030 if (cp->val) {
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001031 scan = SCAN_PAGE;
Andrei Emeltchenko6bf0e462012-02-22 13:21:16 +02001032 } else {
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001033 scan = 0;
1034
Johan Hedbergdf2c6c52012-02-21 19:15:49 +02001035 if (test_bit(HCI_ISCAN, &hdev->flags) &&
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001036 hdev->discov_timeout > 0)
Johan Hedbergdf2c6c52012-02-21 19:15:49 +02001037 cancel_delayed_work(&hdev->discov_off);
1038 }
1039
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001040 err = hci_send_cmd(hdev, HCI_OP_WRITE_SCAN_ENABLE, 1, &scan);
1041 if (err < 0)
1042 mgmt_pending_remove(cmd);
1043
1044failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001045 hci_dev_unlock(hdev);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001046 return err;
1047}
1048
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001049static int set_pairable(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001050 u16 len)
Johan Hedberg73f22f62010-12-29 16:00:25 +02001051{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001052 struct mgmt_mode *cp = data;
Johan Hedberg73f22f62010-12-29 16:00:25 +02001053 int err;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001054
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001055 BT_DBG("request for %s", hdev->name);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001056
Johan Hedberga7e80f22013-01-09 16:05:19 +02001057 if (cp->val != 0x00 && cp->val != 0x01)
1058 return cmd_status(sk, hdev->id, MGMT_OP_SET_PAIRABLE,
1059 MGMT_STATUS_INVALID_PARAMS);
1060
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001061 hci_dev_lock(hdev);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001062
1063 if (cp->val)
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001064 set_bit(HCI_PAIRABLE, &hdev->dev_flags);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001065 else
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001066 clear_bit(HCI_PAIRABLE, &hdev->dev_flags);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001067
Johan Hedberg69ab39e2011-12-15 00:47:35 +02001068 err = send_settings_rsp(sk, MGMT_OP_SET_PAIRABLE, hdev);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001069 if (err < 0)
1070 goto failed;
1071
Johan Hedbergbeadb2b2012-02-21 16:55:31 +02001072 err = new_settings(hdev, sk);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001073
1074failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001075 hci_dev_unlock(hdev);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02001076 return err;
1077}
Johan Hedberg72a734e2010-12-30 00:38:22 +02001078
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001079static int set_link_security(struct sock *sk, struct hci_dev *hdev, void *data,
1080 u16 len)
Johan Hedberg33ef95e2012-02-16 23:56:27 +02001081{
1082 struct mgmt_mode *cp = data;
1083 struct pending_cmd *cmd;
Johan Hedberg816a11d2012-02-26 13:04:52 +02001084 u8 val;
Johan Hedberg33ef95e2012-02-16 23:56:27 +02001085 int err;
1086
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001087 BT_DBG("request for %s", hdev->name);
Johan Hedberg33ef95e2012-02-16 23:56:27 +02001088
Johan Hedberg33c525c2012-10-24 21:11:58 +03001089 if (!lmp_bredr_capable(hdev))
1090 return cmd_status(sk, hdev->id, MGMT_OP_SET_LINK_SECURITY,
1091 MGMT_STATUS_NOT_SUPPORTED);
1092
Johan Hedberga7e80f22013-01-09 16:05:19 +02001093 if (cp->val != 0x00 && cp->val != 0x01)
1094 return cmd_status(sk, hdev->id, MGMT_OP_SET_LINK_SECURITY,
1095 MGMT_STATUS_INVALID_PARAMS);
1096
Johan Hedberg33ef95e2012-02-16 23:56:27 +02001097 hci_dev_lock(hdev);
1098
Johan Hedberg4b34ee782012-02-21 14:13:02 +02001099 if (!hdev_is_powered(hdev)) {
Johan Hedberg47990ea2012-02-22 11:58:37 +02001100 bool changed = false;
1101
1102 if (!!cp->val != test_bit(HCI_LINK_SECURITY,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001103 &hdev->dev_flags)) {
Johan Hedberg47990ea2012-02-22 11:58:37 +02001104 change_bit(HCI_LINK_SECURITY, &hdev->dev_flags);
1105 changed = true;
1106 }
1107
1108 err = send_settings_rsp(sk, MGMT_OP_SET_LINK_SECURITY, hdev);
1109 if (err < 0)
1110 goto failed;
1111
1112 if (changed)
1113 err = new_settings(hdev, sk);
1114
Johan Hedberg33ef95e2012-02-16 23:56:27 +02001115 goto failed;
1116 }
1117
1118 if (mgmt_pending_find(MGMT_OP_SET_LINK_SECURITY, hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001119 err = cmd_status(sk, hdev->id, MGMT_OP_SET_LINK_SECURITY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001120 MGMT_STATUS_BUSY);
Johan Hedberg33ef95e2012-02-16 23:56:27 +02001121 goto failed;
1122 }
1123
1124 val = !!cp->val;
1125
1126 if (test_bit(HCI_AUTH, &hdev->flags) == val) {
1127 err = send_settings_rsp(sk, MGMT_OP_SET_LINK_SECURITY, hdev);
1128 goto failed;
1129 }
1130
1131 cmd = mgmt_pending_add(sk, MGMT_OP_SET_LINK_SECURITY, hdev, data, len);
1132 if (!cmd) {
1133 err = -ENOMEM;
1134 goto failed;
1135 }
1136
1137 err = hci_send_cmd(hdev, HCI_OP_WRITE_AUTH_ENABLE, sizeof(val), &val);
1138 if (err < 0) {
1139 mgmt_pending_remove(cmd);
1140 goto failed;
1141 }
1142
1143failed:
1144 hci_dev_unlock(hdev);
Johan Hedberg33ef95e2012-02-16 23:56:27 +02001145 return err;
1146}
1147
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001148static int set_ssp(struct sock *sk, struct hci_dev *hdev, void *data, u16 len)
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001149{
1150 struct mgmt_mode *cp = data;
1151 struct pending_cmd *cmd;
Johan Hedberg816a11d2012-02-26 13:04:52 +02001152 u8 val;
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001153 int err;
1154
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001155 BT_DBG("request for %s", hdev->name);
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001156
Johan Hedberg13ecd8b2013-01-09 15:29:38 +02001157 if (!lmp_ssp_capable(hdev))
1158 return cmd_status(sk, hdev->id, MGMT_OP_SET_SSP,
1159 MGMT_STATUS_NOT_SUPPORTED);
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001160
Johan Hedberga7e80f22013-01-09 16:05:19 +02001161 if (cp->val != 0x00 && cp->val != 0x01)
1162 return cmd_status(sk, hdev->id, MGMT_OP_SET_SSP,
1163 MGMT_STATUS_INVALID_PARAMS);
1164
Johan Hedberg13ecd8b2013-01-09 15:29:38 +02001165 hci_dev_lock(hdev);
Johan Hedberg6c8f12c2012-02-22 16:35:26 +02001166
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02001167 val = !!cp->val;
1168
Johan Hedberg4b34ee782012-02-21 14:13:02 +02001169 if (!hdev_is_powered(hdev)) {
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02001170 bool changed = false;
1171
1172 if (val != test_bit(HCI_SSP_ENABLED, &hdev->dev_flags)) {
1173 change_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
1174 changed = true;
1175 }
1176
1177 err = send_settings_rsp(sk, MGMT_OP_SET_SSP, hdev);
1178 if (err < 0)
1179 goto failed;
1180
1181 if (changed)
1182 err = new_settings(hdev, sk);
1183
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001184 goto failed;
1185 }
1186
1187 if (mgmt_pending_find(MGMT_OP_SET_SSP, hdev)) {
Szymon Jancd97dcb62012-03-16 16:02:56 +01001188 err = cmd_status(sk, hdev->id, MGMT_OP_SET_SSP,
1189 MGMT_STATUS_BUSY);
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001190 goto failed;
1191 }
1192
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001193 if (test_bit(HCI_SSP_ENABLED, &hdev->dev_flags) == val) {
1194 err = send_settings_rsp(sk, MGMT_OP_SET_SSP, hdev);
1195 goto failed;
1196 }
1197
1198 cmd = mgmt_pending_add(sk, MGMT_OP_SET_SSP, hdev, data, len);
1199 if (!cmd) {
1200 err = -ENOMEM;
1201 goto failed;
1202 }
1203
1204 err = hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(val), &val);
1205 if (err < 0) {
1206 mgmt_pending_remove(cmd);
1207 goto failed;
1208 }
1209
1210failed:
1211 hci_dev_unlock(hdev);
Johan Hedberged2c4ee2012-02-17 00:56:28 +02001212 return err;
1213}
1214
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001215static int set_hs(struct sock *sk, struct hci_dev *hdev, void *data, u16 len)
Johan Hedberg6d80dfd2012-02-20 23:50:38 +02001216{
1217 struct mgmt_mode *cp = data;
Johan Hedberg6d80dfd2012-02-20 23:50:38 +02001218
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001219 BT_DBG("request for %s", hdev->name);
Johan Hedberg6d80dfd2012-02-20 23:50:38 +02001220
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001221 if (!enable_hs)
1222 return cmd_status(sk, hdev->id, MGMT_OP_SET_HS,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001223 MGMT_STATUS_NOT_SUPPORTED);
Johan Hedberg6d80dfd2012-02-20 23:50:38 +02001224
Johan Hedberga7e80f22013-01-09 16:05:19 +02001225 if (cp->val != 0x00 && cp->val != 0x01)
1226 return cmd_status(sk, hdev->id, MGMT_OP_SET_HS,
1227 MGMT_STATUS_INVALID_PARAMS);
1228
Johan Hedberg6d80dfd2012-02-20 23:50:38 +02001229 if (cp->val)
1230 set_bit(HCI_HS_ENABLED, &hdev->dev_flags);
1231 else
1232 clear_bit(HCI_HS_ENABLED, &hdev->dev_flags);
1233
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001234 return send_settings_rsp(sk, MGMT_OP_SET_HS, hdev);
Johan Hedberg6d80dfd2012-02-20 23:50:38 +02001235}
1236
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001237static int set_le(struct sock *sk, struct hci_dev *hdev, void *data, u16 len)
Johan Hedberg06199cf2012-02-22 16:37:11 +02001238{
1239 struct mgmt_mode *cp = data;
1240 struct hci_cp_write_le_host_supported hci_cp;
1241 struct pending_cmd *cmd;
Johan Hedberg06199cf2012-02-22 16:37:11 +02001242 int err;
Johan Hedberg0b60eba2012-02-28 00:57:24 +02001243 u8 val, enabled;
Johan Hedberg06199cf2012-02-22 16:37:11 +02001244
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001245 BT_DBG("request for %s", hdev->name);
Johan Hedberg06199cf2012-02-22 16:37:11 +02001246
Johan Hedberg13ecd8b2013-01-09 15:29:38 +02001247 if (!lmp_le_capable(hdev))
1248 return cmd_status(sk, hdev->id, MGMT_OP_SET_LE,
1249 MGMT_STATUS_NOT_SUPPORTED);
Johan Hedberg1de028c2012-02-29 19:55:35 -08001250
Johan Hedberga7e80f22013-01-09 16:05:19 +02001251 if (cp->val != 0x00 && cp->val != 0x01)
1252 return cmd_status(sk, hdev->id, MGMT_OP_SET_LE,
1253 MGMT_STATUS_INVALID_PARAMS);
1254
Johan Hedberg13ecd8b2013-01-09 15:29:38 +02001255 hci_dev_lock(hdev);
Johan Hedberg06199cf2012-02-22 16:37:11 +02001256
1257 val = !!cp->val;
Gustavo Padovanffa88e02012-11-23 16:50:51 -02001258 enabled = lmp_host_le_capable(hdev);
Johan Hedberg06199cf2012-02-22 16:37:11 +02001259
Johan Hedberg0b60eba2012-02-28 00:57:24 +02001260 if (!hdev_is_powered(hdev) || val == enabled) {
Johan Hedberg06199cf2012-02-22 16:37:11 +02001261 bool changed = false;
1262
1263 if (val != test_bit(HCI_LE_ENABLED, &hdev->dev_flags)) {
1264 change_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1265 changed = true;
1266 }
1267
1268 err = send_settings_rsp(sk, MGMT_OP_SET_LE, hdev);
1269 if (err < 0)
Johan Hedberg1de028c2012-02-29 19:55:35 -08001270 goto unlock;
Johan Hedberg06199cf2012-02-22 16:37:11 +02001271
1272 if (changed)
1273 err = new_settings(hdev, sk);
1274
Johan Hedberg1de028c2012-02-29 19:55:35 -08001275 goto unlock;
Johan Hedberg06199cf2012-02-22 16:37:11 +02001276 }
1277
1278 if (mgmt_pending_find(MGMT_OP_SET_LE, hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001279 err = cmd_status(sk, hdev->id, MGMT_OP_SET_LE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001280 MGMT_STATUS_BUSY);
Johan Hedberg1de028c2012-02-29 19:55:35 -08001281 goto unlock;
Johan Hedberg06199cf2012-02-22 16:37:11 +02001282 }
1283
1284 cmd = mgmt_pending_add(sk, MGMT_OP_SET_LE, hdev, data, len);
1285 if (!cmd) {
1286 err = -ENOMEM;
Johan Hedberg1de028c2012-02-29 19:55:35 -08001287 goto unlock;
Johan Hedberg06199cf2012-02-22 16:37:11 +02001288 }
1289
1290 memset(&hci_cp, 0, sizeof(hci_cp));
1291
1292 if (val) {
1293 hci_cp.le = val;
Gustavo Padovanffa88e02012-11-23 16:50:51 -02001294 hci_cp.simul = lmp_le_br_capable(hdev);
Johan Hedberg06199cf2012-02-22 16:37:11 +02001295 }
1296
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001297 err = hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(hci_cp),
1298 &hci_cp);
Syam Sidhardhan0c01bc42012-04-12 20:33:21 +05301299 if (err < 0)
Johan Hedberg06199cf2012-02-22 16:37:11 +02001300 mgmt_pending_remove(cmd);
Johan Hedberg06199cf2012-02-22 16:37:11 +02001301
Johan Hedberg1de028c2012-02-29 19:55:35 -08001302unlock:
1303 hci_dev_unlock(hdev);
Johan Hedberg06199cf2012-02-22 16:37:11 +02001304 return err;
1305}
1306
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001307static int add_uuid(struct sock *sk, struct hci_dev *hdev, void *data, u16 len)
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001308{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001309 struct mgmt_cp_add_uuid *cp = data;
Johan Hedberg90e70452012-02-23 23:09:40 +02001310 struct pending_cmd *cmd;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001311 struct bt_uuid *uuid;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001312 int err;
1313
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001314 BT_DBG("request for %s", hdev->name);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001315
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001316 hci_dev_lock(hdev);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001317
Johan Hedbergc95f0ba2012-02-23 22:54:38 +02001318 if (test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001319 err = cmd_status(sk, hdev->id, MGMT_OP_ADD_UUID,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001320 MGMT_STATUS_BUSY);
Johan Hedbergc95f0ba2012-02-23 22:54:38 +02001321 goto failed;
1322 }
1323
Andre Guedes92c4c202012-06-07 19:05:44 -03001324 uuid = kmalloc(sizeof(*uuid), GFP_KERNEL);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001325 if (!uuid) {
1326 err = -ENOMEM;
1327 goto failed;
1328 }
1329
1330 memcpy(uuid->uuid, cp->uuid, 16);
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001331 uuid->svc_hint = cp->svc_hint;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001332
1333 list_add(&uuid->list, &hdev->uuids);
1334
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001335 err = update_class(hdev);
1336 if (err < 0)
1337 goto failed;
1338
Johan Hedberg80a1e1d2011-03-28 14:07:23 +03001339 err = update_eir(hdev);
1340 if (err < 0)
1341 goto failed;
1342
Johan Hedberg90e70452012-02-23 23:09:40 +02001343 if (!test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001344 err = cmd_complete(sk, hdev->id, MGMT_OP_ADD_UUID, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001345 hdev->dev_class, 3);
Johan Hedberg90e70452012-02-23 23:09:40 +02001346 goto failed;
1347 }
1348
1349 cmd = mgmt_pending_add(sk, MGMT_OP_ADD_UUID, hdev, data, len);
Syam Sidhardhan0c01bc42012-04-12 20:33:21 +05301350 if (!cmd)
Johan Hedberg90e70452012-02-23 23:09:40 +02001351 err = -ENOMEM;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001352
1353failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001354 hci_dev_unlock(hdev);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001355 return err;
1356}
1357
Johan Hedberg24b78d02012-02-23 23:24:30 +02001358static bool enable_service_cache(struct hci_dev *hdev)
1359{
1360 if (!hdev_is_powered(hdev))
1361 return false;
1362
1363 if (!test_and_set_bit(HCI_SERVICE_CACHE, &hdev->dev_flags)) {
Johan Hedberg46818ed2013-01-14 22:33:52 +02001364 queue_delayed_work(hdev->workqueue, &hdev->service_cache,
1365 CACHE_TIMEOUT);
Johan Hedberg24b78d02012-02-23 23:24:30 +02001366 return true;
1367 }
1368
1369 return false;
1370}
1371
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001372static int remove_uuid(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001373 u16 len)
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001374{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001375 struct mgmt_cp_remove_uuid *cp = data;
Johan Hedberg90e70452012-02-23 23:09:40 +02001376 struct pending_cmd *cmd;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001377 struct list_head *p, *n;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001378 u8 bt_uuid_any[] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001379 int err, found;
1380
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001381 BT_DBG("request for %s", hdev->name);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001382
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001383 hci_dev_lock(hdev);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001384
Johan Hedbergc95f0ba2012-02-23 22:54:38 +02001385 if (test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001386 err = cmd_status(sk, hdev->id, MGMT_OP_REMOVE_UUID,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001387 MGMT_STATUS_BUSY);
Johan Hedbergc95f0ba2012-02-23 22:54:38 +02001388 goto unlock;
1389 }
1390
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001391 if (memcmp(cp->uuid, bt_uuid_any, 16) == 0) {
1392 err = hci_uuids_clear(hdev);
Johan Hedberg4004b6d2012-02-23 21:30:12 +02001393
Johan Hedberg24b78d02012-02-23 23:24:30 +02001394 if (enable_service_cache(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001395 err = cmd_complete(sk, hdev->id, MGMT_OP_REMOVE_UUID,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001396 0, hdev->dev_class, 3);
Johan Hedberg24b78d02012-02-23 23:24:30 +02001397 goto unlock;
1398 }
Johan Hedberg4004b6d2012-02-23 21:30:12 +02001399
Johan Hedberg9246a862012-02-23 21:33:16 +02001400 goto update_class;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001401 }
1402
1403 found = 0;
1404
1405 list_for_each_safe(p, n, &hdev->uuids) {
1406 struct bt_uuid *match = list_entry(p, struct bt_uuid, list);
1407
1408 if (memcmp(match->uuid, cp->uuid, 16) != 0)
1409 continue;
1410
1411 list_del(&match->list);
Johan Hedberg482049f2012-11-08 10:25:26 +01001412 kfree(match);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001413 found++;
1414 }
1415
1416 if (found == 0) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001417 err = cmd_status(sk, hdev->id, MGMT_OP_REMOVE_UUID,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001418 MGMT_STATUS_INVALID_PARAMS);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001419 goto unlock;
1420 }
1421
Johan Hedberg9246a862012-02-23 21:33:16 +02001422update_class:
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001423 err = update_class(hdev);
1424 if (err < 0)
1425 goto unlock;
1426
Johan Hedberg80a1e1d2011-03-28 14:07:23 +03001427 err = update_eir(hdev);
1428 if (err < 0)
1429 goto unlock;
1430
Johan Hedberg90e70452012-02-23 23:09:40 +02001431 if (!test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001432 err = cmd_complete(sk, hdev->id, MGMT_OP_REMOVE_UUID, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001433 hdev->dev_class, 3);
Johan Hedberg90e70452012-02-23 23:09:40 +02001434 goto unlock;
1435 }
1436
1437 cmd = mgmt_pending_add(sk, MGMT_OP_REMOVE_UUID, hdev, data, len);
Syam Sidhardhan0c01bc42012-04-12 20:33:21 +05301438 if (!cmd)
Johan Hedberg90e70452012-02-23 23:09:40 +02001439 err = -ENOMEM;
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001440
1441unlock:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001442 hci_dev_unlock(hdev);
Johan Hedberg2aeb9a12011-01-04 12:08:51 +02001443 return err;
1444}
1445
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001446static int set_dev_class(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001447 u16 len)
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001448{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001449 struct mgmt_cp_set_dev_class *cp = data;
Johan Hedberg90e70452012-02-23 23:09:40 +02001450 struct pending_cmd *cmd;
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001451 int err;
1452
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001453 BT_DBG("request for %s", hdev->name);
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001454
Johan Hedberg13ecd8b2013-01-09 15:29:38 +02001455 if (!lmp_bredr_capable(hdev))
1456 return cmd_status(sk, hdev->id, MGMT_OP_SET_DEV_CLASS,
1457 MGMT_STATUS_NOT_SUPPORTED);
1458
1459 if (test_bit(HCI_PENDING_CLASS, &hdev->dev_flags))
1460 return cmd_status(sk, hdev->id, MGMT_OP_SET_DEV_CLASS,
1461 MGMT_STATUS_BUSY);
1462
1463 if ((cp->minor & 0x03) != 0 || (cp->major & 0xe0) != 0)
1464 return cmd_status(sk, hdev->id, MGMT_OP_SET_DEV_CLASS,
1465 MGMT_STATUS_INVALID_PARAMS);
1466
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001467 hci_dev_lock(hdev);
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001468
1469 hdev->major_class = cp->major;
1470 hdev->minor_class = cp->minor;
1471
Johan Hedberg932f5ff2012-02-22 22:11:32 +02001472 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001473 err = cmd_complete(sk, hdev->id, MGMT_OP_SET_DEV_CLASS, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001474 hdev->dev_class, 3);
Johan Hedberg932f5ff2012-02-22 22:11:32 +02001475 goto unlock;
1476 }
1477
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001478 if (test_and_clear_bit(HCI_SERVICE_CACHE, &hdev->dev_flags)) {
Johan Hedberg7d785252011-12-15 00:47:39 +02001479 hci_dev_unlock(hdev);
1480 cancel_delayed_work_sync(&hdev->service_cache);
1481 hci_dev_lock(hdev);
Johan Hedberg14c0b602011-12-15 00:47:37 +02001482 update_eir(hdev);
Johan Hedberg7d785252011-12-15 00:47:39 +02001483 }
Johan Hedberg14c0b602011-12-15 00:47:37 +02001484
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001485 err = update_class(hdev);
Johan Hedberg90e70452012-02-23 23:09:40 +02001486 if (err < 0)
1487 goto unlock;
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001488
Johan Hedberg90e70452012-02-23 23:09:40 +02001489 if (!test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001490 err = cmd_complete(sk, hdev->id, MGMT_OP_SET_DEV_CLASS, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001491 hdev->dev_class, 3);
Johan Hedberg90e70452012-02-23 23:09:40 +02001492 goto unlock;
1493 }
1494
1495 cmd = mgmt_pending_add(sk, MGMT_OP_SET_DEV_CLASS, hdev, data, len);
Syam Sidhardhan0c01bc42012-04-12 20:33:21 +05301496 if (!cmd)
Johan Hedberg90e70452012-02-23 23:09:40 +02001497 err = -ENOMEM;
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001498
Johan Hedbergb5235a62012-02-21 14:32:24 +02001499unlock:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001500 hci_dev_unlock(hdev);
Johan Hedberg1aff6f02011-01-13 21:56:52 +02001501 return err;
1502}
1503
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001504static int load_link_keys(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001505 u16 len)
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001506{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001507 struct mgmt_cp_load_link_keys *cp = data;
Szymon Janc4e51eae2011-02-25 19:05:48 +01001508 u16 key_count, expected_len;
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03001509 int i;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001510
Marcel Holtmann1f350c82012-03-12 20:31:08 -07001511 key_count = __le16_to_cpu(cp->key_count);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001512
Johan Hedberg86742e12011-11-07 23:13:38 +02001513 expected_len = sizeof(*cp) + key_count *
1514 sizeof(struct mgmt_link_key_info);
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03001515 if (expected_len != len) {
Johan Hedberg86742e12011-11-07 23:13:38 +02001516 BT_ERR("load_link_keys: expected %u bytes, got %u bytes",
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001517 len, expected_len);
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001518 return cmd_status(sk, hdev->id, MGMT_OP_LOAD_LINK_KEYS,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001519 MGMT_STATUS_INVALID_PARAMS);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001520 }
1521
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001522 BT_DBG("%s debug_keys %u key_count %u", hdev->name, cp->debug_keys,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001523 key_count);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001524
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001525 hci_dev_lock(hdev);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001526
1527 hci_link_keys_clear(hdev);
1528
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001529 set_bit(HCI_LINK_KEYS, &hdev->dev_flags);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001530
1531 if (cp->debug_keys)
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001532 set_bit(HCI_DEBUG_KEYS, &hdev->dev_flags);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001533 else
Johan Hedberga8b2d5c2012-01-08 23:11:15 +02001534 clear_bit(HCI_DEBUG_KEYS, &hdev->dev_flags);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001535
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03001536 for (i = 0; i < key_count; i++) {
Johan Hedberg86742e12011-11-07 23:13:38 +02001537 struct mgmt_link_key_info *key = &cp->keys[i];
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001538
Johan Hedbergd753fdc2012-02-17 14:06:34 +02001539 hci_add_link_key(hdev, NULL, 0, &key->addr.bdaddr, key->val,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001540 key->type, key->pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001541 }
1542
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001543 cmd_complete(sk, hdev->id, MGMT_OP_LOAD_LINK_KEYS, 0, NULL, 0);
Johan Hedberg0e5f8752011-11-11 16:18:54 +02001544
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001545 hci_dev_unlock(hdev);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001546
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03001547 return 0;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001548}
1549
Johan Hedbergb1078ad2012-02-09 17:21:16 +02001550static int device_unpaired(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001551 u8 addr_type, struct sock *skip_sk)
Johan Hedbergb1078ad2012-02-09 17:21:16 +02001552{
1553 struct mgmt_ev_device_unpaired ev;
1554
1555 bacpy(&ev.addr.bdaddr, bdaddr);
1556 ev.addr.type = addr_type;
1557
1558 return mgmt_event(MGMT_EV_DEVICE_UNPAIRED, hdev, &ev, sizeof(ev),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001559 skip_sk);
Johan Hedbergb1078ad2012-02-09 17:21:16 +02001560}
1561
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001562static int unpair_device(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001563 u16 len)
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001564{
Johan Hedberg124f6e32012-02-09 13:50:12 +02001565 struct mgmt_cp_unpair_device *cp = data;
1566 struct mgmt_rp_unpair_device rp;
Johan Hedberga8a1d192011-11-10 15:54:38 +02001567 struct hci_cp_disconnect dc;
1568 struct pending_cmd *cmd;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001569 struct hci_conn *conn;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001570 int err;
1571
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001572 hci_dev_lock(hdev);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001573
Johan Hedberga8a1d192011-11-10 15:54:38 +02001574 memset(&rp, 0, sizeof(rp));
Johan Hedberg124f6e32012-02-09 13:50:12 +02001575 bacpy(&rp.addr.bdaddr, &cp->addr.bdaddr);
1576 rp.addr.type = cp->addr.type;
Johan Hedberga8a1d192011-11-10 15:54:38 +02001577
Johan Hedberg86a8cfc2012-02-22 22:53:34 +02001578 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001579 err = cmd_complete(sk, hdev->id, MGMT_OP_UNPAIR_DEVICE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001580 MGMT_STATUS_NOT_POWERED, &rp, sizeof(rp));
Johan Hedberg86a8cfc2012-02-22 22:53:34 +02001581 goto unlock;
1582 }
1583
Andre Guedes591f47f2012-04-24 21:02:49 -03001584 if (cp->addr.type == BDADDR_BREDR)
Johan Hedberg124f6e32012-02-09 13:50:12 +02001585 err = hci_remove_link_key(hdev, &cp->addr.bdaddr);
1586 else
1587 err = hci_remove_ltk(hdev, &cp->addr.bdaddr);
Vinicius Costa Gomesb0dbfb42012-02-02 21:08:03 -03001588
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001589 if (err < 0) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001590 err = cmd_complete(sk, hdev->id, MGMT_OP_UNPAIR_DEVICE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001591 MGMT_STATUS_NOT_PAIRED, &rp, sizeof(rp));
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001592 goto unlock;
1593 }
1594
Johan Hedberg86a8cfc2012-02-22 22:53:34 +02001595 if (cp->disconnect) {
Andre Guedes591f47f2012-04-24 21:02:49 -03001596 if (cp->addr.type == BDADDR_BREDR)
Johan Hedberg86a8cfc2012-02-22 22:53:34 +02001597 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001598 &cp->addr.bdaddr);
Johan Hedberg86a8cfc2012-02-22 22:53:34 +02001599 else
1600 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001601 &cp->addr.bdaddr);
Johan Hedberg86a8cfc2012-02-22 22:53:34 +02001602 } else {
1603 conn = NULL;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001604 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001605
Johan Hedberga8a1d192011-11-10 15:54:38 +02001606 if (!conn) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001607 err = cmd_complete(sk, hdev->id, MGMT_OP_UNPAIR_DEVICE, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001608 &rp, sizeof(rp));
Johan Hedbergb1078ad2012-02-09 17:21:16 +02001609 device_unpaired(hdev, &cp->addr.bdaddr, cp->addr.type, sk);
Johan Hedberga8a1d192011-11-10 15:54:38 +02001610 goto unlock;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001611 }
1612
Johan Hedberg124f6e32012-02-09 13:50:12 +02001613 cmd = mgmt_pending_add(sk, MGMT_OP_UNPAIR_DEVICE, hdev, cp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001614 sizeof(*cp));
Johan Hedberga8a1d192011-11-10 15:54:38 +02001615 if (!cmd) {
1616 err = -ENOMEM;
1617 goto unlock;
1618 }
1619
Marcel Holtmanneb55ef02012-03-14 18:08:46 +02001620 dc.handle = cpu_to_le16(conn->handle);
Johan Hedberga8a1d192011-11-10 15:54:38 +02001621 dc.reason = 0x13; /* Remote User Terminated Connection */
1622 err = hci_send_cmd(hdev, HCI_OP_DISCONNECT, sizeof(dc), &dc);
1623 if (err < 0)
1624 mgmt_pending_remove(cmd);
1625
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001626unlock:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001627 hci_dev_unlock(hdev);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02001628 return err;
1629}
1630
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001631static int disconnect(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001632 u16 len)
Johan Hedberg8962ee72011-01-20 12:40:27 +02001633{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001634 struct mgmt_cp_disconnect *cp = data;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001635 struct hci_cp_disconnect dc;
Johan Hedberg366a0332011-02-19 12:05:55 -03001636 struct pending_cmd *cmd;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001637 struct hci_conn *conn;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001638 int err;
1639
1640 BT_DBG("");
1641
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001642 hci_dev_lock(hdev);
Johan Hedberg8962ee72011-01-20 12:40:27 +02001643
1644 if (!test_bit(HCI_UP, &hdev->flags)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001645 err = cmd_status(sk, hdev->id, MGMT_OP_DISCONNECT,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001646 MGMT_STATUS_NOT_POWERED);
Johan Hedberg8962ee72011-01-20 12:40:27 +02001647 goto failed;
1648 }
1649
Johan Hedberg2e58ef32011-11-08 20:40:15 +02001650 if (mgmt_pending_find(MGMT_OP_DISCONNECT, hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001651 err = cmd_status(sk, hdev->id, MGMT_OP_DISCONNECT,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001652 MGMT_STATUS_BUSY);
Johan Hedberg8962ee72011-01-20 12:40:27 +02001653 goto failed;
1654 }
1655
Andre Guedes591f47f2012-04-24 21:02:49 -03001656 if (cp->addr.type == BDADDR_BREDR)
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03001657 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK,
1658 &cp->addr.bdaddr);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001659 else
1660 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->addr.bdaddr);
Vinicius Costa Gomes365227e2011-05-06 18:41:44 -03001661
Vishal Agarwalf9607272012-06-13 05:32:43 +05301662 if (!conn || conn->state == BT_OPEN || conn->state == BT_CLOSED) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001663 err = cmd_status(sk, hdev->id, MGMT_OP_DISCONNECT,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001664 MGMT_STATUS_NOT_CONNECTED);
Johan Hedberg8962ee72011-01-20 12:40:27 +02001665 goto failed;
1666 }
1667
Johan Hedberg2e58ef32011-11-08 20:40:15 +02001668 cmd = mgmt_pending_add(sk, MGMT_OP_DISCONNECT, hdev, data, len);
Johan Hedberg366a0332011-02-19 12:05:55 -03001669 if (!cmd) {
1670 err = -ENOMEM;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001671 goto failed;
Johan Hedberg366a0332011-02-19 12:05:55 -03001672 }
Johan Hedberg8962ee72011-01-20 12:40:27 +02001673
Marcel Holtmanneb55ef02012-03-14 18:08:46 +02001674 dc.handle = cpu_to_le16(conn->handle);
Andre Guedes3701f942012-06-11 18:41:12 -03001675 dc.reason = HCI_ERROR_REMOTE_USER_TERM;
Johan Hedberg8962ee72011-01-20 12:40:27 +02001676
1677 err = hci_send_cmd(hdev, HCI_OP_DISCONNECT, sizeof(dc), &dc);
1678 if (err < 0)
Johan Hedberga664b5b2011-02-19 12:06:02 -03001679 mgmt_pending_remove(cmd);
Johan Hedberg8962ee72011-01-20 12:40:27 +02001680
1681failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001682 hci_dev_unlock(hdev);
Johan Hedberg8962ee72011-01-20 12:40:27 +02001683 return err;
1684}
1685
Andre Guedes57c14772012-04-24 21:02:50 -03001686static u8 link_to_bdaddr(u8 link_type, u8 addr_type)
Johan Hedberg4c659c32011-11-07 23:13:39 +02001687{
1688 switch (link_type) {
1689 case LE_LINK:
Johan Hedberg48264f02011-11-09 13:58:58 +02001690 switch (addr_type) {
1691 case ADDR_LE_DEV_PUBLIC:
Andre Guedes591f47f2012-04-24 21:02:49 -03001692 return BDADDR_LE_PUBLIC;
Andre Guedes0ed09142012-04-03 08:46:54 -03001693
Johan Hedberg48264f02011-11-09 13:58:58 +02001694 default:
Andre Guedes0ed09142012-04-03 08:46:54 -03001695 /* Fallback to LE Random address type */
Andre Guedes591f47f2012-04-24 21:02:49 -03001696 return BDADDR_LE_RANDOM;
Johan Hedberg48264f02011-11-09 13:58:58 +02001697 }
Andre Guedes0ed09142012-04-03 08:46:54 -03001698
Johan Hedberg4c659c32011-11-07 23:13:39 +02001699 default:
Andre Guedes0ed09142012-04-03 08:46:54 -03001700 /* Fallback to BR/EDR type */
Andre Guedes591f47f2012-04-24 21:02:49 -03001701 return BDADDR_BREDR;
Johan Hedberg4c659c32011-11-07 23:13:39 +02001702 }
1703}
1704
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001705static int get_connections(struct sock *sk, struct hci_dev *hdev, void *data,
1706 u16 data_len)
Johan Hedberg2784eb42011-01-21 13:56:35 +02001707{
Johan Hedberg2784eb42011-01-21 13:56:35 +02001708 struct mgmt_rp_get_connections *rp;
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +02001709 struct hci_conn *c;
Johan Hedberga38528f2011-01-22 06:46:43 +02001710 size_t rp_len;
Johan Hedberg60fc5fb62012-02-23 09:52:28 +02001711 int err;
1712 u16 i;
Johan Hedberg2784eb42011-01-21 13:56:35 +02001713
1714 BT_DBG("");
1715
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001716 hci_dev_lock(hdev);
Johan Hedberg2784eb42011-01-21 13:56:35 +02001717
Johan Hedberg5f97c1d2012-02-22 22:41:18 +02001718 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001719 err = cmd_status(sk, hdev->id, MGMT_OP_GET_CONNECTIONS,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001720 MGMT_STATUS_NOT_POWERED);
Johan Hedberg5f97c1d2012-02-22 22:41:18 +02001721 goto unlock;
1722 }
1723
Johan Hedberg60fc5fb62012-02-23 09:52:28 +02001724 i = 0;
Johan Hedbergb644ba32012-01-17 21:48:47 +02001725 list_for_each_entry(c, &hdev->conn_hash.list, list) {
1726 if (test_bit(HCI_CONN_MGMT_CONNECTED, &c->flags))
Johan Hedberg60fc5fb62012-02-23 09:52:28 +02001727 i++;
Johan Hedberg2784eb42011-01-21 13:56:35 +02001728 }
1729
Johan Hedberg60fc5fb62012-02-23 09:52:28 +02001730 rp_len = sizeof(*rp) + (i * sizeof(struct mgmt_addr_info));
Andre Guedes92c4c202012-06-07 19:05:44 -03001731 rp = kmalloc(rp_len, GFP_KERNEL);
Johan Hedberga38528f2011-01-22 06:46:43 +02001732 if (!rp) {
Johan Hedberg2784eb42011-01-21 13:56:35 +02001733 err = -ENOMEM;
1734 goto unlock;
1735 }
1736
Johan Hedberg2784eb42011-01-21 13:56:35 +02001737 i = 0;
Johan Hedberg4c659c32011-11-07 23:13:39 +02001738 list_for_each_entry(c, &hdev->conn_hash.list, list) {
Johan Hedbergb644ba32012-01-17 21:48:47 +02001739 if (!test_bit(HCI_CONN_MGMT_CONNECTED, &c->flags))
1740 continue;
Johan Hedberg4c659c32011-11-07 23:13:39 +02001741 bacpy(&rp->addr[i].bdaddr, &c->dst);
Andre Guedes57c14772012-04-24 21:02:50 -03001742 rp->addr[i].type = link_to_bdaddr(c->type, c->dst_type);
Andre Guedes0ed09142012-04-03 08:46:54 -03001743 if (c->type == SCO_LINK || c->type == ESCO_LINK)
Johan Hedberg4c659c32011-11-07 23:13:39 +02001744 continue;
1745 i++;
1746 }
1747
Marcel Holtmanneb55ef02012-03-14 18:08:46 +02001748 rp->conn_count = cpu_to_le16(i);
Johan Hedberg60fc5fb62012-02-23 09:52:28 +02001749
Johan Hedberg4c659c32011-11-07 23:13:39 +02001750 /* Recalculate length in case of filtered SCO connections, etc */
1751 rp_len = sizeof(*rp) + (i * sizeof(struct mgmt_addr_info));
Johan Hedberg2784eb42011-01-21 13:56:35 +02001752
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001753 err = cmd_complete(sk, hdev->id, MGMT_OP_GET_CONNECTIONS, 0, rp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001754 rp_len);
Johan Hedberg2784eb42011-01-21 13:56:35 +02001755
Johan Hedberga38528f2011-01-22 06:46:43 +02001756 kfree(rp);
Johan Hedberg5f97c1d2012-02-22 22:41:18 +02001757
1758unlock:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001759 hci_dev_unlock(hdev);
Johan Hedberg2784eb42011-01-21 13:56:35 +02001760 return err;
1761}
1762
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001763static int send_pin_code_neg_reply(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001764 struct mgmt_cp_pin_code_neg_reply *cp)
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001765{
1766 struct pending_cmd *cmd;
1767 int err;
1768
Johan Hedberg2e58ef32011-11-08 20:40:15 +02001769 cmd = mgmt_pending_add(sk, MGMT_OP_PIN_CODE_NEG_REPLY, hdev, cp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001770 sizeof(*cp));
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001771 if (!cmd)
1772 return -ENOMEM;
1773
Johan Hedbergd8457692012-02-17 14:24:57 +02001774 err = hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001775 sizeof(cp->addr.bdaddr), &cp->addr.bdaddr);
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001776 if (err < 0)
1777 mgmt_pending_remove(cmd);
1778
1779 return err;
1780}
1781
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001782static int pin_code_reply(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001783 u16 len)
Johan Hedberg980e1a52011-01-22 06:10:07 +02001784{
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001785 struct hci_conn *conn;
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001786 struct mgmt_cp_pin_code_reply *cp = data;
Johan Hedberg980e1a52011-01-22 06:10:07 +02001787 struct hci_cp_pin_code_reply reply;
Johan Hedberg366a0332011-02-19 12:05:55 -03001788 struct pending_cmd *cmd;
Johan Hedberg980e1a52011-01-22 06:10:07 +02001789 int err;
1790
1791 BT_DBG("");
1792
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001793 hci_dev_lock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +02001794
Johan Hedberg4b34ee782012-02-21 14:13:02 +02001795 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001796 err = cmd_status(sk, hdev->id, MGMT_OP_PIN_CODE_REPLY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001797 MGMT_STATUS_NOT_POWERED);
Johan Hedberg980e1a52011-01-22 06:10:07 +02001798 goto failed;
1799 }
1800
Johan Hedbergd8457692012-02-17 14:24:57 +02001801 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->addr.bdaddr);
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001802 if (!conn) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001803 err = cmd_status(sk, hdev->id, MGMT_OP_PIN_CODE_REPLY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001804 MGMT_STATUS_NOT_CONNECTED);
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001805 goto failed;
1806 }
1807
1808 if (conn->pending_sec_level == BT_SECURITY_HIGH && cp->pin_len != 16) {
Johan Hedbergd8457692012-02-17 14:24:57 +02001809 struct mgmt_cp_pin_code_neg_reply ncp;
1810
1811 memcpy(&ncp.addr, &cp->addr, sizeof(ncp.addr));
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001812
1813 BT_ERR("PIN code is not 16 bytes long");
1814
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001815 err = send_pin_code_neg_reply(sk, hdev, &ncp);
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001816 if (err >= 0)
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001817 err = cmd_status(sk, hdev->id, MGMT_OP_PIN_CODE_REPLY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001818 MGMT_STATUS_INVALID_PARAMS);
Waldemar Rymarkiewicz96d97a62011-06-01 17:28:48 +02001819
1820 goto failed;
1821 }
1822
Gustavo F. Padovan00abfe42012-03-01 00:37:10 -03001823 cmd = mgmt_pending_add(sk, MGMT_OP_PIN_CODE_REPLY, hdev, data, len);
Johan Hedberg366a0332011-02-19 12:05:55 -03001824 if (!cmd) {
1825 err = -ENOMEM;
Johan Hedberg980e1a52011-01-22 06:10:07 +02001826 goto failed;
Johan Hedberg366a0332011-02-19 12:05:55 -03001827 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02001828
Johan Hedbergd8457692012-02-17 14:24:57 +02001829 bacpy(&reply.bdaddr, &cp->addr.bdaddr);
Johan Hedberg980e1a52011-01-22 06:10:07 +02001830 reply.pin_len = cp->pin_len;
Waldemar Rymarkiewicz24718ca2011-06-01 17:28:47 +02001831 memcpy(reply.pin_code, cp->pin_code, sizeof(reply.pin_code));
Johan Hedberg980e1a52011-01-22 06:10:07 +02001832
1833 err = hci_send_cmd(hdev, HCI_OP_PIN_CODE_REPLY, sizeof(reply), &reply);
1834 if (err < 0)
Johan Hedberga664b5b2011-02-19 12:06:02 -03001835 mgmt_pending_remove(cmd);
Johan Hedberg980e1a52011-01-22 06:10:07 +02001836
1837failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001838 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +02001839 return err;
1840}
1841
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001842static int set_io_capability(struct sock *sk, struct hci_dev *hdev, void *data,
1843 u16 len)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02001844{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001845 struct mgmt_cp_set_io_capability *cp = data;
Johan Hedberg17fa4b92011-01-25 13:28:33 +02001846
1847 BT_DBG("");
1848
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001849 hci_dev_lock(hdev);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02001850
1851 hdev->io_capability = cp->io_capability;
1852
1853 BT_DBG("%s IO capability set to 0x%02x", hdev->name,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03001854 hdev->io_capability);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02001855
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001856 hci_dev_unlock(hdev);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02001857
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001858 return cmd_complete(sk, hdev->id, MGMT_OP_SET_IO_CAPABILITY, 0, NULL,
1859 0);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02001860}
1861
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001862static struct pending_cmd *find_pairing(struct hci_conn *conn)
Johan Hedberge9a416b2011-02-19 12:05:56 -03001863{
1864 struct hci_dev *hdev = conn->hdev;
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +02001865 struct pending_cmd *cmd;
Johan Hedberge9a416b2011-02-19 12:05:56 -03001866
Johan Hedberg2e58ef32011-11-08 20:40:15 +02001867 list_for_each_entry(cmd, &hdev->mgmt_pending, list) {
Johan Hedberge9a416b2011-02-19 12:05:56 -03001868 if (cmd->opcode != MGMT_OP_PAIR_DEVICE)
1869 continue;
1870
Johan Hedberge9a416b2011-02-19 12:05:56 -03001871 if (cmd->user_data != conn)
1872 continue;
1873
1874 return cmd;
1875 }
1876
1877 return NULL;
1878}
1879
1880static void pairing_complete(struct pending_cmd *cmd, u8 status)
1881{
1882 struct mgmt_rp_pair_device rp;
1883 struct hci_conn *conn = cmd->user_data;
1884
Johan Hedbergba4e5642011-11-11 00:07:34 +02001885 bacpy(&rp.addr.bdaddr, &conn->dst);
Andre Guedes57c14772012-04-24 21:02:50 -03001886 rp.addr.type = link_to_bdaddr(conn->type, conn->dst_type);
Johan Hedberge9a416b2011-02-19 12:05:56 -03001887
Johan Hedbergaee9b212012-02-18 15:07:59 +02001888 cmd_complete(cmd->sk, cmd->index, MGMT_OP_PAIR_DEVICE, status,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001889 &rp, sizeof(rp));
Johan Hedberge9a416b2011-02-19 12:05:56 -03001890
1891 /* So we don't get further callbacks for this connection */
1892 conn->connect_cfm_cb = NULL;
1893 conn->security_cfm_cb = NULL;
1894 conn->disconn_cfm_cb = NULL;
1895
1896 hci_conn_put(conn);
1897
Johan Hedberga664b5b2011-02-19 12:06:02 -03001898 mgmt_pending_remove(cmd);
Johan Hedberge9a416b2011-02-19 12:05:56 -03001899}
1900
1901static void pairing_complete_cb(struct hci_conn *conn, u8 status)
1902{
1903 struct pending_cmd *cmd;
1904
1905 BT_DBG("status %u", status);
1906
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001907 cmd = find_pairing(conn);
1908 if (!cmd)
1909 BT_DBG("Unable to find a pending command");
1910 else
Johan Hedberge2113262012-02-18 15:20:03 +02001911 pairing_complete(cmd, mgmt_status(status));
Johan Hedberge9a416b2011-02-19 12:05:56 -03001912}
1913
Vishal Agarwal4c47d732012-06-07 20:27:35 +05301914static void le_connect_complete_cb(struct hci_conn *conn, u8 status)
1915{
1916 struct pending_cmd *cmd;
1917
1918 BT_DBG("status %u", status);
1919
1920 if (!status)
1921 return;
1922
1923 cmd = find_pairing(conn);
1924 if (!cmd)
1925 BT_DBG("Unable to find a pending command");
1926 else
1927 pairing_complete(cmd, mgmt_status(status));
1928}
1929
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001930static int pair_device(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001931 u16 len)
Johan Hedberge9a416b2011-02-19 12:05:56 -03001932{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03001933 struct mgmt_cp_pair_device *cp = data;
Johan Hedberg1425acb2011-11-11 00:07:35 +02001934 struct mgmt_rp_pair_device rp;
Johan Hedberge9a416b2011-02-19 12:05:56 -03001935 struct pending_cmd *cmd;
1936 u8 sec_level, auth_type;
1937 struct hci_conn *conn;
Johan Hedberge9a416b2011-02-19 12:05:56 -03001938 int err;
1939
1940 BT_DBG("");
1941
Szymon Jancf950a30e2013-01-18 12:48:07 +01001942 memset(&rp, 0, sizeof(rp));
1943 bacpy(&rp.addr.bdaddr, &cp->addr.bdaddr);
1944 rp.addr.type = cp->addr.type;
1945
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001946 hci_dev_lock(hdev);
Johan Hedberge9a416b2011-02-19 12:05:56 -03001947
Johan Hedberg5f97c1d2012-02-22 22:41:18 +02001948 if (!hdev_is_powered(hdev)) {
Szymon Jancf950a30e2013-01-18 12:48:07 +01001949 err = cmd_complete(sk, hdev->id, MGMT_OP_PAIR_DEVICE,
1950 MGMT_STATUS_NOT_POWERED, &rp, sizeof(rp));
Johan Hedberg5f97c1d2012-02-22 22:41:18 +02001951 goto unlock;
1952 }
1953
Vinicius Costa Gomesc908df32011-09-02 14:51:22 -03001954 sec_level = BT_SECURITY_MEDIUM;
1955 if (cp->io_cap == 0x03)
Johan Hedberge9a416b2011-02-19 12:05:56 -03001956 auth_type = HCI_AT_DEDICATED_BONDING;
Vinicius Costa Gomesc908df32011-09-02 14:51:22 -03001957 else
Johan Hedberge9a416b2011-02-19 12:05:56 -03001958 auth_type = HCI_AT_DEDICATED_BONDING_MITM;
Johan Hedberge9a416b2011-02-19 12:05:56 -03001959
Andre Guedes591f47f2012-04-24 21:02:49 -03001960 if (cp->addr.type == BDADDR_BREDR)
Andre Guedesb12f62c2012-04-24 21:02:54 -03001961 conn = hci_connect(hdev, ACL_LINK, &cp->addr.bdaddr,
1962 cp->addr.type, sec_level, auth_type);
Vinicius Costa Gomes7a512d02011-08-19 21:06:54 -03001963 else
Andre Guedesb12f62c2012-04-24 21:02:54 -03001964 conn = hci_connect(hdev, LE_LINK, &cp->addr.bdaddr,
1965 cp->addr.type, sec_level, auth_type);
Vinicius Costa Gomes7a512d02011-08-19 21:06:54 -03001966
Ville Tervo30e76272011-02-22 16:10:53 -03001967 if (IS_ERR(conn)) {
Andrzej Kaczmarek489dc482012-05-30 15:39:22 +02001968 int status;
1969
1970 if (PTR_ERR(conn) == -EBUSY)
1971 status = MGMT_STATUS_BUSY;
1972 else
1973 status = MGMT_STATUS_CONNECT_FAILED;
1974
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001975 err = cmd_complete(sk, hdev->id, MGMT_OP_PAIR_DEVICE,
Andrzej Kaczmarek489dc482012-05-30 15:39:22 +02001976 status, &rp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001977 sizeof(rp));
Johan Hedberge9a416b2011-02-19 12:05:56 -03001978 goto unlock;
1979 }
1980
1981 if (conn->connect_cfm_cb) {
1982 hci_conn_put(conn);
Johan Hedbergbdb6d972012-02-28 06:13:32 +02001983 err = cmd_complete(sk, hdev->id, MGMT_OP_PAIR_DEVICE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001984 MGMT_STATUS_BUSY, &rp, sizeof(rp));
Johan Hedberge9a416b2011-02-19 12:05:56 -03001985 goto unlock;
1986 }
1987
Johan Hedberg2e58ef32011-11-08 20:40:15 +02001988 cmd = mgmt_pending_add(sk, MGMT_OP_PAIR_DEVICE, hdev, data, len);
Johan Hedberge9a416b2011-02-19 12:05:56 -03001989 if (!cmd) {
1990 err = -ENOMEM;
1991 hci_conn_put(conn);
1992 goto unlock;
1993 }
1994
Vinicius Costa Gomes7a512d02011-08-19 21:06:54 -03001995 /* For LE, just connecting isn't a proof that the pairing finished */
Andre Guedes591f47f2012-04-24 21:02:49 -03001996 if (cp->addr.type == BDADDR_BREDR)
Vinicius Costa Gomes7a512d02011-08-19 21:06:54 -03001997 conn->connect_cfm_cb = pairing_complete_cb;
Vishal Agarwal4c47d732012-06-07 20:27:35 +05301998 else
1999 conn->connect_cfm_cb = le_connect_complete_cb;
Vinicius Costa Gomes7a512d02011-08-19 21:06:54 -03002000
Johan Hedberge9a416b2011-02-19 12:05:56 -03002001 conn->security_cfm_cb = pairing_complete_cb;
2002 conn->disconn_cfm_cb = pairing_complete_cb;
2003 conn->io_capability = cp->io_cap;
2004 cmd->user_data = conn;
2005
2006 if (conn->state == BT_CONNECTED &&
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03002007 hci_conn_security(conn, sec_level, auth_type))
Johan Hedberge9a416b2011-02-19 12:05:56 -03002008 pairing_complete(cmd, 0);
2009
2010 err = 0;
2011
2012unlock:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002013 hci_dev_unlock(hdev);
Johan Hedberge9a416b2011-02-19 12:05:56 -03002014 return err;
2015}
2016
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002017static int cancel_pair_device(struct sock *sk, struct hci_dev *hdev, void *data,
2018 u16 len)
Johan Hedberg28424702012-02-02 04:02:29 +02002019{
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002020 struct mgmt_addr_info *addr = data;
Johan Hedberg28424702012-02-02 04:02:29 +02002021 struct pending_cmd *cmd;
2022 struct hci_conn *conn;
2023 int err;
2024
2025 BT_DBG("");
2026
Johan Hedberg28424702012-02-02 04:02:29 +02002027 hci_dev_lock(hdev);
2028
Johan Hedberg5f97c1d2012-02-22 22:41:18 +02002029 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002030 err = cmd_status(sk, hdev->id, MGMT_OP_CANCEL_PAIR_DEVICE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002031 MGMT_STATUS_NOT_POWERED);
Johan Hedberg5f97c1d2012-02-22 22:41:18 +02002032 goto unlock;
2033 }
2034
Johan Hedberg28424702012-02-02 04:02:29 +02002035 cmd = mgmt_pending_find(MGMT_OP_PAIR_DEVICE, hdev);
2036 if (!cmd) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002037 err = cmd_status(sk, hdev->id, MGMT_OP_CANCEL_PAIR_DEVICE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002038 MGMT_STATUS_INVALID_PARAMS);
Johan Hedberg28424702012-02-02 04:02:29 +02002039 goto unlock;
2040 }
2041
2042 conn = cmd->user_data;
2043
2044 if (bacmp(&addr->bdaddr, &conn->dst) != 0) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002045 err = cmd_status(sk, hdev->id, MGMT_OP_CANCEL_PAIR_DEVICE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002046 MGMT_STATUS_INVALID_PARAMS);
Johan Hedberg28424702012-02-02 04:02:29 +02002047 goto unlock;
2048 }
2049
2050 pairing_complete(cmd, MGMT_STATUS_CANCELLED);
2051
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002052 err = cmd_complete(sk, hdev->id, MGMT_OP_CANCEL_PAIR_DEVICE, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002053 addr, sizeof(*addr));
Johan Hedberg28424702012-02-02 04:02:29 +02002054unlock:
2055 hci_dev_unlock(hdev);
Johan Hedberg28424702012-02-02 04:02:29 +02002056 return err;
2057}
2058
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002059static int user_pairing_resp(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002060 bdaddr_t *bdaddr, u8 type, u16 mgmt_op,
2061 u16 hci_op, __le32 passkey)
Johan Hedberga5c29682011-02-19 12:05:57 -03002062{
Johan Hedberga5c29682011-02-19 12:05:57 -03002063 struct pending_cmd *cmd;
Brian Gix0df4c182011-11-16 13:53:13 -08002064 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03002065 int err;
2066
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002067 hci_dev_lock(hdev);
Johan Hedberg08ba5382011-03-16 14:29:34 +02002068
Johan Hedberg4b34ee782012-02-21 14:13:02 +02002069 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002070 err = cmd_status(sk, hdev->id, mgmt_op,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002071 MGMT_STATUS_NOT_POWERED);
Brian Gix0df4c182011-11-16 13:53:13 -08002072 goto done;
Johan Hedberga5c29682011-02-19 12:05:57 -03002073 }
2074
Andre Guedes591f47f2012-04-24 21:02:49 -03002075 if (type == BDADDR_BREDR)
Johan Hedberg272d90d2012-02-09 15:26:12 +02002076 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, bdaddr);
2077 else
Brian Gix47c15e22011-11-16 13:53:14 -08002078 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, bdaddr);
Brian Gix47c15e22011-11-16 13:53:14 -08002079
Johan Hedberg272d90d2012-02-09 15:26:12 +02002080 if (!conn) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002081 err = cmd_status(sk, hdev->id, mgmt_op,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002082 MGMT_STATUS_NOT_CONNECTED);
Johan Hedberg272d90d2012-02-09 15:26:12 +02002083 goto done;
2084 }
2085
Andre Guedes591f47f2012-04-24 21:02:49 -03002086 if (type == BDADDR_LE_PUBLIC || type == BDADDR_LE_RANDOM) {
Brian Gix47c15e22011-11-16 13:53:14 -08002087 /* Continue with pairing via SMP */
Brian Gix5fe57d92011-12-21 16:12:13 -08002088 err = smp_user_confirm_reply(conn, mgmt_op, passkey);
Brian Gix47c15e22011-11-16 13:53:14 -08002089
Brian Gix5fe57d92011-12-21 16:12:13 -08002090 if (!err)
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002091 err = cmd_status(sk, hdev->id, mgmt_op,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002092 MGMT_STATUS_SUCCESS);
Brian Gix5fe57d92011-12-21 16:12:13 -08002093 else
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002094 err = cmd_status(sk, hdev->id, mgmt_op,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002095 MGMT_STATUS_FAILED);
Brian Gix5fe57d92011-12-21 16:12:13 -08002096
Brian Gix47c15e22011-11-16 13:53:14 -08002097 goto done;
2098 }
2099
Brian Gix0df4c182011-11-16 13:53:13 -08002100 cmd = mgmt_pending_add(sk, mgmt_op, hdev, bdaddr, sizeof(*bdaddr));
Johan Hedberga5c29682011-02-19 12:05:57 -03002101 if (!cmd) {
2102 err = -ENOMEM;
Brian Gix0df4c182011-11-16 13:53:13 -08002103 goto done;
Johan Hedberga5c29682011-02-19 12:05:57 -03002104 }
2105
Brian Gix0df4c182011-11-16 13:53:13 -08002106 /* Continue with pairing via HCI */
Brian Gix604086b2011-11-23 08:28:33 -08002107 if (hci_op == HCI_OP_USER_PASSKEY_REPLY) {
2108 struct hci_cp_user_passkey_reply cp;
2109
2110 bacpy(&cp.bdaddr, bdaddr);
2111 cp.passkey = passkey;
2112 err = hci_send_cmd(hdev, hci_op, sizeof(cp), &cp);
2113 } else
2114 err = hci_send_cmd(hdev, hci_op, sizeof(*bdaddr), bdaddr);
2115
Johan Hedberga664b5b2011-02-19 12:06:02 -03002116 if (err < 0)
2117 mgmt_pending_remove(cmd);
Johan Hedberga5c29682011-02-19 12:05:57 -03002118
Brian Gix0df4c182011-11-16 13:53:13 -08002119done:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002120 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -03002121 return err;
2122}
2123
Jaganath Kanakkasseryafeb0192012-07-09 16:11:51 +05302124static int pin_code_neg_reply(struct sock *sk, struct hci_dev *hdev,
2125 void *data, u16 len)
2126{
2127 struct mgmt_cp_pin_code_neg_reply *cp = data;
2128
2129 BT_DBG("");
2130
2131 return user_pairing_resp(sk, hdev, &cp->addr.bdaddr, cp->addr.type,
2132 MGMT_OP_PIN_CODE_NEG_REPLY,
2133 HCI_OP_PIN_CODE_NEG_REPLY, 0);
2134}
2135
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002136static int user_confirm_reply(struct sock *sk, struct hci_dev *hdev, void *data,
2137 u16 len)
Brian Gix0df4c182011-11-16 13:53:13 -08002138{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002139 struct mgmt_cp_user_confirm_reply *cp = data;
Brian Gix0df4c182011-11-16 13:53:13 -08002140
2141 BT_DBG("");
2142
2143 if (len != sizeof(*cp))
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002144 return cmd_status(sk, hdev->id, MGMT_OP_USER_CONFIRM_REPLY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002145 MGMT_STATUS_INVALID_PARAMS);
Brian Gix0df4c182011-11-16 13:53:13 -08002146
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002147 return user_pairing_resp(sk, hdev, &cp->addr.bdaddr, cp->addr.type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002148 MGMT_OP_USER_CONFIRM_REPLY,
2149 HCI_OP_USER_CONFIRM_REPLY, 0);
Brian Gix0df4c182011-11-16 13:53:13 -08002150}
2151
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002152static int user_confirm_neg_reply(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002153 void *data, u16 len)
Brian Gix0df4c182011-11-16 13:53:13 -08002154{
Johan Hedbergc9c26592011-12-15 00:47:41 +02002155 struct mgmt_cp_user_confirm_neg_reply *cp = data;
Brian Gix0df4c182011-11-16 13:53:13 -08002156
2157 BT_DBG("");
2158
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002159 return user_pairing_resp(sk, hdev, &cp->addr.bdaddr, cp->addr.type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002160 MGMT_OP_USER_CONFIRM_NEG_REPLY,
2161 HCI_OP_USER_CONFIRM_NEG_REPLY, 0);
Brian Gix0df4c182011-11-16 13:53:13 -08002162}
2163
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002164static int user_passkey_reply(struct sock *sk, struct hci_dev *hdev, void *data,
2165 u16 len)
Brian Gix604086b2011-11-23 08:28:33 -08002166{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002167 struct mgmt_cp_user_passkey_reply *cp = data;
Brian Gix604086b2011-11-23 08:28:33 -08002168
2169 BT_DBG("");
2170
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002171 return user_pairing_resp(sk, hdev, &cp->addr.bdaddr, cp->addr.type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002172 MGMT_OP_USER_PASSKEY_REPLY,
2173 HCI_OP_USER_PASSKEY_REPLY, cp->passkey);
Brian Gix604086b2011-11-23 08:28:33 -08002174}
2175
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002176static int user_passkey_neg_reply(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002177 void *data, u16 len)
Brian Gix604086b2011-11-23 08:28:33 -08002178{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002179 struct mgmt_cp_user_passkey_neg_reply *cp = data;
Brian Gix604086b2011-11-23 08:28:33 -08002180
2181 BT_DBG("");
2182
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002183 return user_pairing_resp(sk, hdev, &cp->addr.bdaddr, cp->addr.type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002184 MGMT_OP_USER_PASSKEY_NEG_REPLY,
2185 HCI_OP_USER_PASSKEY_NEG_REPLY, 0);
Brian Gix604086b2011-11-23 08:28:33 -08002186}
2187
Johan Hedberg2b4bf392012-03-03 00:19:06 +02002188static int update_name(struct hci_dev *hdev, const char *name)
2189{
2190 struct hci_cp_write_local_name cp;
2191
2192 memcpy(cp.name, name, sizeof(cp.name));
2193
2194 return hci_send_cmd(hdev, HCI_OP_WRITE_LOCAL_NAME, sizeof(cp), &cp);
2195}
2196
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002197static int set_local_name(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002198 u16 len)
Johan Hedbergb312b1612011-03-16 14:29:37 +02002199{
Johan Hedberg2b4bf392012-03-03 00:19:06 +02002200 struct mgmt_cp_set_local_name *cp = data;
Johan Hedbergb312b1612011-03-16 14:29:37 +02002201 struct pending_cmd *cmd;
2202 int err;
2203
2204 BT_DBG("");
2205
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002206 hci_dev_lock(hdev);
Johan Hedbergb312b1612011-03-16 14:29:37 +02002207
Johan Hedberg2b4bf392012-03-03 00:19:06 +02002208 memcpy(hdev->short_name, cp->short_name, sizeof(hdev->short_name));
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02002209
Johan Hedbergb5235a62012-02-21 14:32:24 +02002210 if (!hdev_is_powered(hdev)) {
Johan Hedberg2b4bf392012-03-03 00:19:06 +02002211 memcpy(hdev->dev_name, cp->name, sizeof(hdev->dev_name));
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02002212
2213 err = cmd_complete(sk, hdev->id, MGMT_OP_SET_LOCAL_NAME, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002214 data, len);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02002215 if (err < 0)
2216 goto failed;
2217
2218 err = mgmt_event(MGMT_EV_LOCAL_NAME_CHANGED, hdev, data, len,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002219 sk);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02002220
Johan Hedbergb5235a62012-02-21 14:32:24 +02002221 goto failed;
2222 }
2223
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02002224 cmd = mgmt_pending_add(sk, MGMT_OP_SET_LOCAL_NAME, hdev, data, len);
Johan Hedbergb312b1612011-03-16 14:29:37 +02002225 if (!cmd) {
2226 err = -ENOMEM;
2227 goto failed;
2228 }
2229
Johan Hedberg2b4bf392012-03-03 00:19:06 +02002230 err = update_name(hdev, cp->name);
Johan Hedbergb312b1612011-03-16 14:29:37 +02002231 if (err < 0)
2232 mgmt_pending_remove(cmd);
2233
2234failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002235 hci_dev_unlock(hdev);
Johan Hedbergb312b1612011-03-16 14:29:37 +02002236 return err;
2237}
2238
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002239static int read_local_oob_data(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002240 void *data, u16 data_len)
Szymon Jancc35938b2011-03-22 13:12:21 +01002241{
Szymon Jancc35938b2011-03-22 13:12:21 +01002242 struct pending_cmd *cmd;
2243 int err;
2244
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002245 BT_DBG("%s", hdev->name);
Szymon Jancc35938b2011-03-22 13:12:21 +01002246
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002247 hci_dev_lock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +01002248
Johan Hedberg4b34ee782012-02-21 14:13:02 +02002249 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002250 err = cmd_status(sk, hdev->id, MGMT_OP_READ_LOCAL_OOB_DATA,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002251 MGMT_STATUS_NOT_POWERED);
Szymon Jancc35938b2011-03-22 13:12:21 +01002252 goto unlock;
2253 }
2254
Andre Guedes9a1a1992012-07-24 15:03:48 -03002255 if (!lmp_ssp_capable(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002256 err = cmd_status(sk, hdev->id, MGMT_OP_READ_LOCAL_OOB_DATA,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002257 MGMT_STATUS_NOT_SUPPORTED);
Szymon Jancc35938b2011-03-22 13:12:21 +01002258 goto unlock;
2259 }
2260
Johan Hedberg2e58ef32011-11-08 20:40:15 +02002261 if (mgmt_pending_find(MGMT_OP_READ_LOCAL_OOB_DATA, hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002262 err = cmd_status(sk, hdev->id, MGMT_OP_READ_LOCAL_OOB_DATA,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002263 MGMT_STATUS_BUSY);
Szymon Jancc35938b2011-03-22 13:12:21 +01002264 goto unlock;
2265 }
2266
Johan Hedberg2e58ef32011-11-08 20:40:15 +02002267 cmd = mgmt_pending_add(sk, MGMT_OP_READ_LOCAL_OOB_DATA, hdev, NULL, 0);
Szymon Jancc35938b2011-03-22 13:12:21 +01002268 if (!cmd) {
2269 err = -ENOMEM;
2270 goto unlock;
2271 }
2272
2273 err = hci_send_cmd(hdev, HCI_OP_READ_LOCAL_OOB_DATA, 0, NULL);
2274 if (err < 0)
2275 mgmt_pending_remove(cmd);
2276
2277unlock:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002278 hci_dev_unlock(hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +01002279 return err;
2280}
2281
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002282static int add_remote_oob_data(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002283 void *data, u16 len)
Szymon Janc2763eda2011-03-22 13:12:22 +01002284{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002285 struct mgmt_cp_add_remote_oob_data *cp = data;
Johan Hedbergbf1e3542012-02-19 13:16:14 +02002286 u8 status;
Szymon Janc2763eda2011-03-22 13:12:22 +01002287 int err;
2288
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002289 BT_DBG("%s ", hdev->name);
Szymon Janc2763eda2011-03-22 13:12:22 +01002290
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002291 hci_dev_lock(hdev);
Szymon Janc2763eda2011-03-22 13:12:22 +01002292
Johan Hedberg664ce4c2012-02-09 15:44:09 +02002293 err = hci_add_remote_oob_data(hdev, &cp->addr.bdaddr, cp->hash,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002294 cp->randomizer);
Szymon Janc2763eda2011-03-22 13:12:22 +01002295 if (err < 0)
Johan Hedbergbf1e3542012-02-19 13:16:14 +02002296 status = MGMT_STATUS_FAILED;
Szymon Janc2763eda2011-03-22 13:12:22 +01002297 else
Szymon Janca6785be2012-12-13 15:11:21 +01002298 status = MGMT_STATUS_SUCCESS;
Johan Hedbergbf1e3542012-02-19 13:16:14 +02002299
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002300 err = cmd_complete(sk, hdev->id, MGMT_OP_ADD_REMOTE_OOB_DATA, status,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002301 &cp->addr, sizeof(cp->addr));
Szymon Janc2763eda2011-03-22 13:12:22 +01002302
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002303 hci_dev_unlock(hdev);
Szymon Janc2763eda2011-03-22 13:12:22 +01002304 return err;
2305}
2306
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002307static int remove_remote_oob_data(struct sock *sk, struct hci_dev *hdev,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03002308 void *data, u16 len)
Szymon Janc2763eda2011-03-22 13:12:22 +01002309{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002310 struct mgmt_cp_remove_remote_oob_data *cp = data;
Johan Hedbergbf1e3542012-02-19 13:16:14 +02002311 u8 status;
Szymon Janc2763eda2011-03-22 13:12:22 +01002312 int err;
2313
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002314 BT_DBG("%s", hdev->name);
Szymon Janc2763eda2011-03-22 13:12:22 +01002315
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002316 hci_dev_lock(hdev);
Szymon Janc2763eda2011-03-22 13:12:22 +01002317
Johan Hedberg664ce4c2012-02-09 15:44:09 +02002318 err = hci_remove_remote_oob_data(hdev, &cp->addr.bdaddr);
Szymon Janc2763eda2011-03-22 13:12:22 +01002319 if (err < 0)
Johan Hedbergbf1e3542012-02-19 13:16:14 +02002320 status = MGMT_STATUS_INVALID_PARAMS;
Szymon Janc2763eda2011-03-22 13:12:22 +01002321 else
Szymon Janca6785be2012-12-13 15:11:21 +01002322 status = MGMT_STATUS_SUCCESS;
Johan Hedbergbf1e3542012-02-19 13:16:14 +02002323
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002324 err = cmd_complete(sk, hdev->id, MGMT_OP_REMOVE_REMOTE_OOB_DATA,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002325 status, &cp->addr, sizeof(cp->addr));
Szymon Janc2763eda2011-03-22 13:12:22 +01002326
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002327 hci_dev_unlock(hdev);
Szymon Janc2763eda2011-03-22 13:12:22 +01002328 return err;
2329}
2330
Andre Guedes5e0452c2012-02-17 20:39:38 -03002331int mgmt_interleaved_discovery(struct hci_dev *hdev)
2332{
2333 int err;
2334
2335 BT_DBG("%s", hdev->name);
2336
2337 hci_dev_lock(hdev);
2338
2339 err = hci_do_inquiry(hdev, INQUIRY_LEN_BREDR_LE);
2340 if (err < 0)
2341 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
2342
2343 hci_dev_unlock(hdev);
2344
2345 return err;
2346}
2347
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002348static int start_discovery(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002349 void *data, u16 len)
Johan Hedberg14a53662011-04-27 10:29:56 -04002350{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002351 struct mgmt_cp_start_discovery *cp = data;
Johan Hedberg14a53662011-04-27 10:29:56 -04002352 struct pending_cmd *cmd;
Johan Hedberg14a53662011-04-27 10:29:56 -04002353 int err;
2354
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002355 BT_DBG("%s", hdev->name);
Johan Hedberg14a53662011-04-27 10:29:56 -04002356
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002357 hci_dev_lock(hdev);
Johan Hedberg14a53662011-04-27 10:29:56 -04002358
Johan Hedberg4b34ee782012-02-21 14:13:02 +02002359 if (!hdev_is_powered(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002360 err = cmd_status(sk, hdev->id, MGMT_OP_START_DISCOVERY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002361 MGMT_STATUS_NOT_POWERED);
Johan Hedbergbd2d1332011-11-07 23:13:37 +02002362 goto failed;
2363 }
2364
Andre Guedes642be6c2012-03-21 00:03:37 -03002365 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags)) {
2366 err = cmd_status(sk, hdev->id, MGMT_OP_START_DISCOVERY,
2367 MGMT_STATUS_BUSY);
2368 goto failed;
2369 }
2370
Johan Hedbergff9ef572012-01-04 14:23:45 +02002371 if (hdev->discovery.state != DISCOVERY_STOPPED) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002372 err = cmd_status(sk, hdev->id, MGMT_OP_START_DISCOVERY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002373 MGMT_STATUS_BUSY);
Johan Hedbergff9ef572012-01-04 14:23:45 +02002374 goto failed;
2375 }
2376
Johan Hedberg2e58ef32011-11-08 20:40:15 +02002377 cmd = mgmt_pending_add(sk, MGMT_OP_START_DISCOVERY, hdev, NULL, 0);
Johan Hedberg14a53662011-04-27 10:29:56 -04002378 if (!cmd) {
2379 err = -ENOMEM;
2380 goto failed;
2381 }
2382
Andre Guedes4aab14e2012-02-17 20:39:36 -03002383 hdev->discovery.type = cp->type;
2384
2385 switch (hdev->discovery.type) {
Andre Guedesf39799f2012-02-17 20:39:35 -03002386 case DISCOV_TYPE_BREDR:
Johan Hedberg04106752013-01-10 14:54:09 +02002387 if (!lmp_bredr_capable(hdev)) {
2388 err = cmd_status(sk, hdev->id, MGMT_OP_START_DISCOVERY,
2389 MGMT_STATUS_NOT_SUPPORTED);
2390 mgmt_pending_remove(cmd);
2391 goto failed;
2392 }
2393
2394 err = hci_do_inquiry(hdev, INQUIRY_LEN_BREDR);
Andre Guedesf39799f2012-02-17 20:39:35 -03002395 break;
2396
2397 case DISCOV_TYPE_LE:
Johan Hedberg04106752013-01-10 14:54:09 +02002398 if (!lmp_host_le_capable(hdev)) {
2399 err = cmd_status(sk, hdev->id, MGMT_OP_START_DISCOVERY,
2400 MGMT_STATUS_NOT_SUPPORTED);
2401 mgmt_pending_remove(cmd);
2402 goto failed;
2403 }
2404
2405 err = hci_le_scan(hdev, LE_SCAN_TYPE, LE_SCAN_INT,
2406 LE_SCAN_WIN, LE_SCAN_TIMEOUT_LE_ONLY);
Andre Guedesf39799f2012-02-17 20:39:35 -03002407 break;
2408
Andre Guedes5e0452c2012-02-17 20:39:38 -03002409 case DISCOV_TYPE_INTERLEAVED:
Johan Hedberg04106752013-01-10 14:54:09 +02002410 if (!lmp_host_le_capable(hdev) || !lmp_bredr_capable(hdev)) {
2411 err = cmd_status(sk, hdev->id, MGMT_OP_START_DISCOVERY,
2412 MGMT_STATUS_NOT_SUPPORTED);
2413 mgmt_pending_remove(cmd);
2414 goto failed;
2415 }
2416
2417 err = hci_le_scan(hdev, LE_SCAN_TYPE, LE_SCAN_INT, LE_SCAN_WIN,
2418 LE_SCAN_TIMEOUT_BREDR_LE);
Andre Guedes5e0452c2012-02-17 20:39:38 -03002419 break;
2420
Andre Guedesf39799f2012-02-17 20:39:35 -03002421 default:
Johan Hedberg04106752013-01-10 14:54:09 +02002422 err = cmd_status(sk, hdev->id, MGMT_OP_START_DISCOVERY,
2423 MGMT_STATUS_INVALID_PARAMS);
2424 mgmt_pending_remove(cmd);
2425 goto failed;
Andre Guedesf39799f2012-02-17 20:39:35 -03002426 }
Andre Guedes3fd24152012-02-03 17:48:01 -03002427
Johan Hedberg14a53662011-04-27 10:29:56 -04002428 if (err < 0)
2429 mgmt_pending_remove(cmd);
Johan Hedbergff9ef572012-01-04 14:23:45 +02002430 else
2431 hci_discovery_set_state(hdev, DISCOVERY_STARTING);
Johan Hedberg14a53662011-04-27 10:29:56 -04002432
2433failed:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002434 hci_dev_unlock(hdev);
Johan Hedberg14a53662011-04-27 10:29:56 -04002435 return err;
2436}
2437
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002438static int stop_discovery(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002439 u16 len)
Johan Hedberg14a53662011-04-27 10:29:56 -04002440{
Johan Hedbergd9306502012-02-20 23:25:18 +02002441 struct mgmt_cp_stop_discovery *mgmt_cp = data;
Johan Hedberg14a53662011-04-27 10:29:56 -04002442 struct pending_cmd *cmd;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002443 struct hci_cp_remote_name_req_cancel cp;
2444 struct inquiry_entry *e;
Johan Hedberg14a53662011-04-27 10:29:56 -04002445 int err;
2446
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002447 BT_DBG("%s", hdev->name);
Johan Hedberg14a53662011-04-27 10:29:56 -04002448
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002449 hci_dev_lock(hdev);
Johan Hedberg14a53662011-04-27 10:29:56 -04002450
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002451 if (!hci_discovery_active(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002452 err = cmd_complete(sk, hdev->id, MGMT_OP_STOP_DISCOVERY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002453 MGMT_STATUS_REJECTED, &mgmt_cp->type,
2454 sizeof(mgmt_cp->type));
Johan Hedbergd9306502012-02-20 23:25:18 +02002455 goto unlock;
2456 }
2457
2458 if (hdev->discovery.type != mgmt_cp->type) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002459 err = cmd_complete(sk, hdev->id, MGMT_OP_STOP_DISCOVERY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002460 MGMT_STATUS_INVALID_PARAMS, &mgmt_cp->type,
2461 sizeof(mgmt_cp->type));
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002462 goto unlock;
Johan Hedbergff9ef572012-01-04 14:23:45 +02002463 }
2464
Johan Hedberg2e58ef32011-11-08 20:40:15 +02002465 cmd = mgmt_pending_add(sk, MGMT_OP_STOP_DISCOVERY, hdev, NULL, 0);
Johan Hedberg14a53662011-04-27 10:29:56 -04002466 if (!cmd) {
2467 err = -ENOMEM;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002468 goto unlock;
Johan Hedberg14a53662011-04-27 10:29:56 -04002469 }
2470
Andre Guedese0d9727e2012-03-20 15:15:36 -03002471 switch (hdev->discovery.state) {
2472 case DISCOVERY_FINDING:
Andre Guedesc9ecc482012-03-15 16:52:08 -03002473 if (test_bit(HCI_INQUIRY, &hdev->flags))
2474 err = hci_cancel_inquiry(hdev);
2475 else
2476 err = hci_cancel_le_scan(hdev);
2477
Andre Guedese0d9727e2012-03-20 15:15:36 -03002478 break;
2479
2480 case DISCOVERY_RESOLVING:
2481 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03002482 NAME_PENDING);
Andre Guedese0d9727e2012-03-20 15:15:36 -03002483 if (!e) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002484 mgmt_pending_remove(cmd);
Andre Guedese0d9727e2012-03-20 15:15:36 -03002485 err = cmd_complete(sk, hdev->id,
2486 MGMT_OP_STOP_DISCOVERY, 0,
2487 &mgmt_cp->type,
2488 sizeof(mgmt_cp->type));
2489 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
2490 goto unlock;
2491 }
2492
2493 bacpy(&cp.bdaddr, &e->data.bdaddr);
2494 err = hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ_CANCEL,
2495 sizeof(cp), &cp);
2496
2497 break;
2498
2499 default:
2500 BT_DBG("unknown discovery state %u", hdev->discovery.state);
2501 err = -EFAULT;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002502 }
2503
Johan Hedberg14a53662011-04-27 10:29:56 -04002504 if (err < 0)
2505 mgmt_pending_remove(cmd);
Johan Hedbergff9ef572012-01-04 14:23:45 +02002506 else
2507 hci_discovery_set_state(hdev, DISCOVERY_STOPPING);
Johan Hedberg14a53662011-04-27 10:29:56 -04002508
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002509unlock:
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002510 hci_dev_unlock(hdev);
Johan Hedberg14a53662011-04-27 10:29:56 -04002511 return err;
2512}
2513
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002514static int confirm_name(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002515 u16 len)
Johan Hedberg561aafb2012-01-04 13:31:59 +02002516{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002517 struct mgmt_cp_confirm_name *cp = data;
Johan Hedberg561aafb2012-01-04 13:31:59 +02002518 struct inquiry_entry *e;
Johan Hedberg561aafb2012-01-04 13:31:59 +02002519 int err;
2520
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002521 BT_DBG("%s", hdev->name);
Johan Hedberg561aafb2012-01-04 13:31:59 +02002522
Johan Hedberg561aafb2012-01-04 13:31:59 +02002523 hci_dev_lock(hdev);
2524
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002525 if (!hci_discovery_active(hdev)) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002526 err = cmd_status(sk, hdev->id, MGMT_OP_CONFIRM_NAME,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002527 MGMT_STATUS_FAILED);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002528 goto failed;
2529 }
2530
Johan Hedberga198e7b2012-02-17 14:27:06 +02002531 e = hci_inquiry_cache_lookup_unknown(hdev, &cp->addr.bdaddr);
Johan Hedberg561aafb2012-01-04 13:31:59 +02002532 if (!e) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002533 err = cmd_status(sk, hdev->id, MGMT_OP_CONFIRM_NAME,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002534 MGMT_STATUS_INVALID_PARAMS);
Johan Hedberg561aafb2012-01-04 13:31:59 +02002535 goto failed;
2536 }
2537
2538 if (cp->name_known) {
2539 e->name_state = NAME_KNOWN;
2540 list_del(&e->list);
2541 } else {
2542 e->name_state = NAME_NEEDED;
Johan Hedberga3d4e202012-01-09 00:53:02 +02002543 hci_inquiry_cache_update_resolve(hdev, e);
Johan Hedberg561aafb2012-01-04 13:31:59 +02002544 }
2545
Johan Hedberge3846622013-01-09 15:29:33 +02002546 err = cmd_complete(sk, hdev->id, MGMT_OP_CONFIRM_NAME, 0, &cp->addr,
2547 sizeof(cp->addr));
Johan Hedberg561aafb2012-01-04 13:31:59 +02002548
2549failed:
2550 hci_dev_unlock(hdev);
Johan Hedberg561aafb2012-01-04 13:31:59 +02002551 return err;
2552}
2553
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002554static int block_device(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002555 u16 len)
Antti Julku7fbec222011-06-15 12:01:15 +03002556{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002557 struct mgmt_cp_block_device *cp = data;
Johan Hedbergf0eeea82012-02-19 12:58:54 +02002558 u8 status;
Antti Julku7fbec222011-06-15 12:01:15 +03002559 int err;
2560
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002561 BT_DBG("%s", hdev->name);
Antti Julku7fbec222011-06-15 12:01:15 +03002562
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002563 hci_dev_lock(hdev);
Antti Julku5e762442011-08-25 16:48:02 +03002564
Johan Hedberg88c1fe42012-02-09 15:56:11 +02002565 err = hci_blacklist_add(hdev, &cp->addr.bdaddr, cp->addr.type);
Antti Julku7fbec222011-06-15 12:01:15 +03002566 if (err < 0)
Johan Hedbergf0eeea82012-02-19 12:58:54 +02002567 status = MGMT_STATUS_FAILED;
Antti Julku7fbec222011-06-15 12:01:15 +03002568 else
Szymon Janca6785be2012-12-13 15:11:21 +01002569 status = MGMT_STATUS_SUCCESS;
Johan Hedbergf0eeea82012-02-19 12:58:54 +02002570
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002571 err = cmd_complete(sk, hdev->id, MGMT_OP_BLOCK_DEVICE, status,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002572 &cp->addr, sizeof(cp->addr));
Antti Julku5e762442011-08-25 16:48:02 +03002573
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002574 hci_dev_unlock(hdev);
Antti Julku7fbec222011-06-15 12:01:15 +03002575
2576 return err;
2577}
2578
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002579static int unblock_device(struct sock *sk, struct hci_dev *hdev, void *data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002580 u16 len)
Antti Julku7fbec222011-06-15 12:01:15 +03002581{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002582 struct mgmt_cp_unblock_device *cp = data;
Johan Hedbergf0eeea82012-02-19 12:58:54 +02002583 u8 status;
Antti Julku7fbec222011-06-15 12:01:15 +03002584 int err;
2585
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002586 BT_DBG("%s", hdev->name);
Antti Julku7fbec222011-06-15 12:01:15 +03002587
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002588 hci_dev_lock(hdev);
Antti Julku5e762442011-08-25 16:48:02 +03002589
Johan Hedberg88c1fe42012-02-09 15:56:11 +02002590 err = hci_blacklist_del(hdev, &cp->addr.bdaddr, cp->addr.type);
Antti Julku7fbec222011-06-15 12:01:15 +03002591 if (err < 0)
Johan Hedbergf0eeea82012-02-19 12:58:54 +02002592 status = MGMT_STATUS_INVALID_PARAMS;
Antti Julku7fbec222011-06-15 12:01:15 +03002593 else
Szymon Janca6785be2012-12-13 15:11:21 +01002594 status = MGMT_STATUS_SUCCESS;
Johan Hedbergf0eeea82012-02-19 12:58:54 +02002595
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002596 err = cmd_complete(sk, hdev->id, MGMT_OP_UNBLOCK_DEVICE, status,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002597 &cp->addr, sizeof(cp->addr));
Antti Julku5e762442011-08-25 16:48:02 +03002598
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03002599 hci_dev_unlock(hdev);
Antti Julku7fbec222011-06-15 12:01:15 +03002600
2601 return err;
2602}
2603
Marcel Holtmanncdbaccc2012-03-11 20:00:29 -07002604static int set_device_id(struct sock *sk, struct hci_dev *hdev, void *data,
2605 u16 len)
2606{
2607 struct mgmt_cp_set_device_id *cp = data;
2608 int err;
Szymon Jancc72d4b82012-03-16 16:02:57 +01002609 __u16 source;
Marcel Holtmanncdbaccc2012-03-11 20:00:29 -07002610
2611 BT_DBG("%s", hdev->name);
2612
Szymon Jancc72d4b82012-03-16 16:02:57 +01002613 source = __le16_to_cpu(cp->source);
2614
2615 if (source > 0x0002)
2616 return cmd_status(sk, hdev->id, MGMT_OP_SET_DEVICE_ID,
2617 MGMT_STATUS_INVALID_PARAMS);
2618
Marcel Holtmanncdbaccc2012-03-11 20:00:29 -07002619 hci_dev_lock(hdev);
2620
Szymon Jancc72d4b82012-03-16 16:02:57 +01002621 hdev->devid_source = source;
Marcel Holtmanncdbaccc2012-03-11 20:00:29 -07002622 hdev->devid_vendor = __le16_to_cpu(cp->vendor);
2623 hdev->devid_product = __le16_to_cpu(cp->product);
2624 hdev->devid_version = __le16_to_cpu(cp->version);
2625
2626 err = cmd_complete(sk, hdev->id, MGMT_OP_SET_DEVICE_ID, 0, NULL, 0);
2627
2628 update_eir(hdev);
2629
2630 hci_dev_unlock(hdev);
2631
2632 return err;
2633}
2634
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002635static int set_fast_connectable(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002636 void *data, u16 len)
Antti Julkuf6422ec2011-06-22 13:11:56 +03002637{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002638 struct mgmt_mode *cp = data;
Antti Julkuf6422ec2011-06-22 13:11:56 +03002639 struct hci_cp_write_page_scan_activity acp;
2640 u8 type;
2641 int err;
2642
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002643 BT_DBG("%s", hdev->name);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002644
Johan Hedberg33c525c2012-10-24 21:11:58 +03002645 if (!lmp_bredr_capable(hdev))
2646 return cmd_status(sk, hdev->id, MGMT_OP_SET_FAST_CONNECTABLE,
2647 MGMT_STATUS_NOT_SUPPORTED);
2648
Johan Hedberga7e80f22013-01-09 16:05:19 +02002649 if (cp->val != 0x00 && cp->val != 0x01)
2650 return cmd_status(sk, hdev->id, MGMT_OP_SET_FAST_CONNECTABLE,
2651 MGMT_STATUS_INVALID_PARAMS);
2652
Johan Hedberg5400c042012-02-21 16:40:33 +02002653 if (!hdev_is_powered(hdev))
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002654 return cmd_status(sk, hdev->id, MGMT_OP_SET_FAST_CONNECTABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002655 MGMT_STATUS_NOT_POWERED);
Johan Hedberg5400c042012-02-21 16:40:33 +02002656
2657 if (!test_bit(HCI_CONNECTABLE, &hdev->dev_flags))
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002658 return cmd_status(sk, hdev->id, MGMT_OP_SET_FAST_CONNECTABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002659 MGMT_STATUS_REJECTED);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002660
2661 hci_dev_lock(hdev);
2662
Johan Hedbergf7c6869ce2011-12-15 00:47:36 +02002663 if (cp->val) {
Antti Julkuf6422ec2011-06-22 13:11:56 +03002664 type = PAGE_SCAN_TYPE_INTERLACED;
Andrei Emeltchenko76ec9de2012-03-12 12:13:11 +02002665
Johan Hedberg83ce9a062012-06-28 13:44:30 +03002666 /* 160 msec page scan interval */
2667 acp.interval = __constant_cpu_to_le16(0x0100);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002668 } else {
2669 type = PAGE_SCAN_TYPE_STANDARD; /* default */
Andrei Emeltchenko76ec9de2012-03-12 12:13:11 +02002670
2671 /* default 1.28 sec page scan */
2672 acp.interval = __constant_cpu_to_le16(0x0800);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002673 }
2674
Andrei Emeltchenko76ec9de2012-03-12 12:13:11 +02002675 /* default 11.25 msec page scan window */
2676 acp.window = __constant_cpu_to_le16(0x0012);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002677
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002678 err = hci_send_cmd(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY, sizeof(acp),
2679 &acp);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002680 if (err < 0) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002681 err = cmd_status(sk, hdev->id, MGMT_OP_SET_FAST_CONNECTABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002682 MGMT_STATUS_FAILED);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002683 goto done;
2684 }
2685
2686 err = hci_send_cmd(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE, 1, &type);
2687 if (err < 0) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002688 err = cmd_status(sk, hdev->id, MGMT_OP_SET_FAST_CONNECTABLE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002689 MGMT_STATUS_FAILED);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002690 goto done;
2691 }
2692
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002693 err = cmd_complete(sk, hdev->id, MGMT_OP_SET_FAST_CONNECTABLE, 0,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002694 NULL, 0);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002695done:
2696 hci_dev_unlock(hdev);
Antti Julkuf6422ec2011-06-22 13:11:56 +03002697 return err;
2698}
2699
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002700static int load_long_term_keys(struct sock *sk, struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002701 void *cp_data, u16 len)
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002702{
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002703 struct mgmt_cp_load_long_term_keys *cp = cp_data;
2704 u16 key_count, expected_len;
Johan Hedberg715a5bf2013-01-09 15:29:34 +02002705 int i, err;
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002706
Marcel Holtmann1f350c82012-03-12 20:31:08 -07002707 key_count = __le16_to_cpu(cp->key_count);
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002708
2709 expected_len = sizeof(*cp) + key_count *
2710 sizeof(struct mgmt_ltk_info);
2711 if (expected_len != len) {
2712 BT_ERR("load_keys: expected %u bytes, got %u bytes",
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03002713 len, expected_len);
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002714 return cmd_status(sk, hdev->id, MGMT_OP_LOAD_LONG_TERM_KEYS,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002715 EINVAL);
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002716 }
2717
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002718 BT_DBG("%s key_count %u", hdev->name, key_count);
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002719
2720 hci_dev_lock(hdev);
2721
2722 hci_smp_ltks_clear(hdev);
2723
2724 for (i = 0; i < key_count; i++) {
2725 struct mgmt_ltk_info *key = &cp->keys[i];
2726 u8 type;
2727
2728 if (key->master)
2729 type = HCI_SMP_LTK;
2730 else
2731 type = HCI_SMP_LTK_SLAVE;
2732
Hemant Gupta4596fde2012-04-16 14:57:40 +05302733 hci_add_ltk(hdev, &key->addr.bdaddr,
Andre Guedes378b5b72012-04-24 21:02:51 -03002734 bdaddr_to_le(key->addr.type),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002735 type, 0, key->authenticated, key->val,
2736 key->enc_size, key->ediv, key->rand);
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002737 }
2738
Johan Hedberg715a5bf2013-01-09 15:29:34 +02002739 err = cmd_complete(sk, hdev->id, MGMT_OP_LOAD_LONG_TERM_KEYS, 0,
2740 NULL, 0);
2741
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002742 hci_dev_unlock(hdev);
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002743
Johan Hedberg715a5bf2013-01-09 15:29:34 +02002744 return err;
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03002745}
2746
Andrei Emeltchenko2e3c35e2012-03-14 18:54:15 +02002747static const struct mgmt_handler {
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002748 int (*func) (struct sock *sk, struct hci_dev *hdev, void *data,
2749 u16 data_len);
Johan Hedbergbe22b542012-03-01 22:24:41 +02002750 bool var_len;
2751 size_t data_len;
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002752} mgmt_handlers[] = {
2753 { NULL }, /* 0x0000 (no command) */
Johan Hedbergbe22b542012-03-01 22:24:41 +02002754 { read_version, false, MGMT_READ_VERSION_SIZE },
2755 { read_commands, false, MGMT_READ_COMMANDS_SIZE },
2756 { read_index_list, false, MGMT_READ_INDEX_LIST_SIZE },
2757 { read_controller_info, false, MGMT_READ_INFO_SIZE },
2758 { set_powered, false, MGMT_SETTING_SIZE },
2759 { set_discoverable, false, MGMT_SET_DISCOVERABLE_SIZE },
2760 { set_connectable, false, MGMT_SETTING_SIZE },
2761 { set_fast_connectable, false, MGMT_SETTING_SIZE },
2762 { set_pairable, false, MGMT_SETTING_SIZE },
2763 { set_link_security, false, MGMT_SETTING_SIZE },
2764 { set_ssp, false, MGMT_SETTING_SIZE },
2765 { set_hs, false, MGMT_SETTING_SIZE },
2766 { set_le, false, MGMT_SETTING_SIZE },
2767 { set_dev_class, false, MGMT_SET_DEV_CLASS_SIZE },
2768 { set_local_name, false, MGMT_SET_LOCAL_NAME_SIZE },
2769 { add_uuid, false, MGMT_ADD_UUID_SIZE },
2770 { remove_uuid, false, MGMT_REMOVE_UUID_SIZE },
2771 { load_link_keys, true, MGMT_LOAD_LINK_KEYS_SIZE },
2772 { load_long_term_keys, true, MGMT_LOAD_LONG_TERM_KEYS_SIZE },
2773 { disconnect, false, MGMT_DISCONNECT_SIZE },
2774 { get_connections, false, MGMT_GET_CONNECTIONS_SIZE },
2775 { pin_code_reply, false, MGMT_PIN_CODE_REPLY_SIZE },
2776 { pin_code_neg_reply, false, MGMT_PIN_CODE_NEG_REPLY_SIZE },
2777 { set_io_capability, false, MGMT_SET_IO_CAPABILITY_SIZE },
2778 { pair_device, false, MGMT_PAIR_DEVICE_SIZE },
2779 { cancel_pair_device, false, MGMT_CANCEL_PAIR_DEVICE_SIZE },
2780 { unpair_device, false, MGMT_UNPAIR_DEVICE_SIZE },
2781 { user_confirm_reply, false, MGMT_USER_CONFIRM_REPLY_SIZE },
2782 { user_confirm_neg_reply, false, MGMT_USER_CONFIRM_NEG_REPLY_SIZE },
2783 { user_passkey_reply, false, MGMT_USER_PASSKEY_REPLY_SIZE },
2784 { user_passkey_neg_reply, false, MGMT_USER_PASSKEY_NEG_REPLY_SIZE },
2785 { read_local_oob_data, false, MGMT_READ_LOCAL_OOB_DATA_SIZE },
2786 { add_remote_oob_data, false, MGMT_ADD_REMOTE_OOB_DATA_SIZE },
2787 { remove_remote_oob_data, false, MGMT_REMOVE_REMOTE_OOB_DATA_SIZE },
2788 { start_discovery, false, MGMT_START_DISCOVERY_SIZE },
2789 { stop_discovery, false, MGMT_STOP_DISCOVERY_SIZE },
2790 { confirm_name, false, MGMT_CONFIRM_NAME_SIZE },
2791 { block_device, false, MGMT_BLOCK_DEVICE_SIZE },
2792 { unblock_device, false, MGMT_UNBLOCK_DEVICE_SIZE },
Marcel Holtmanncdbaccc2012-03-11 20:00:29 -07002793 { set_device_id, false, MGMT_SET_DEVICE_ID_SIZE },
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002794};
2795
2796
Johan Hedberg03811012010-12-08 00:21:06 +02002797int mgmt_control(struct sock *sk, struct msghdr *msg, size_t msglen)
2798{
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002799 void *buf;
2800 u8 *cp;
Johan Hedberg03811012010-12-08 00:21:06 +02002801 struct mgmt_hdr *hdr;
Szymon Janc4e51eae2011-02-25 19:05:48 +01002802 u16 opcode, index, len;
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002803 struct hci_dev *hdev = NULL;
Andrei Emeltchenko2e3c35e2012-03-14 18:54:15 +02002804 const struct mgmt_handler *handler;
Johan Hedberg03811012010-12-08 00:21:06 +02002805 int err;
2806
2807 BT_DBG("got %zu bytes", msglen);
2808
2809 if (msglen < sizeof(*hdr))
2810 return -EINVAL;
2811
Gustavo F. Padovane63a15e2011-04-04 18:56:53 -03002812 buf = kmalloc(msglen, GFP_KERNEL);
Johan Hedberg03811012010-12-08 00:21:06 +02002813 if (!buf)
2814 return -ENOMEM;
2815
2816 if (memcpy_fromiovec(buf, msg->msg_iov, msglen)) {
2817 err = -EFAULT;
2818 goto done;
2819 }
2820
Vinicius Costa Gomes650f7262012-02-02 21:07:59 -03002821 hdr = buf;
Marcel Holtmann1f350c82012-03-12 20:31:08 -07002822 opcode = __le16_to_cpu(hdr->opcode);
2823 index = __le16_to_cpu(hdr->index);
2824 len = __le16_to_cpu(hdr->len);
Johan Hedberg03811012010-12-08 00:21:06 +02002825
2826 if (len != msglen - sizeof(*hdr)) {
2827 err = -EINVAL;
2828 goto done;
2829 }
2830
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002831 if (index != MGMT_INDEX_NONE) {
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002832 hdev = hci_dev_get(index);
2833 if (!hdev) {
2834 err = cmd_status(sk, index, opcode,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002835 MGMT_STATUS_INVALID_INDEX);
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002836 goto done;
2837 }
2838 }
2839
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002840 if (opcode >= ARRAY_SIZE(mgmt_handlers) ||
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03002841 mgmt_handlers[opcode].func == NULL) {
Johan Hedberg03811012010-12-08 00:21:06 +02002842 BT_DBG("Unknown op %u", opcode);
Johan Hedbergca69b792011-11-11 18:10:00 +02002843 err = cmd_status(sk, index, opcode,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002844 MGMT_STATUS_UNKNOWN_COMMAND);
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002845 goto done;
Johan Hedberg03811012010-12-08 00:21:06 +02002846 }
2847
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002848 if ((hdev && opcode < MGMT_OP_READ_INFO) ||
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03002849 (!hdev && opcode >= MGMT_OP_READ_INFO)) {
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002850 err = cmd_status(sk, index, opcode,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002851 MGMT_STATUS_INVALID_INDEX);
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002852 goto done;
2853 }
2854
Johan Hedbergbe22b542012-03-01 22:24:41 +02002855 handler = &mgmt_handlers[opcode];
2856
2857 if ((handler->var_len && len < handler->data_len) ||
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03002858 (!handler->var_len && len != handler->data_len)) {
Johan Hedbergbe22b542012-03-01 22:24:41 +02002859 err = cmd_status(sk, index, opcode,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002860 MGMT_STATUS_INVALID_PARAMS);
Johan Hedbergbe22b542012-03-01 22:24:41 +02002861 goto done;
2862 }
2863
Johan Hedberg0f4e68c2012-02-28 17:18:30 +02002864 if (hdev)
2865 mgmt_init_hdev(sk, hdev);
2866
2867 cp = buf + sizeof(*hdr);
2868
Johan Hedbergbe22b542012-03-01 22:24:41 +02002869 err = handler->func(sk, hdev, cp, len);
Johan Hedberge41d8b42010-12-13 21:07:03 +02002870 if (err < 0)
2871 goto done;
2872
Johan Hedberg03811012010-12-08 00:21:06 +02002873 err = msglen;
2874
2875done:
Johan Hedbergbdb6d972012-02-28 06:13:32 +02002876 if (hdev)
2877 hci_dev_put(hdev);
2878
Johan Hedberg03811012010-12-08 00:21:06 +02002879 kfree(buf);
2880 return err;
2881}
Johan Hedbergc71e97b2010-12-13 21:07:07 +02002882
Johan Hedbergb24752f2011-11-03 14:40:33 +02002883static void cmd_status_rsp(struct pending_cmd *cmd, void *data)
2884{
2885 u8 *status = data;
2886
2887 cmd_status(cmd->sk, cmd->index, cmd->opcode, *status);
2888 mgmt_pending_remove(cmd);
2889}
2890
Johan Hedberg744cf192011-11-08 20:40:14 +02002891int mgmt_index_added(struct hci_dev *hdev)
Johan Hedbergc71e97b2010-12-13 21:07:07 +02002892{
Andrei Emeltchenkobb4b2a92012-07-19 17:03:40 +03002893 if (!mgmt_valid_hdev(hdev))
2894 return -ENOTSUPP;
2895
Johan Hedberg744cf192011-11-08 20:40:14 +02002896 return mgmt_event(MGMT_EV_INDEX_ADDED, hdev, NULL, 0, NULL);
Johan Hedbergc71e97b2010-12-13 21:07:07 +02002897}
2898
Johan Hedberg744cf192011-11-08 20:40:14 +02002899int mgmt_index_removed(struct hci_dev *hdev)
Johan Hedbergc71e97b2010-12-13 21:07:07 +02002900{
Johan Hedberg5f159032012-03-02 03:13:19 +02002901 u8 status = MGMT_STATUS_INVALID_INDEX;
Johan Hedbergb24752f2011-11-03 14:40:33 +02002902
Andrei Emeltchenkobb4b2a92012-07-19 17:03:40 +03002903 if (!mgmt_valid_hdev(hdev))
2904 return -ENOTSUPP;
2905
Johan Hedberg744cf192011-11-08 20:40:14 +02002906 mgmt_pending_foreach(0, hdev, cmd_status_rsp, &status);
Johan Hedbergb24752f2011-11-03 14:40:33 +02002907
Johan Hedberg744cf192011-11-08 20:40:14 +02002908 return mgmt_event(MGMT_EV_INDEX_REMOVED, hdev, NULL, 0, NULL);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02002909}
2910
Johan Hedberg73f22f62010-12-29 16:00:25 +02002911struct cmd_lookup {
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02002912 struct sock *sk;
Johan Hedberg69ab39e2011-12-15 00:47:35 +02002913 struct hci_dev *hdev;
Johan Hedberg90e70452012-02-23 23:09:40 +02002914 u8 mgmt_status;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02002915};
2916
Johan Hedberg69ab39e2011-12-15 00:47:35 +02002917static void settings_rsp(struct pending_cmd *cmd, void *data)
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02002918{
Johan Hedberg73f22f62010-12-29 16:00:25 +02002919 struct cmd_lookup *match = data;
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02002920
Johan Hedberg69ab39e2011-12-15 00:47:35 +02002921 send_settings_rsp(cmd->sk, cmd->opcode, match->hdev);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02002922
2923 list_del(&cmd->list);
2924
2925 if (match->sk == NULL) {
2926 match->sk = cmd->sk;
2927 sock_hold(match->sk);
2928 }
2929
2930 mgmt_pending_free(cmd);
Johan Hedbergc71e97b2010-12-13 21:07:07 +02002931}
Johan Hedberg5add6af2010-12-16 10:00:37 +02002932
Johan Hedberg7f0ae642012-10-24 21:11:57 +03002933static int set_bredr_scan(struct hci_dev *hdev)
2934{
2935 u8 scan = 0;
2936
2937 if (test_bit(HCI_CONNECTABLE, &hdev->dev_flags))
2938 scan |= SCAN_PAGE;
2939 if (test_bit(HCI_DISCOVERABLE, &hdev->dev_flags))
2940 scan |= SCAN_INQUIRY;
2941
2942 if (!scan)
2943 return 0;
2944
2945 return hci_send_cmd(hdev, HCI_OP_WRITE_SCAN_ENABLE, 1, &scan);
2946}
2947
Johan Hedberg744cf192011-11-08 20:40:14 +02002948int mgmt_powered(struct hci_dev *hdev, u8 powered)
Johan Hedberg5add6af2010-12-16 10:00:37 +02002949{
Johan Hedberg76a7f3a2012-02-17 00:34:40 +02002950 struct cmd_lookup match = { NULL, hdev };
Johan Hedberg7bb895d2012-02-17 01:20:00 +02002951 int err;
Johan Hedberg5add6af2010-12-16 10:00:37 +02002952
Johan Hedberg5e5282b2012-02-21 16:01:30 +02002953 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
2954 return 0;
2955
Johan Hedberg69ab39e2011-12-15 00:47:35 +02002956 mgmt_pending_foreach(MGMT_OP_SET_POWERED, hdev, settings_rsp, &match);
Johan Hedberg5add6af2010-12-16 10:00:37 +02002957
Johan Hedberg5e5282b2012-02-21 16:01:30 +02002958 if (powered) {
Johan Hedberg6b4b73e2012-10-25 00:09:52 +03002959 if (test_bit(HCI_SSP_ENABLED, &hdev->dev_flags) &&
2960 !lmp_host_ssp_capable(hdev)) {
Andrzej Kaczmarek3d1cbdd2012-08-29 10:02:08 +02002961 u8 ssp = 1;
2962
2963 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, 1, &ssp);
2964 }
2965
Andrzej Kaczmarek562fcc22012-08-29 10:02:09 +02002966 if (test_bit(HCI_LE_ENABLED, &hdev->dev_flags)) {
2967 struct hci_cp_write_le_host_supported cp;
2968
2969 cp.le = 1;
Gustavo Padovanffa88e02012-11-23 16:50:51 -02002970 cp.simul = lmp_le_br_capable(hdev);
Andrzej Kaczmarek562fcc22012-08-29 10:02:09 +02002971
Johan Hedberg430a61b2012-10-25 00:09:53 +03002972 /* Check first if we already have the right
2973 * host state (host features set)
2974 */
Gustavo Padovanffa88e02012-11-23 16:50:51 -02002975 if (cp.le != lmp_host_le_capable(hdev) ||
2976 cp.simul != lmp_host_le_br_capable(hdev))
Johan Hedberg430a61b2012-10-25 00:09:53 +03002977 hci_send_cmd(hdev,
2978 HCI_OP_WRITE_LE_HOST_SUPPORTED,
2979 sizeof(cp), &cp);
Andrzej Kaczmarek562fcc22012-08-29 10:02:09 +02002980 }
2981
Johan Hedberg7f0ae642012-10-24 21:11:57 +03002982 if (lmp_bredr_capable(hdev)) {
2983 set_bredr_scan(hdev);
2984 update_class(hdev);
2985 update_name(hdev, hdev->dev_name);
2986 update_eir(hdev);
2987 }
Johan Hedberg5e5282b2012-02-21 16:01:30 +02002988 } else {
Johan Hedbergd4f68522012-03-02 03:07:07 +02002989 u8 status = MGMT_STATUS_NOT_POWERED;
Johan Hedbergfe038882013-01-16 16:15:34 +02002990 u8 zero_cod[] = { 0, 0, 0 };
2991
Johan Hedberg744cf192011-11-08 20:40:14 +02002992 mgmt_pending_foreach(0, hdev, cmd_status_rsp, &status);
Johan Hedbergfe038882013-01-16 16:15:34 +02002993
2994 if (memcmp(hdev->dev_class, zero_cod, sizeof(zero_cod)) != 0)
2995 mgmt_event(MGMT_EV_CLASS_OF_DEV_CHANGED, hdev,
2996 zero_cod, sizeof(zero_cod), NULL);
Johan Hedbergb24752f2011-11-03 14:40:33 +02002997 }
2998
Johan Hedbergbeadb2b2012-02-21 16:55:31 +02002999 err = new_settings(hdev, match.sk);
Johan Hedbergeec8d2b2010-12-16 10:17:38 +02003000
3001 if (match.sk)
3002 sock_put(match.sk);
3003
Johan Hedberg7bb895d2012-02-17 01:20:00 +02003004 return err;
Johan Hedberg5add6af2010-12-16 10:00:37 +02003005}
Johan Hedberg73f22f62010-12-29 16:00:25 +02003006
Johan Hedberg744cf192011-11-08 20:40:14 +02003007int mgmt_discoverable(struct hci_dev *hdev, u8 discoverable)
Johan Hedberg73f22f62010-12-29 16:00:25 +02003008{
Johan Hedberg76a7f3a2012-02-17 00:34:40 +02003009 struct cmd_lookup match = { NULL, hdev };
Johan Hedberg5e5282b2012-02-21 16:01:30 +02003010 bool changed = false;
3011 int err = 0;
Johan Hedberg73f22f62010-12-29 16:00:25 +02003012
Johan Hedberg5e5282b2012-02-21 16:01:30 +02003013 if (discoverable) {
3014 if (!test_and_set_bit(HCI_DISCOVERABLE, &hdev->dev_flags))
3015 changed = true;
3016 } else {
3017 if (test_and_clear_bit(HCI_DISCOVERABLE, &hdev->dev_flags))
3018 changed = true;
3019 }
Johan Hedberg73f22f62010-12-29 16:00:25 +02003020
Johan Hedberged9b5f22012-02-21 20:47:06 +02003021 mgmt_pending_foreach(MGMT_OP_SET_DISCOVERABLE, hdev, settings_rsp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003022 &match);
Johan Hedberged9b5f22012-02-21 20:47:06 +02003023
Johan Hedbergbeadb2b2012-02-21 16:55:31 +02003024 if (changed)
3025 err = new_settings(hdev, match.sk);
Johan Hedberg5e5282b2012-02-21 16:01:30 +02003026
Johan Hedberg73f22f62010-12-29 16:00:25 +02003027 if (match.sk)
3028 sock_put(match.sk);
3029
Johan Hedberg7bb895d2012-02-17 01:20:00 +02003030 return err;
Johan Hedberg73f22f62010-12-29 16:00:25 +02003031}
Johan Hedberg9fbcbb42010-12-30 00:18:33 +02003032
Johan Hedberg744cf192011-11-08 20:40:14 +02003033int mgmt_connectable(struct hci_dev *hdev, u8 connectable)
Johan Hedberg9fbcbb42010-12-30 00:18:33 +02003034{
Johan Hedberg76a7f3a2012-02-17 00:34:40 +02003035 struct cmd_lookup match = { NULL, hdev };
Johan Hedberg5e5282b2012-02-21 16:01:30 +02003036 bool changed = false;
3037 int err = 0;
Johan Hedberg9fbcbb42010-12-30 00:18:33 +02003038
Johan Hedberg5e5282b2012-02-21 16:01:30 +02003039 if (connectable) {
3040 if (!test_and_set_bit(HCI_CONNECTABLE, &hdev->dev_flags))
3041 changed = true;
3042 } else {
3043 if (test_and_clear_bit(HCI_CONNECTABLE, &hdev->dev_flags))
3044 changed = true;
3045 }
Johan Hedberg9fbcbb42010-12-30 00:18:33 +02003046
Johan Hedberged9b5f22012-02-21 20:47:06 +02003047 mgmt_pending_foreach(MGMT_OP_SET_CONNECTABLE, hdev, settings_rsp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003048 &match);
Johan Hedberged9b5f22012-02-21 20:47:06 +02003049
Johan Hedbergbeadb2b2012-02-21 16:55:31 +02003050 if (changed)
3051 err = new_settings(hdev, match.sk);
Johan Hedberg9fbcbb42010-12-30 00:18:33 +02003052
3053 if (match.sk)
3054 sock_put(match.sk);
3055
Johan Hedberg7bb895d2012-02-17 01:20:00 +02003056 return err;
Johan Hedberg9fbcbb42010-12-30 00:18:33 +02003057}
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003058
Johan Hedberg744cf192011-11-08 20:40:14 +02003059int mgmt_write_scan_failed(struct hci_dev *hdev, u8 scan, u8 status)
Johan Hedberg2d7cee52011-11-07 22:16:03 +02003060{
Johan Hedbergca69b792011-11-11 18:10:00 +02003061 u8 mgmt_err = mgmt_status(status);
3062
Johan Hedberg2d7cee52011-11-07 22:16:03 +02003063 if (scan & SCAN_PAGE)
Johan Hedberg744cf192011-11-08 20:40:14 +02003064 mgmt_pending_foreach(MGMT_OP_SET_CONNECTABLE, hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003065 cmd_status_rsp, &mgmt_err);
Johan Hedberg2d7cee52011-11-07 22:16:03 +02003066
3067 if (scan & SCAN_INQUIRY)
Johan Hedberg744cf192011-11-08 20:40:14 +02003068 mgmt_pending_foreach(MGMT_OP_SET_DISCOVERABLE, hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003069 cmd_status_rsp, &mgmt_err);
Johan Hedberg2d7cee52011-11-07 22:16:03 +02003070
3071 return 0;
3072}
3073
Cristian Chilipirea53168e52012-05-09 08:44:52 +03003074int mgmt_new_link_key(struct hci_dev *hdev, struct link_key *key,
3075 bool persistent)
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003076{
Johan Hedberg86742e12011-11-07 23:13:38 +02003077 struct mgmt_ev_new_link_key ev;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003078
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03003079 memset(&ev, 0, sizeof(ev));
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003080
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03003081 ev.store_hint = persistent;
Johan Hedbergd753fdc2012-02-17 14:06:34 +02003082 bacpy(&ev.key.addr.bdaddr, &key->bdaddr);
Andre Guedes591f47f2012-04-24 21:02:49 -03003083 ev.key.addr.type = BDADDR_BREDR;
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03003084 ev.key.type = key->type;
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03003085 memcpy(ev.key.val, key->val, HCI_LINK_KEY_SIZE);
Vinicius Costa Gomesa492cd52011-08-25 20:02:29 -03003086 ev.key.pin_len = key->pin_len;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003087
Johan Hedberg744cf192011-11-08 20:40:14 +02003088 return mgmt_event(MGMT_EV_NEW_LINK_KEY, hdev, &ev, sizeof(ev), NULL);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003089}
Johan Hedbergf7520542011-01-20 12:34:39 +02003090
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03003091int mgmt_new_ltk(struct hci_dev *hdev, struct smp_ltk *key, u8 persistent)
3092{
3093 struct mgmt_ev_new_long_term_key ev;
3094
3095 memset(&ev, 0, sizeof(ev));
3096
3097 ev.store_hint = persistent;
3098 bacpy(&ev.key.addr.bdaddr, &key->bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003099 ev.key.addr.type = link_to_bdaddr(LE_LINK, key->bdaddr_type);
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03003100 ev.key.authenticated = key->authenticated;
3101 ev.key.enc_size = key->enc_size;
3102 ev.key.ediv = key->ediv;
3103
3104 if (key->type == HCI_SMP_LTK)
3105 ev.key.master = 1;
3106
3107 memcpy(ev.key.rand, key->rand, sizeof(key->rand));
3108 memcpy(ev.key.val, key->val, sizeof(key->val));
3109
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003110 return mgmt_event(MGMT_EV_NEW_LONG_TERM_KEY, hdev, &ev, sizeof(ev),
3111 NULL);
Vinicius Costa Gomes346af672012-02-02 21:08:02 -03003112}
3113
Johan Hedbergafc747a2012-01-15 18:11:07 +02003114int mgmt_device_connected(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 link_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003115 u8 addr_type, u32 flags, u8 *name, u8 name_len,
3116 u8 *dev_class)
Johan Hedbergf7520542011-01-20 12:34:39 +02003117{
Johan Hedbergb644ba32012-01-17 21:48:47 +02003118 char buf[512];
3119 struct mgmt_ev_device_connected *ev = (void *) buf;
3120 u16 eir_len = 0;
Johan Hedbergf7520542011-01-20 12:34:39 +02003121
Johan Hedbergb644ba32012-01-17 21:48:47 +02003122 bacpy(&ev->addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003123 ev->addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedbergf7520542011-01-20 12:34:39 +02003124
Johan Hedbergc95f0ba2012-02-23 22:54:38 +02003125 ev->flags = __cpu_to_le32(flags);
Johan Hedberg08c79b62012-02-23 22:31:51 +02003126
Johan Hedbergb644ba32012-01-17 21:48:47 +02003127 if (name_len > 0)
3128 eir_len = eir_append_data(ev->eir, 0, EIR_NAME_COMPLETE,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003129 name, name_len);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003130
3131 if (dev_class && memcmp(dev_class, "\0\0\0", 3) != 0)
Brian Gix53156382012-03-09 14:07:03 -08003132 eir_len = eir_append_data(ev->eir, eir_len,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003133 EIR_CLASS_OF_DEV, dev_class, 3);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003134
Marcel Holtmanneb55ef02012-03-14 18:08:46 +02003135 ev->eir_len = cpu_to_le16(eir_len);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003136
3137 return mgmt_event(MGMT_EV_DEVICE_CONNECTED, hdev, buf,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003138 sizeof(*ev) + eir_len, NULL);
Johan Hedbergf7520542011-01-20 12:34:39 +02003139}
3140
Johan Hedberg8962ee72011-01-20 12:40:27 +02003141static void disconnect_rsp(struct pending_cmd *cmd, void *data)
3142{
Szymon Jancc68fb7f2011-03-22 13:12:19 +01003143 struct mgmt_cp_disconnect *cp = cmd->param;
Johan Hedberg8962ee72011-01-20 12:40:27 +02003144 struct sock **sk = data;
Johan Hedberga38528f2011-01-22 06:46:43 +02003145 struct mgmt_rp_disconnect rp;
Johan Hedberg8962ee72011-01-20 12:40:27 +02003146
Johan Hedberg88c3df12012-02-09 14:27:38 +02003147 bacpy(&rp.addr.bdaddr, &cp->addr.bdaddr);
3148 rp.addr.type = cp->addr.type;
Johan Hedberg8962ee72011-01-20 12:40:27 +02003149
Johan Hedbergaee9b212012-02-18 15:07:59 +02003150 cmd_complete(cmd->sk, cmd->index, MGMT_OP_DISCONNECT, 0, &rp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003151 sizeof(rp));
Johan Hedberg8962ee72011-01-20 12:40:27 +02003152
3153 *sk = cmd->sk;
3154 sock_hold(*sk);
3155
Johan Hedberga664b5b2011-02-19 12:06:02 -03003156 mgmt_pending_remove(cmd);
Johan Hedberg8962ee72011-01-20 12:40:27 +02003157}
3158
Johan Hedberg124f6e32012-02-09 13:50:12 +02003159static void unpair_device_rsp(struct pending_cmd *cmd, void *data)
Johan Hedberga8a1d192011-11-10 15:54:38 +02003160{
Johan Hedbergb1078ad2012-02-09 17:21:16 +02003161 struct hci_dev *hdev = data;
Johan Hedberg124f6e32012-02-09 13:50:12 +02003162 struct mgmt_cp_unpair_device *cp = cmd->param;
3163 struct mgmt_rp_unpair_device rp;
Johan Hedberga8a1d192011-11-10 15:54:38 +02003164
3165 memset(&rp, 0, sizeof(rp));
Johan Hedberg124f6e32012-02-09 13:50:12 +02003166 bacpy(&rp.addr.bdaddr, &cp->addr.bdaddr);
3167 rp.addr.type = cp->addr.type;
Johan Hedberga8a1d192011-11-10 15:54:38 +02003168
Johan Hedbergb1078ad2012-02-09 17:21:16 +02003169 device_unpaired(hdev, &cp->addr.bdaddr, cp->addr.type, cmd->sk);
3170
Johan Hedbergaee9b212012-02-18 15:07:59 +02003171 cmd_complete(cmd->sk, cmd->index, cmd->opcode, 0, &rp, sizeof(rp));
Johan Hedberga8a1d192011-11-10 15:54:38 +02003172
3173 mgmt_pending_remove(cmd);
3174}
3175
Johan Hedbergafc747a2012-01-15 18:11:07 +02003176int mgmt_device_disconnected(struct hci_dev *hdev, bdaddr_t *bdaddr,
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02003177 u8 link_type, u8 addr_type, u8 reason)
Johan Hedbergf7520542011-01-20 12:34:39 +02003178{
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02003179 struct mgmt_ev_device_disconnected ev;
Johan Hedberg8962ee72011-01-20 12:40:27 +02003180 struct sock *sk = NULL;
3181 int err;
3182
Johan Hedberg744cf192011-11-08 20:40:14 +02003183 mgmt_pending_foreach(MGMT_OP_DISCONNECT, hdev, disconnect_rsp, &sk);
Johan Hedbergf7520542011-01-20 12:34:39 +02003184
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02003185 bacpy(&ev.addr.bdaddr, bdaddr);
3186 ev.addr.type = link_to_bdaddr(link_type, addr_type);
3187 ev.reason = reason;
Johan Hedbergf7520542011-01-20 12:34:39 +02003188
Johan Hedbergafc747a2012-01-15 18:11:07 +02003189 err = mgmt_event(MGMT_EV_DEVICE_DISCONNECTED, hdev, &ev, sizeof(ev),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003190 sk);
Johan Hedberg8962ee72011-01-20 12:40:27 +02003191
3192 if (sk)
Szymon Jancd97dcb62012-03-16 16:02:56 +01003193 sock_put(sk);
Johan Hedberg8962ee72011-01-20 12:40:27 +02003194
Johan Hedberg124f6e32012-02-09 13:50:12 +02003195 mgmt_pending_foreach(MGMT_OP_UNPAIR_DEVICE, hdev, unpair_device_rsp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003196 hdev);
Johan Hedberga8a1d192011-11-10 15:54:38 +02003197
Johan Hedberg8962ee72011-01-20 12:40:27 +02003198 return err;
3199}
3200
Johan Hedberg88c3df12012-02-09 14:27:38 +02003201int mgmt_disconnect_failed(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003202 u8 link_type, u8 addr_type, u8 status)
Johan Hedberg8962ee72011-01-20 12:40:27 +02003203{
Johan Hedberg88c3df12012-02-09 14:27:38 +02003204 struct mgmt_rp_disconnect rp;
Johan Hedberg8962ee72011-01-20 12:40:27 +02003205 struct pending_cmd *cmd;
3206 int err;
3207
Jefferson Delfes36a75f12012-09-18 13:36:54 -04003208 mgmt_pending_foreach(MGMT_OP_UNPAIR_DEVICE, hdev, unpair_device_rsp,
3209 hdev);
3210
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003211 cmd = mgmt_pending_find(MGMT_OP_DISCONNECT, hdev);
Johan Hedberg8962ee72011-01-20 12:40:27 +02003212 if (!cmd)
3213 return -ENOENT;
3214
Johan Hedberg88c3df12012-02-09 14:27:38 +02003215 bacpy(&rp.addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003216 rp.addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedberg37d9ef72011-11-10 15:54:39 +02003217
Johan Hedberg88c3df12012-02-09 14:27:38 +02003218 err = cmd_complete(cmd->sk, cmd->index, MGMT_OP_DISCONNECT,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003219 mgmt_status(status), &rp, sizeof(rp));
Johan Hedberg8962ee72011-01-20 12:40:27 +02003220
Johan Hedberga664b5b2011-02-19 12:06:02 -03003221 mgmt_pending_remove(cmd);
Johan Hedberg8962ee72011-01-20 12:40:27 +02003222
3223 return err;
Johan Hedbergf7520542011-01-20 12:34:39 +02003224}
Johan Hedberg17d5c042011-01-22 06:09:08 +02003225
Johan Hedberg48264f02011-11-09 13:58:58 +02003226int mgmt_connect_failed(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 link_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003227 u8 addr_type, u8 status)
Johan Hedberg17d5c042011-01-22 06:09:08 +02003228{
3229 struct mgmt_ev_connect_failed ev;
3230
Johan Hedberg4c659c32011-11-07 23:13:39 +02003231 bacpy(&ev.addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003232 ev.addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedbergca69b792011-11-11 18:10:00 +02003233 ev.status = mgmt_status(status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02003234
Johan Hedberg744cf192011-11-08 20:40:14 +02003235 return mgmt_event(MGMT_EV_CONNECT_FAILED, hdev, &ev, sizeof(ev), NULL);
Johan Hedberg17d5c042011-01-22 06:09:08 +02003236}
Johan Hedberg980e1a52011-01-22 06:10:07 +02003237
Johan Hedberg744cf192011-11-08 20:40:14 +02003238int mgmt_pin_code_request(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 secure)
Johan Hedberg980e1a52011-01-22 06:10:07 +02003239{
3240 struct mgmt_ev_pin_code_request ev;
3241
Johan Hedbergd8457692012-02-17 14:24:57 +02003242 bacpy(&ev.addr.bdaddr, bdaddr);
Andre Guedes591f47f2012-04-24 21:02:49 -03003243 ev.addr.type = BDADDR_BREDR;
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003244 ev.secure = secure;
Johan Hedberg980e1a52011-01-22 06:10:07 +02003245
Johan Hedberg744cf192011-11-08 20:40:14 +02003246 return mgmt_event(MGMT_EV_PIN_CODE_REQUEST, hdev, &ev, sizeof(ev),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003247 NULL);
Johan Hedberg980e1a52011-01-22 06:10:07 +02003248}
3249
Johan Hedberg744cf192011-11-08 20:40:14 +02003250int mgmt_pin_code_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003251 u8 status)
Johan Hedberg980e1a52011-01-22 06:10:07 +02003252{
3253 struct pending_cmd *cmd;
Johan Hedbergac56fb12011-02-19 12:05:59 -03003254 struct mgmt_rp_pin_code_reply rp;
Johan Hedberg980e1a52011-01-22 06:10:07 +02003255 int err;
3256
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003257 cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_REPLY, hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +02003258 if (!cmd)
3259 return -ENOENT;
3260
Johan Hedbergd8457692012-02-17 14:24:57 +02003261 bacpy(&rp.addr.bdaddr, bdaddr);
Andre Guedes591f47f2012-04-24 21:02:49 -03003262 rp.addr.type = BDADDR_BREDR;
Johan Hedbergac56fb12011-02-19 12:05:59 -03003263
Johan Hedbergaee9b212012-02-18 15:07:59 +02003264 err = cmd_complete(cmd->sk, hdev->id, MGMT_OP_PIN_CODE_REPLY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003265 mgmt_status(status), &rp, sizeof(rp));
Johan Hedberg980e1a52011-01-22 06:10:07 +02003266
Johan Hedberga664b5b2011-02-19 12:06:02 -03003267 mgmt_pending_remove(cmd);
Johan Hedberg980e1a52011-01-22 06:10:07 +02003268
3269 return err;
3270}
3271
Johan Hedberg744cf192011-11-08 20:40:14 +02003272int mgmt_pin_code_neg_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003273 u8 status)
Johan Hedberg980e1a52011-01-22 06:10:07 +02003274{
3275 struct pending_cmd *cmd;
Johan Hedbergac56fb12011-02-19 12:05:59 -03003276 struct mgmt_rp_pin_code_reply rp;
Johan Hedberg980e1a52011-01-22 06:10:07 +02003277 int err;
3278
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003279 cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_NEG_REPLY, hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +02003280 if (!cmd)
3281 return -ENOENT;
3282
Johan Hedbergd8457692012-02-17 14:24:57 +02003283 bacpy(&rp.addr.bdaddr, bdaddr);
Andre Guedes591f47f2012-04-24 21:02:49 -03003284 rp.addr.type = BDADDR_BREDR;
Johan Hedbergac56fb12011-02-19 12:05:59 -03003285
Johan Hedbergaee9b212012-02-18 15:07:59 +02003286 err = cmd_complete(cmd->sk, hdev->id, MGMT_OP_PIN_CODE_NEG_REPLY,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003287 mgmt_status(status), &rp, sizeof(rp));
Johan Hedberg980e1a52011-01-22 06:10:07 +02003288
Johan Hedberga664b5b2011-02-19 12:06:02 -03003289 mgmt_pending_remove(cmd);
Johan Hedberg980e1a52011-01-22 06:10:07 +02003290
3291 return err;
3292}
Johan Hedberga5c29682011-02-19 12:05:57 -03003293
Johan Hedberg744cf192011-11-08 20:40:14 +02003294int mgmt_user_confirm_request(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003295 u8 link_type, u8 addr_type, __le32 value,
3296 u8 confirm_hint)
Johan Hedberga5c29682011-02-19 12:05:57 -03003297{
3298 struct mgmt_ev_user_confirm_request ev;
3299
Johan Hedberg744cf192011-11-08 20:40:14 +02003300 BT_DBG("%s", hdev->name);
Johan Hedberga5c29682011-02-19 12:05:57 -03003301
Johan Hedberg272d90d2012-02-09 15:26:12 +02003302 bacpy(&ev.addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003303 ev.addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedberg55bc1a32011-04-28 11:28:56 -07003304 ev.confirm_hint = confirm_hint;
Andrei Emeltchenko78e80982012-03-09 13:00:50 +02003305 ev.value = value;
Johan Hedberga5c29682011-02-19 12:05:57 -03003306
Johan Hedberg744cf192011-11-08 20:40:14 +02003307 return mgmt_event(MGMT_EV_USER_CONFIRM_REQUEST, hdev, &ev, sizeof(ev),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003308 NULL);
Johan Hedberga5c29682011-02-19 12:05:57 -03003309}
3310
Johan Hedberg272d90d2012-02-09 15:26:12 +02003311int mgmt_user_passkey_request(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03003312 u8 link_type, u8 addr_type)
Brian Gix604086b2011-11-23 08:28:33 -08003313{
3314 struct mgmt_ev_user_passkey_request ev;
3315
3316 BT_DBG("%s", hdev->name);
3317
Johan Hedberg272d90d2012-02-09 15:26:12 +02003318 bacpy(&ev.addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003319 ev.addr.type = link_to_bdaddr(link_type, addr_type);
Brian Gix604086b2011-11-23 08:28:33 -08003320
3321 return mgmt_event(MGMT_EV_USER_PASSKEY_REQUEST, hdev, &ev, sizeof(ev),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003322 NULL);
Brian Gix604086b2011-11-23 08:28:33 -08003323}
3324
Brian Gix0df4c182011-11-16 13:53:13 -08003325static int user_pairing_resp_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo Padovan8ce8e2b2012-05-17 00:36:20 -03003326 u8 link_type, u8 addr_type, u8 status,
3327 u8 opcode)
Johan Hedberga5c29682011-02-19 12:05:57 -03003328{
3329 struct pending_cmd *cmd;
3330 struct mgmt_rp_user_confirm_reply rp;
3331 int err;
3332
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003333 cmd = mgmt_pending_find(opcode, hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -03003334 if (!cmd)
3335 return -ENOENT;
3336
Johan Hedberg272d90d2012-02-09 15:26:12 +02003337 bacpy(&rp.addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003338 rp.addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedbergaee9b212012-02-18 15:07:59 +02003339 err = cmd_complete(cmd->sk, hdev->id, opcode, mgmt_status(status),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003340 &rp, sizeof(rp));
Johan Hedberga5c29682011-02-19 12:05:57 -03003341
Johan Hedberga664b5b2011-02-19 12:06:02 -03003342 mgmt_pending_remove(cmd);
Johan Hedberga5c29682011-02-19 12:05:57 -03003343
3344 return err;
3345}
3346
Johan Hedberg744cf192011-11-08 20:40:14 +02003347int mgmt_user_confirm_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003348 u8 link_type, u8 addr_type, u8 status)
Johan Hedberga5c29682011-02-19 12:05:57 -03003349{
Johan Hedberg272d90d2012-02-09 15:26:12 +02003350 return user_pairing_resp_complete(hdev, bdaddr, link_type, addr_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003351 status, MGMT_OP_USER_CONFIRM_REPLY);
Johan Hedberga5c29682011-02-19 12:05:57 -03003352}
3353
Johan Hedberg272d90d2012-02-09 15:26:12 +02003354int mgmt_user_confirm_neg_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003355 u8 link_type, u8 addr_type, u8 status)
Johan Hedberga5c29682011-02-19 12:05:57 -03003356{
Johan Hedberg272d90d2012-02-09 15:26:12 +02003357 return user_pairing_resp_complete(hdev, bdaddr, link_type, addr_type,
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003358 status,
3359 MGMT_OP_USER_CONFIRM_NEG_REPLY);
Johan Hedberga5c29682011-02-19 12:05:57 -03003360}
Johan Hedberg2a611692011-02-19 12:06:00 -03003361
Brian Gix604086b2011-11-23 08:28:33 -08003362int mgmt_user_passkey_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003363 u8 link_type, u8 addr_type, u8 status)
Brian Gix604086b2011-11-23 08:28:33 -08003364{
Johan Hedberg272d90d2012-02-09 15:26:12 +02003365 return user_pairing_resp_complete(hdev, bdaddr, link_type, addr_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003366 status, MGMT_OP_USER_PASSKEY_REPLY);
Brian Gix604086b2011-11-23 08:28:33 -08003367}
3368
Johan Hedberg272d90d2012-02-09 15:26:12 +02003369int mgmt_user_passkey_neg_reply_complete(struct hci_dev *hdev, bdaddr_t *bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003370 u8 link_type, u8 addr_type, u8 status)
Brian Gix604086b2011-11-23 08:28:33 -08003371{
Johan Hedberg272d90d2012-02-09 15:26:12 +02003372 return user_pairing_resp_complete(hdev, bdaddr, link_type, addr_type,
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003373 status,
3374 MGMT_OP_USER_PASSKEY_NEG_REPLY);
Brian Gix604086b2011-11-23 08:28:33 -08003375}
3376
Johan Hedberg92a25252012-09-06 18:39:26 +03003377int mgmt_user_passkey_notify(struct hci_dev *hdev, bdaddr_t *bdaddr,
3378 u8 link_type, u8 addr_type, u32 passkey,
3379 u8 entered)
3380{
3381 struct mgmt_ev_passkey_notify ev;
3382
3383 BT_DBG("%s", hdev->name);
3384
3385 bacpy(&ev.addr.bdaddr, bdaddr);
3386 ev.addr.type = link_to_bdaddr(link_type, addr_type);
3387 ev.passkey = __cpu_to_le32(passkey);
3388 ev.entered = entered;
3389
3390 return mgmt_event(MGMT_EV_PASSKEY_NOTIFY, hdev, &ev, sizeof(ev), NULL);
3391}
3392
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003393int mgmt_auth_failed(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 link_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003394 u8 addr_type, u8 status)
Johan Hedberg2a611692011-02-19 12:06:00 -03003395{
3396 struct mgmt_ev_auth_failed ev;
3397
Johan Hedbergbab73cb2012-02-09 16:07:29 +02003398 bacpy(&ev.addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003399 ev.addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedbergca69b792011-11-11 18:10:00 +02003400 ev.status = mgmt_status(status);
Johan Hedberg2a611692011-02-19 12:06:00 -03003401
Johan Hedberg744cf192011-11-08 20:40:14 +02003402 return mgmt_event(MGMT_EV_AUTH_FAILED, hdev, &ev, sizeof(ev), NULL);
Johan Hedberg2a611692011-02-19 12:06:00 -03003403}
Johan Hedbergb312b1612011-03-16 14:29:37 +02003404
Johan Hedberg33ef95e2012-02-16 23:56:27 +02003405int mgmt_auth_enable_complete(struct hci_dev *hdev, u8 status)
3406{
3407 struct cmd_lookup match = { NULL, hdev };
Johan Hedberg47990ea2012-02-22 11:58:37 +02003408 bool changed = false;
3409 int err = 0;
Johan Hedberg33ef95e2012-02-16 23:56:27 +02003410
3411 if (status) {
3412 u8 mgmt_err = mgmt_status(status);
3413 mgmt_pending_foreach(MGMT_OP_SET_LINK_SECURITY, hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003414 cmd_status_rsp, &mgmt_err);
Johan Hedberg33ef95e2012-02-16 23:56:27 +02003415 return 0;
3416 }
3417
Johan Hedberg47990ea2012-02-22 11:58:37 +02003418 if (test_bit(HCI_AUTH, &hdev->flags)) {
3419 if (!test_and_set_bit(HCI_LINK_SECURITY, &hdev->dev_flags))
3420 changed = true;
3421 } else {
3422 if (test_and_clear_bit(HCI_LINK_SECURITY, &hdev->dev_flags))
3423 changed = true;
3424 }
3425
Johan Hedberg33ef95e2012-02-16 23:56:27 +02003426 mgmt_pending_foreach(MGMT_OP_SET_LINK_SECURITY, hdev, settings_rsp,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003427 &match);
Johan Hedberg33ef95e2012-02-16 23:56:27 +02003428
Johan Hedberg47990ea2012-02-22 11:58:37 +02003429 if (changed)
3430 err = new_settings(hdev, match.sk);
Johan Hedberg33ef95e2012-02-16 23:56:27 +02003431
3432 if (match.sk)
3433 sock_put(match.sk);
3434
3435 return err;
3436}
3437
Johan Hedbergcacaf522012-02-21 00:52:42 +02003438static int clear_eir(struct hci_dev *hdev)
3439{
3440 struct hci_cp_write_eir cp;
3441
Johan Hedberg976eb202012-10-24 21:12:01 +03003442 if (!lmp_ext_inq_capable(hdev))
Johan Hedbergcacaf522012-02-21 00:52:42 +02003443 return 0;
3444
Johan Hedbergc80da272012-02-22 15:38:48 +02003445 memset(hdev->eir, 0, sizeof(hdev->eir));
3446
Johan Hedbergcacaf522012-02-21 00:52:42 +02003447 memset(&cp, 0, sizeof(cp));
3448
3449 return hci_send_cmd(hdev, HCI_OP_WRITE_EIR, sizeof(cp), &cp);
3450}
3451
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02003452int mgmt_ssp_enable_complete(struct hci_dev *hdev, u8 enable, u8 status)
Johan Hedberged2c4ee2012-02-17 00:56:28 +02003453{
3454 struct cmd_lookup match = { NULL, hdev };
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02003455 bool changed = false;
3456 int err = 0;
Johan Hedberged2c4ee2012-02-17 00:56:28 +02003457
3458 if (status) {
3459 u8 mgmt_err = mgmt_status(status);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02003460
3461 if (enable && test_and_clear_bit(HCI_SSP_ENABLED,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003462 &hdev->dev_flags))
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02003463 err = new_settings(hdev, NULL);
3464
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003465 mgmt_pending_foreach(MGMT_OP_SET_SSP, hdev, cmd_status_rsp,
3466 &mgmt_err);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02003467
3468 return err;
3469 }
3470
3471 if (enable) {
3472 if (!test_and_set_bit(HCI_SSP_ENABLED, &hdev->dev_flags))
3473 changed = true;
3474 } else {
3475 if (test_and_clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags))
3476 changed = true;
Johan Hedberged2c4ee2012-02-17 00:56:28 +02003477 }
3478
3479 mgmt_pending_foreach(MGMT_OP_SET_SSP, hdev, settings_rsp, &match);
3480
Johan Hedbergc0ecddc2012-02-22 12:38:31 +02003481 if (changed)
3482 err = new_settings(hdev, match.sk);
Johan Hedberged2c4ee2012-02-17 00:56:28 +02003483
Johan Hedberg5fc6ebb2012-02-22 15:10:59 +02003484 if (match.sk)
Johan Hedberged2c4ee2012-02-17 00:56:28 +02003485 sock_put(match.sk);
3486
Johan Hedberg5fc6ebb2012-02-22 15:10:59 +02003487 if (test_bit(HCI_SSP_ENABLED, &hdev->dev_flags))
3488 update_eir(hdev);
3489 else
3490 clear_eir(hdev);
Johan Hedbergcacaf522012-02-21 00:52:42 +02003491
Johan Hedberged2c4ee2012-02-17 00:56:28 +02003492 return err;
3493}
3494
Johan Hedberg90e70452012-02-23 23:09:40 +02003495static void class_rsp(struct pending_cmd *cmd, void *data)
3496{
3497 struct cmd_lookup *match = data;
3498
3499 cmd_complete(cmd->sk, cmd->index, cmd->opcode, match->mgmt_status,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003500 match->hdev->dev_class, 3);
Johan Hedberg90e70452012-02-23 23:09:40 +02003501
3502 list_del(&cmd->list);
3503
3504 if (match->sk == NULL) {
3505 match->sk = cmd->sk;
3506 sock_hold(match->sk);
3507 }
3508
3509 mgmt_pending_free(cmd);
3510}
3511
Marcel Holtmann7f9a9032012-02-22 18:38:01 +01003512int mgmt_set_class_of_dev_complete(struct hci_dev *hdev, u8 *dev_class,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003513 u8 status)
Marcel Holtmann7f9a9032012-02-22 18:38:01 +01003514{
Johan Hedberg90e70452012-02-23 23:09:40 +02003515 struct cmd_lookup match = { NULL, hdev, mgmt_status(status) };
3516 int err = 0;
Marcel Holtmann7f9a9032012-02-22 18:38:01 +01003517
Johan Hedbergc95f0ba2012-02-23 22:54:38 +02003518 clear_bit(HCI_PENDING_CLASS, &hdev->dev_flags);
3519
Johan Hedberg90e70452012-02-23 23:09:40 +02003520 mgmt_pending_foreach(MGMT_OP_SET_DEV_CLASS, hdev, class_rsp, &match);
3521 mgmt_pending_foreach(MGMT_OP_ADD_UUID, hdev, class_rsp, &match);
3522 mgmt_pending_foreach(MGMT_OP_REMOVE_UUID, hdev, class_rsp, &match);
3523
3524 if (!status)
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003525 err = mgmt_event(MGMT_EV_CLASS_OF_DEV_CHANGED, hdev, dev_class,
3526 3, NULL);
Johan Hedberg90e70452012-02-23 23:09:40 +02003527
3528 if (match.sk)
3529 sock_put(match.sk);
Marcel Holtmann7f9a9032012-02-22 18:38:01 +01003530
3531 return err;
3532}
3533
Johan Hedberg744cf192011-11-08 20:40:14 +02003534int mgmt_set_local_name_complete(struct hci_dev *hdev, u8 *name, u8 status)
Johan Hedbergb312b1612011-03-16 14:29:37 +02003535{
3536 struct pending_cmd *cmd;
3537 struct mgmt_cp_set_local_name ev;
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02003538 bool changed = false;
3539 int err = 0;
3540
3541 if (memcmp(name, hdev->dev_name, sizeof(hdev->dev_name)) != 0) {
3542 memcpy(hdev->dev_name, name, sizeof(hdev->dev_name));
3543 changed = true;
3544 }
Johan Hedbergb312b1612011-03-16 14:29:37 +02003545
3546 memset(&ev, 0, sizeof(ev));
3547 memcpy(ev.name, name, HCI_MAX_NAME_LENGTH);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02003548 memcpy(ev.short_name, hdev->short_name, HCI_MAX_SHORT_NAME_LENGTH);
Johan Hedbergb312b1612011-03-16 14:29:37 +02003549
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003550 cmd = mgmt_pending_find(MGMT_OP_SET_LOCAL_NAME, hdev);
Johan Hedbergb312b1612011-03-16 14:29:37 +02003551 if (!cmd)
3552 goto send_event;
3553
Johan Hedberg7bdaae42012-02-22 21:39:58 +02003554 /* Always assume that either the short or the complete name has
3555 * changed if there was a pending mgmt command */
3556 changed = true;
3557
Johan Hedbergb312b1612011-03-16 14:29:37 +02003558 if (status) {
Johan Hedberg744cf192011-11-08 20:40:14 +02003559 err = cmd_status(cmd->sk, hdev->id, MGMT_OP_SET_LOCAL_NAME,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003560 mgmt_status(status));
Johan Hedbergb312b1612011-03-16 14:29:37 +02003561 goto failed;
3562 }
3563
Johan Hedbergaee9b212012-02-18 15:07:59 +02003564 err = cmd_complete(cmd->sk, hdev->id, MGMT_OP_SET_LOCAL_NAME, 0, &ev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003565 sizeof(ev));
Johan Hedbergb312b1612011-03-16 14:29:37 +02003566 if (err < 0)
3567 goto failed;
3568
3569send_event:
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02003570 if (changed)
3571 err = mgmt_event(MGMT_EV_LOCAL_NAME_CHANGED, hdev, &ev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003572 sizeof(ev), cmd ? cmd->sk : NULL);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +02003573
Johan Hedberg1225a6b2012-10-25 00:09:54 +03003574 /* EIR is taken care of separately when powering on the
3575 * adapter so only update them here if this is a name change
3576 * unrelated to power on.
3577 */
3578 if (!test_bit(HCI_INIT, &hdev->flags))
3579 update_eir(hdev);
Johan Hedbergb312b1612011-03-16 14:29:37 +02003580
3581failed:
3582 if (cmd)
3583 mgmt_pending_remove(cmd);
3584 return err;
3585}
Szymon Jancc35938b2011-03-22 13:12:21 +01003586
Johan Hedberg744cf192011-11-08 20:40:14 +02003587int mgmt_read_local_oob_data_reply_complete(struct hci_dev *hdev, u8 *hash,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003588 u8 *randomizer, u8 status)
Szymon Jancc35938b2011-03-22 13:12:21 +01003589{
3590 struct pending_cmd *cmd;
3591 int err;
3592
Johan Hedberg744cf192011-11-08 20:40:14 +02003593 BT_DBG("%s status %u", hdev->name, status);
Szymon Jancc35938b2011-03-22 13:12:21 +01003594
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003595 cmd = mgmt_pending_find(MGMT_OP_READ_LOCAL_OOB_DATA, hdev);
Szymon Jancc35938b2011-03-22 13:12:21 +01003596 if (!cmd)
3597 return -ENOENT;
3598
3599 if (status) {
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003600 err = cmd_status(cmd->sk, hdev->id, MGMT_OP_READ_LOCAL_OOB_DATA,
3601 mgmt_status(status));
Szymon Jancc35938b2011-03-22 13:12:21 +01003602 } else {
3603 struct mgmt_rp_read_local_oob_data rp;
3604
3605 memcpy(rp.hash, hash, sizeof(rp.hash));
3606 memcpy(rp.randomizer, randomizer, sizeof(rp.randomizer));
3607
Johan Hedberg744cf192011-11-08 20:40:14 +02003608 err = cmd_complete(cmd->sk, hdev->id,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003609 MGMT_OP_READ_LOCAL_OOB_DATA, 0, &rp,
3610 sizeof(rp));
Szymon Jancc35938b2011-03-22 13:12:21 +01003611 }
3612
3613 mgmt_pending_remove(cmd);
3614
3615 return err;
3616}
Johan Hedberge17acd42011-03-30 23:57:16 +03003617
Johan Hedberg06199cf2012-02-22 16:37:11 +02003618int mgmt_le_enable_complete(struct hci_dev *hdev, u8 enable, u8 status)
3619{
3620 struct cmd_lookup match = { NULL, hdev };
3621 bool changed = false;
3622 int err = 0;
3623
3624 if (status) {
3625 u8 mgmt_err = mgmt_status(status);
3626
3627 if (enable && test_and_clear_bit(HCI_LE_ENABLED,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003628 &hdev->dev_flags))
Szymon Jancd97dcb62012-03-16 16:02:56 +01003629 err = new_settings(hdev, NULL);
Johan Hedberg06199cf2012-02-22 16:37:11 +02003630
Szymon Jancd97dcb62012-03-16 16:02:56 +01003631 mgmt_pending_foreach(MGMT_OP_SET_LE, hdev, cmd_status_rsp,
3632 &mgmt_err);
Johan Hedberg06199cf2012-02-22 16:37:11 +02003633
3634 return err;
3635 }
3636
3637 if (enable) {
3638 if (!test_and_set_bit(HCI_LE_ENABLED, &hdev->dev_flags))
3639 changed = true;
3640 } else {
3641 if (test_and_clear_bit(HCI_LE_ENABLED, &hdev->dev_flags))
3642 changed = true;
3643 }
3644
3645 mgmt_pending_foreach(MGMT_OP_SET_LE, hdev, settings_rsp, &match);
3646
3647 if (changed)
3648 err = new_settings(hdev, match.sk);
3649
3650 if (match.sk)
3651 sock_put(match.sk);
3652
3653 return err;
3654}
3655
Johan Hedberg48264f02011-11-09 13:58:58 +02003656int mgmt_device_found(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 link_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003657 u8 addr_type, u8 *dev_class, s8 rssi, u8 cfm_name, u8
3658 ssp, u8 *eir, u16 eir_len)
Johan Hedberge17acd42011-03-30 23:57:16 +03003659{
Johan Hedberge319d2e2012-01-15 19:51:59 +02003660 char buf[512];
3661 struct mgmt_ev_device_found *ev = (void *) buf;
Johan Hedberg1dc06092012-01-15 21:01:23 +02003662 size_t ev_size;
Johan Hedberge17acd42011-03-30 23:57:16 +03003663
Johan Hedberg1dc06092012-01-15 21:01:23 +02003664 /* Leave 5 bytes for a potential CoD field */
3665 if (sizeof(*ev) + eir_len + 5 > sizeof(buf))
Andre Guedes7d262f82012-01-10 18:20:49 -03003666 return -EINVAL;
3667
Johan Hedberg1dc06092012-01-15 21:01:23 +02003668 memset(buf, 0, sizeof(buf));
3669
Johan Hedberge319d2e2012-01-15 19:51:59 +02003670 bacpy(&ev->addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003671 ev->addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedberge319d2e2012-01-15 19:51:59 +02003672 ev->rssi = rssi;
Johan Hedberg9a395a82012-02-23 00:00:32 +02003673 if (cfm_name)
Syam Sidhardhan612dfce2012-10-29 22:37:36 +05303674 ev->flags |= __constant_cpu_to_le32(MGMT_DEV_FOUND_CONFIRM_NAME);
Johan Hedberg388fc8f2012-02-23 00:38:59 +02003675 if (!ssp)
Syam Sidhardhan612dfce2012-10-29 22:37:36 +05303676 ev->flags |= __constant_cpu_to_le32(MGMT_DEV_FOUND_LEGACY_PAIRING);
Johan Hedberge17acd42011-03-30 23:57:16 +03003677
Johan Hedberg1dc06092012-01-15 21:01:23 +02003678 if (eir_len > 0)
Johan Hedberge319d2e2012-01-15 19:51:59 +02003679 memcpy(ev->eir, eir, eir_len);
Johan Hedberge17acd42011-03-30 23:57:16 +03003680
Johan Hedberg1dc06092012-01-15 21:01:23 +02003681 if (dev_class && !eir_has_data_type(ev->eir, eir_len, EIR_CLASS_OF_DEV))
3682 eir_len = eir_append_data(ev->eir, eir_len, EIR_CLASS_OF_DEV,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003683 dev_class, 3);
Johan Hedberg1dc06092012-01-15 21:01:23 +02003684
Marcel Holtmanneb55ef02012-03-14 18:08:46 +02003685 ev->eir_len = cpu_to_le16(eir_len);
Johan Hedberg1dc06092012-01-15 21:01:23 +02003686 ev_size = sizeof(*ev) + eir_len;
Andre Guedesf8523592011-09-09 18:56:26 -03003687
Johan Hedberge319d2e2012-01-15 19:51:59 +02003688 return mgmt_event(MGMT_EV_DEVICE_FOUND, hdev, ev, ev_size, NULL);
Johan Hedberge17acd42011-03-30 23:57:16 +03003689}
Johan Hedberga88a9652011-03-30 13:18:12 +03003690
Johan Hedbergb644ba32012-01-17 21:48:47 +02003691int mgmt_remote_name(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 link_type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003692 u8 addr_type, s8 rssi, u8 *name, u8 name_len)
Johan Hedberga88a9652011-03-30 13:18:12 +03003693{
Johan Hedbergb644ba32012-01-17 21:48:47 +02003694 struct mgmt_ev_device_found *ev;
3695 char buf[sizeof(*ev) + HCI_MAX_NAME_LENGTH + 2];
3696 u16 eir_len;
Johan Hedberga88a9652011-03-30 13:18:12 +03003697
Johan Hedbergb644ba32012-01-17 21:48:47 +02003698 ev = (struct mgmt_ev_device_found *) buf;
Johan Hedberga88a9652011-03-30 13:18:12 +03003699
Johan Hedbergb644ba32012-01-17 21:48:47 +02003700 memset(buf, 0, sizeof(buf));
Johan Hedberga88a9652011-03-30 13:18:12 +03003701
Johan Hedbergb644ba32012-01-17 21:48:47 +02003702 bacpy(&ev->addr.bdaddr, bdaddr);
Andre Guedes57c14772012-04-24 21:02:50 -03003703 ev->addr.type = link_to_bdaddr(link_type, addr_type);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003704 ev->rssi = rssi;
3705
3706 eir_len = eir_append_data(ev->eir, 0, EIR_NAME_COMPLETE, name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003707 name_len);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003708
Marcel Holtmanneb55ef02012-03-14 18:08:46 +02003709 ev->eir_len = cpu_to_le16(eir_len);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003710
Johan Hedberg053c7e02012-02-04 00:06:00 +02003711 return mgmt_event(MGMT_EV_DEVICE_FOUND, hdev, ev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003712 sizeof(*ev) + eir_len, NULL);
Johan Hedberga88a9652011-03-30 13:18:12 +03003713}
Johan Hedberg314b2382011-04-27 10:29:57 -04003714
Andre Guedes7a135102011-11-09 17:14:25 -03003715int mgmt_start_discovery_failed(struct hci_dev *hdev, u8 status)
Johan Hedberg164a6e72011-11-01 17:06:44 +02003716{
3717 struct pending_cmd *cmd;
Johan Hedbergf808e162012-02-19 12:52:07 +02003718 u8 type;
Johan Hedberg164a6e72011-11-01 17:06:44 +02003719 int err;
3720
Andre Guedes203159d2012-02-13 15:41:01 -03003721 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
3722
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003723 cmd = mgmt_pending_find(MGMT_OP_START_DISCOVERY, hdev);
Johan Hedberg164a6e72011-11-01 17:06:44 +02003724 if (!cmd)
3725 return -ENOENT;
3726
Johan Hedbergf808e162012-02-19 12:52:07 +02003727 type = hdev->discovery.type;
3728
3729 err = cmd_complete(cmd->sk, hdev->id, cmd->opcode, mgmt_status(status),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003730 &type, sizeof(type));
Johan Hedberg164a6e72011-11-01 17:06:44 +02003731 mgmt_pending_remove(cmd);
3732
3733 return err;
3734}
3735
Andre Guedese6d465c2011-11-09 17:14:26 -03003736int mgmt_stop_discovery_failed(struct hci_dev *hdev, u8 status)
3737{
3738 struct pending_cmd *cmd;
3739 int err;
3740
3741 cmd = mgmt_pending_find(MGMT_OP_STOP_DISCOVERY, hdev);
3742 if (!cmd)
3743 return -ENOENT;
3744
Johan Hedbergd9306502012-02-20 23:25:18 +02003745 err = cmd_complete(cmd->sk, hdev->id, cmd->opcode, mgmt_status(status),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003746 &hdev->discovery.type, sizeof(hdev->discovery.type));
Johan Hedberg03811012010-12-08 00:21:06 +02003747 mgmt_pending_remove(cmd);
3748
3749 return err;
3750}
Johan Hedberg314b2382011-04-27 10:29:57 -04003751
Johan Hedberg744cf192011-11-08 20:40:14 +02003752int mgmt_discovering(struct hci_dev *hdev, u8 discovering)
Johan Hedberg314b2382011-04-27 10:29:57 -04003753{
Johan Hedbergf963e8e2012-02-20 23:30:44 +02003754 struct mgmt_ev_discovering ev;
Johan Hedberg164a6e72011-11-01 17:06:44 +02003755 struct pending_cmd *cmd;
3756
Andre Guedes343fb142011-11-22 17:14:19 -03003757 BT_DBG("%s discovering %u", hdev->name, discovering);
3758
Johan Hedberg164a6e72011-11-01 17:06:44 +02003759 if (discovering)
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003760 cmd = mgmt_pending_find(MGMT_OP_START_DISCOVERY, hdev);
Johan Hedberg164a6e72011-11-01 17:06:44 +02003761 else
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003762 cmd = mgmt_pending_find(MGMT_OP_STOP_DISCOVERY, hdev);
Johan Hedberg164a6e72011-11-01 17:06:44 +02003763
3764 if (cmd != NULL) {
Johan Hedbergf808e162012-02-19 12:52:07 +02003765 u8 type = hdev->discovery.type;
3766
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003767 cmd_complete(cmd->sk, hdev->id, cmd->opcode, 0, &type,
3768 sizeof(type));
Johan Hedberg164a6e72011-11-01 17:06:44 +02003769 mgmt_pending_remove(cmd);
3770 }
3771
Johan Hedbergf963e8e2012-02-20 23:30:44 +02003772 memset(&ev, 0, sizeof(ev));
3773 ev.type = hdev->discovery.type;
3774 ev.discovering = discovering;
3775
3776 return mgmt_event(MGMT_EV_DISCOVERING, hdev, &ev, sizeof(ev), NULL);
Johan Hedberg314b2382011-04-27 10:29:57 -04003777}
Antti Julku5e762442011-08-25 16:48:02 +03003778
Johan Hedberg88c1fe42012-02-09 15:56:11 +02003779int mgmt_device_blocked(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type)
Antti Julku5e762442011-08-25 16:48:02 +03003780{
3781 struct pending_cmd *cmd;
3782 struct mgmt_ev_device_blocked ev;
3783
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003784 cmd = mgmt_pending_find(MGMT_OP_BLOCK_DEVICE, hdev);
Antti Julku5e762442011-08-25 16:48:02 +03003785
Johan Hedberg88c1fe42012-02-09 15:56:11 +02003786 bacpy(&ev.addr.bdaddr, bdaddr);
3787 ev.addr.type = type;
Antti Julku5e762442011-08-25 16:48:02 +03003788
Johan Hedberg744cf192011-11-08 20:40:14 +02003789 return mgmt_event(MGMT_EV_DEVICE_BLOCKED, hdev, &ev, sizeof(ev),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003790 cmd ? cmd->sk : NULL);
Antti Julku5e762442011-08-25 16:48:02 +03003791}
3792
Johan Hedberg88c1fe42012-02-09 15:56:11 +02003793int mgmt_device_unblocked(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type)
Antti Julku5e762442011-08-25 16:48:02 +03003794{
3795 struct pending_cmd *cmd;
3796 struct mgmt_ev_device_unblocked ev;
3797
Johan Hedberg2e58ef32011-11-08 20:40:15 +02003798 cmd = mgmt_pending_find(MGMT_OP_UNBLOCK_DEVICE, hdev);
Antti Julku5e762442011-08-25 16:48:02 +03003799
Johan Hedberg88c1fe42012-02-09 15:56:11 +02003800 bacpy(&ev.addr.bdaddr, bdaddr);
3801 ev.addr.type = type;
Antti Julku5e762442011-08-25 16:48:02 +03003802
Johan Hedberg744cf192011-11-08 20:40:14 +02003803 return mgmt_event(MGMT_EV_DEVICE_UNBLOCKED, hdev, &ev, sizeof(ev),
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003804 cmd ? cmd->sk : NULL);
Antti Julku5e762442011-08-25 16:48:02 +03003805}
Marcel Holtmannd7b7e792012-02-20 21:47:49 +01003806
3807module_param(enable_hs, bool, 0644);
3808MODULE_PARM_DESC(enable_hs, "Enable High Speed support");