1 // SPDX-License-Identifier: GPL-2.0-only
4 * Copyright (C) 2020 Google Corporation
7 #include <net/bluetooth/bluetooth.h>
8 #include <net/bluetooth/hci_core.h>
9 #include <net/bluetooth/mgmt.h>
11 #include "mgmt_util.h"
12 #include "mgmt_config.h"
14 #define HDEV_PARAM_U16(_param_code_, _param_name_) \
16 { cpu_to_le16(_param_code_), sizeof(__u16) }, \
17 { cpu_to_le16(hdev->_param_name_) } \
20 #define HDEV_PARAM_U16_JIFFIES_TO_MSECS(_param_code_, _param_name_) \
22 { cpu_to_le16(_param_code_), sizeof(__u16) }, \
23 { cpu_to_le16(jiffies_to_msecs(hdev->_param_name_)) } \
26 int read_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data,
30 struct mgmt_tlv entry;
32 /* This is a simplification for now since all values
33 * are 16 bits. In the future, this code may need
34 * refactoring to account for variable length values
35 * and properly calculate the required buffer size.
39 } __packed params[] = {
40 /* Please see mgmt-api.txt for documentation of these values */
41 HDEV_PARAM_U16(0x0000, def_page_scan_type),
42 HDEV_PARAM_U16(0x0001, def_page_scan_int),
43 HDEV_PARAM_U16(0x0002, def_page_scan_window),
44 HDEV_PARAM_U16(0x0003, def_inq_scan_type),
45 HDEV_PARAM_U16(0x0004, def_inq_scan_int),
46 HDEV_PARAM_U16(0x0005, def_inq_scan_window),
47 HDEV_PARAM_U16(0x0006, def_br_lsto),
48 HDEV_PARAM_U16(0x0007, def_page_timeout),
49 HDEV_PARAM_U16(0x0008, sniff_min_interval),
50 HDEV_PARAM_U16(0x0009, sniff_max_interval),
51 HDEV_PARAM_U16(0x000a, le_adv_min_interval),
52 HDEV_PARAM_U16(0x000b, le_adv_max_interval),
53 HDEV_PARAM_U16(0x000c, def_multi_adv_rotation_duration),
54 HDEV_PARAM_U16(0x000d, le_scan_interval),
55 HDEV_PARAM_U16(0x000e, le_scan_window),
56 HDEV_PARAM_U16(0x000f, le_scan_int_suspend),
57 HDEV_PARAM_U16(0x0010, le_scan_window_suspend),
58 HDEV_PARAM_U16(0x0011, le_scan_int_discovery),
59 HDEV_PARAM_U16(0x0012, le_scan_window_discovery),
60 HDEV_PARAM_U16(0x0013, le_scan_int_adv_monitor),
61 HDEV_PARAM_U16(0x0014, le_scan_window_adv_monitor),
62 HDEV_PARAM_U16(0x0015, le_scan_int_connect),
63 HDEV_PARAM_U16(0x0016, le_scan_window_connect),
64 HDEV_PARAM_U16(0x0017, le_conn_min_interval),
65 HDEV_PARAM_U16(0x0018, le_conn_max_interval),
66 HDEV_PARAM_U16(0x0019, le_conn_latency),
67 HDEV_PARAM_U16(0x001a, le_supv_timeout),
68 HDEV_PARAM_U16_JIFFIES_TO_MSECS(0x001b,
69 def_le_autoconnect_timeout),
71 struct mgmt_rp_read_def_system_config *rp = (void *)params;
73 bt_dev_dbg(hdev, "sock %p", sk);
75 return mgmt_cmd_complete(sk, hdev->id,
76 MGMT_OP_READ_DEF_SYSTEM_CONFIG,
77 0, rp, sizeof(params));
80 #define TO_TLV(x) ((struct mgmt_tlv *)(x))
81 #define TLV_GET_LE16(tlv) le16_to_cpu(*((__le16 *)(TO_TLV(tlv)->value)))
83 int set_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data,
86 u16 buffer_left = data_len;
89 if (buffer_left < sizeof(struct mgmt_tlv)) {
90 return mgmt_cmd_status(sk, hdev->id,
91 MGMT_OP_SET_DEF_SYSTEM_CONFIG,
92 MGMT_STATUS_INVALID_PARAMS);
95 /* First pass to validate the tlv */
96 while (buffer_left >= sizeof(struct mgmt_tlv)) {
97 const u8 len = TO_TLV(buffer)->length;
98 const u16 exp_len = sizeof(struct mgmt_tlv) +
100 const u16 type = le16_to_cpu(TO_TLV(buffer)->type);
102 if (buffer_left < exp_len) {
103 bt_dev_warn(hdev, "invalid len left %d, exp >= %d",
104 buffer_left, exp_len);
106 return mgmt_cmd_status(sk, hdev->id,
107 MGMT_OP_SET_DEF_SYSTEM_CONFIG,
108 MGMT_STATUS_INVALID_PARAMS);
111 /* Please see mgmt-api.txt for documentation of these values */
141 if (len != sizeof(u16)) {
142 bt_dev_warn(hdev, "invalid length %d, exp %zu for type %d",
143 len, sizeof(u16), type);
145 return mgmt_cmd_status(sk, hdev->id,
146 MGMT_OP_SET_DEF_SYSTEM_CONFIG,
147 MGMT_STATUS_INVALID_PARAMS);
151 bt_dev_warn(hdev, "unsupported parameter %u", type);
155 buffer_left -= exp_len;
159 buffer_left = data_len;
161 while (buffer_left >= sizeof(struct mgmt_tlv)) {
162 const u8 len = TO_TLV(buffer)->length;
163 const u16 exp_len = sizeof(struct mgmt_tlv) +
165 const u16 type = le16_to_cpu(TO_TLV(buffer)->type);
169 hdev->def_page_scan_type = TLV_GET_LE16(buffer);
172 hdev->def_page_scan_int = TLV_GET_LE16(buffer);
175 hdev->def_page_scan_window = TLV_GET_LE16(buffer);
178 hdev->def_inq_scan_type = TLV_GET_LE16(buffer);
181 hdev->def_inq_scan_int = TLV_GET_LE16(buffer);
184 hdev->def_inq_scan_window = TLV_GET_LE16(buffer);
187 hdev->def_br_lsto = TLV_GET_LE16(buffer);
190 hdev->def_page_timeout = TLV_GET_LE16(buffer);
193 hdev->sniff_min_interval = TLV_GET_LE16(buffer);
196 hdev->sniff_max_interval = TLV_GET_LE16(buffer);
199 hdev->le_adv_min_interval = TLV_GET_LE16(buffer);
202 hdev->le_adv_max_interval = TLV_GET_LE16(buffer);
205 hdev->def_multi_adv_rotation_duration =
206 TLV_GET_LE16(buffer);
209 hdev->le_scan_interval = TLV_GET_LE16(buffer);
212 hdev->le_scan_window = TLV_GET_LE16(buffer);
215 hdev->le_scan_int_suspend = TLV_GET_LE16(buffer);
218 hdev->le_scan_window_suspend = TLV_GET_LE16(buffer);
221 hdev->le_scan_int_discovery = TLV_GET_LE16(buffer);
224 hdev->le_scan_window_discovery = TLV_GET_LE16(buffer);
227 hdev->le_scan_int_adv_monitor = TLV_GET_LE16(buffer);
230 hdev->le_scan_window_adv_monitor = TLV_GET_LE16(buffer);
233 hdev->le_scan_int_connect = TLV_GET_LE16(buffer);
236 hdev->le_scan_window_connect = TLV_GET_LE16(buffer);
239 hdev->le_conn_min_interval = TLV_GET_LE16(buffer);
242 hdev->le_conn_max_interval = TLV_GET_LE16(buffer);
245 hdev->le_conn_latency = TLV_GET_LE16(buffer);
248 hdev->le_supv_timeout = TLV_GET_LE16(buffer);
251 hdev->def_le_autoconnect_timeout =
252 msecs_to_jiffies(TLV_GET_LE16(buffer));
255 bt_dev_warn(hdev, "unsupported parameter %u", type);
259 buffer_left -= exp_len;
263 return mgmt_cmd_complete(sk, hdev->id,
264 MGMT_OP_SET_DEF_SYSTEM_CONFIG, 0, NULL, 0);
267 int read_def_runtime_config(struct sock *sk, struct hci_dev *hdev, void *data,
270 bt_dev_dbg(hdev, "sock %p", sk);
272 return mgmt_cmd_complete(sk, hdev->id,
273 MGMT_OP_READ_DEF_RUNTIME_CONFIG, 0, NULL, 0);
276 int set_def_runtime_config(struct sock *sk, struct hci_dev *hdev, void *data,
279 bt_dev_dbg(hdev, "sock %p", sk);
281 return mgmt_cmd_status(sk, hdev->id, MGMT_OP_SET_DEF_SYSTEM_CONFIG,
282 MGMT_STATUS_INVALID_PARAMS);