forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
346 lines
9.3 KiB
346 lines
9.3 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
|
|
/* |
|
* Copyright (C) 2020 Google Corporation |
|
*/ |
|
|
|
#include <net/bluetooth/bluetooth.h> |
|
#include <net/bluetooth/hci_core.h> |
|
#include <net/bluetooth/mgmt.h> |
|
|
|
#include "mgmt_util.h" |
|
#include "mgmt_config.h" |
|
|
|
#define HDEV_PARAM_U16(_param_name_) \ |
|
struct {\ |
|
struct mgmt_tlv entry; \ |
|
__le16 value; \ |
|
} __packed _param_name_ |
|
|
|
#define HDEV_PARAM_U8(_param_name_) \ |
|
struct {\ |
|
struct mgmt_tlv entry; \ |
|
__u8 value; \ |
|
} __packed _param_name_ |
|
|
|
#define TLV_SET_U16(_param_code_, _param_name_) \ |
|
{ \ |
|
{ cpu_to_le16(_param_code_), sizeof(__u16) }, \ |
|
cpu_to_le16(hdev->_param_name_) \ |
|
} |
|
|
|
#define TLV_SET_U8(_param_code_, _param_name_) \ |
|
{ \ |
|
{ cpu_to_le16(_param_code_), sizeof(__u8) }, \ |
|
hdev->_param_name_ \ |
|
} |
|
|
|
#define TLV_SET_U16_JIFFIES_TO_MSECS(_param_code_, _param_name_) \ |
|
{ \ |
|
{ cpu_to_le16(_param_code_), sizeof(__u16) }, \ |
|
cpu_to_le16(jiffies_to_msecs(hdev->_param_name_)) \ |
|
} |
|
|
|
int read_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data, |
|
u16 data_len) |
|
{ |
|
int ret; |
|
struct mgmt_rp_read_def_system_config { |
|
/* Please see mgmt-api.txt for documentation of these values */ |
|
HDEV_PARAM_U16(def_page_scan_type); |
|
HDEV_PARAM_U16(def_page_scan_int); |
|
HDEV_PARAM_U16(def_page_scan_window); |
|
HDEV_PARAM_U16(def_inq_scan_type); |
|
HDEV_PARAM_U16(def_inq_scan_int); |
|
HDEV_PARAM_U16(def_inq_scan_window); |
|
HDEV_PARAM_U16(def_br_lsto); |
|
HDEV_PARAM_U16(def_page_timeout); |
|
HDEV_PARAM_U16(sniff_min_interval); |
|
HDEV_PARAM_U16(sniff_max_interval); |
|
HDEV_PARAM_U16(le_adv_min_interval); |
|
HDEV_PARAM_U16(le_adv_max_interval); |
|
HDEV_PARAM_U16(def_multi_adv_rotation_duration); |
|
HDEV_PARAM_U16(le_scan_interval); |
|
HDEV_PARAM_U16(le_scan_window); |
|
HDEV_PARAM_U16(le_scan_int_suspend); |
|
HDEV_PARAM_U16(le_scan_window_suspend); |
|
HDEV_PARAM_U16(le_scan_int_discovery); |
|
HDEV_PARAM_U16(le_scan_window_discovery); |
|
HDEV_PARAM_U16(le_scan_int_adv_monitor); |
|
HDEV_PARAM_U16(le_scan_window_adv_monitor); |
|
HDEV_PARAM_U16(le_scan_int_connect); |
|
HDEV_PARAM_U16(le_scan_window_connect); |
|
HDEV_PARAM_U16(le_conn_min_interval); |
|
HDEV_PARAM_U16(le_conn_max_interval); |
|
HDEV_PARAM_U16(le_conn_latency); |
|
HDEV_PARAM_U16(le_supv_timeout); |
|
HDEV_PARAM_U16(def_le_autoconnect_timeout); |
|
HDEV_PARAM_U16(advmon_allowlist_duration); |
|
HDEV_PARAM_U16(advmon_no_filter_duration); |
|
HDEV_PARAM_U8(enable_advmon_interleave_scan); |
|
} __packed rp = { |
|
TLV_SET_U16(0x0000, def_page_scan_type), |
|
TLV_SET_U16(0x0001, def_page_scan_int), |
|
TLV_SET_U16(0x0002, def_page_scan_window), |
|
TLV_SET_U16(0x0003, def_inq_scan_type), |
|
TLV_SET_U16(0x0004, def_inq_scan_int), |
|
TLV_SET_U16(0x0005, def_inq_scan_window), |
|
TLV_SET_U16(0x0006, def_br_lsto), |
|
TLV_SET_U16(0x0007, def_page_timeout), |
|
TLV_SET_U16(0x0008, sniff_min_interval), |
|
TLV_SET_U16(0x0009, sniff_max_interval), |
|
TLV_SET_U16(0x000a, le_adv_min_interval), |
|
TLV_SET_U16(0x000b, le_adv_max_interval), |
|
TLV_SET_U16(0x000c, def_multi_adv_rotation_duration), |
|
TLV_SET_U16(0x000d, le_scan_interval), |
|
TLV_SET_U16(0x000e, le_scan_window), |
|
TLV_SET_U16(0x000f, le_scan_int_suspend), |
|
TLV_SET_U16(0x0010, le_scan_window_suspend), |
|
TLV_SET_U16(0x0011, le_scan_int_discovery), |
|
TLV_SET_U16(0x0012, le_scan_window_discovery), |
|
TLV_SET_U16(0x0013, le_scan_int_adv_monitor), |
|
TLV_SET_U16(0x0014, le_scan_window_adv_monitor), |
|
TLV_SET_U16(0x0015, le_scan_int_connect), |
|
TLV_SET_U16(0x0016, le_scan_window_connect), |
|
TLV_SET_U16(0x0017, le_conn_min_interval), |
|
TLV_SET_U16(0x0018, le_conn_max_interval), |
|
TLV_SET_U16(0x0019, le_conn_latency), |
|
TLV_SET_U16(0x001a, le_supv_timeout), |
|
TLV_SET_U16_JIFFIES_TO_MSECS(0x001b, |
|
def_le_autoconnect_timeout), |
|
TLV_SET_U16(0x001d, advmon_allowlist_duration), |
|
TLV_SET_U16(0x001e, advmon_no_filter_duration), |
|
TLV_SET_U8(0x001f, enable_advmon_interleave_scan), |
|
}; |
|
|
|
bt_dev_dbg(hdev, "sock %p", sk); |
|
|
|
ret = mgmt_cmd_complete(sk, hdev->id, |
|
MGMT_OP_READ_DEF_SYSTEM_CONFIG, |
|
0, &rp, sizeof(rp)); |
|
return ret; |
|
} |
|
|
|
#define TO_TLV(x) ((struct mgmt_tlv *)(x)) |
|
#define TLV_GET_LE16(tlv) le16_to_cpu(*((__le16 *)(TO_TLV(tlv)->value))) |
|
#define TLV_GET_U8(tlv) (*((__u8 *)(TO_TLV(tlv)->value))) |
|
|
|
int set_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data, |
|
u16 data_len) |
|
{ |
|
u16 buffer_left = data_len; |
|
u8 *buffer = data; |
|
|
|
if (buffer_left < sizeof(struct mgmt_tlv)) { |
|
return mgmt_cmd_status(sk, hdev->id, |
|
MGMT_OP_SET_DEF_SYSTEM_CONFIG, |
|
MGMT_STATUS_INVALID_PARAMS); |
|
} |
|
|
|
/* First pass to validate the tlv */ |
|
while (buffer_left >= sizeof(struct mgmt_tlv)) { |
|
const u8 len = TO_TLV(buffer)->length; |
|
size_t exp_type_len; |
|
const u16 exp_len = sizeof(struct mgmt_tlv) + |
|
len; |
|
const u16 type = le16_to_cpu(TO_TLV(buffer)->type); |
|
|
|
if (buffer_left < exp_len) { |
|
bt_dev_warn(hdev, "invalid len left %u, exp >= %u", |
|
buffer_left, exp_len); |
|
|
|
return mgmt_cmd_status(sk, hdev->id, |
|
MGMT_OP_SET_DEF_SYSTEM_CONFIG, |
|
MGMT_STATUS_INVALID_PARAMS); |
|
} |
|
|
|
/* Please see mgmt-api.txt for documentation of these values */ |
|
switch (type) { |
|
case 0x0000: |
|
case 0x0001: |
|
case 0x0002: |
|
case 0x0003: |
|
case 0x0004: |
|
case 0x0005: |
|
case 0x0006: |
|
case 0x0007: |
|
case 0x0008: |
|
case 0x0009: |
|
case 0x000a: |
|
case 0x000b: |
|
case 0x000c: |
|
case 0x000d: |
|
case 0x000e: |
|
case 0x000f: |
|
case 0x0010: |
|
case 0x0011: |
|
case 0x0012: |
|
case 0x0013: |
|
case 0x0014: |
|
case 0x0015: |
|
case 0x0016: |
|
case 0x0017: |
|
case 0x0018: |
|
case 0x0019: |
|
case 0x001a: |
|
case 0x001b: |
|
case 0x001d: |
|
case 0x001e: |
|
exp_type_len = sizeof(u16); |
|
break; |
|
case 0x001f: |
|
exp_type_len = sizeof(u8); |
|
break; |
|
default: |
|
exp_type_len = 0; |
|
bt_dev_warn(hdev, "unsupported parameter %u", type); |
|
break; |
|
} |
|
|
|
if (exp_type_len && len != exp_type_len) { |
|
bt_dev_warn(hdev, "invalid length %d, exp %zu for type %u", |
|
len, exp_type_len, type); |
|
|
|
return mgmt_cmd_status(sk, hdev->id, |
|
MGMT_OP_SET_DEF_SYSTEM_CONFIG, |
|
MGMT_STATUS_INVALID_PARAMS); |
|
} |
|
|
|
buffer_left -= exp_len; |
|
buffer += exp_len; |
|
} |
|
|
|
buffer_left = data_len; |
|
buffer = data; |
|
while (buffer_left >= sizeof(struct mgmt_tlv)) { |
|
const u8 len = TO_TLV(buffer)->length; |
|
const u16 exp_len = sizeof(struct mgmt_tlv) + |
|
len; |
|
const u16 type = le16_to_cpu(TO_TLV(buffer)->type); |
|
|
|
switch (type) { |
|
case 0x0000: |
|
hdev->def_page_scan_type = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0001: |
|
hdev->def_page_scan_int = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0002: |
|
hdev->def_page_scan_window = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0003: |
|
hdev->def_inq_scan_type = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0004: |
|
hdev->def_inq_scan_int = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0005: |
|
hdev->def_inq_scan_window = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0006: |
|
hdev->def_br_lsto = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0007: |
|
hdev->def_page_timeout = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0008: |
|
hdev->sniff_min_interval = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0009: |
|
hdev->sniff_max_interval = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x000a: |
|
hdev->le_adv_min_interval = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x000b: |
|
hdev->le_adv_max_interval = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x000c: |
|
hdev->def_multi_adv_rotation_duration = |
|
TLV_GET_LE16(buffer); |
|
break; |
|
case 0x000d: |
|
hdev->le_scan_interval = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x000e: |
|
hdev->le_scan_window = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x000f: |
|
hdev->le_scan_int_suspend = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0010: |
|
hdev->le_scan_window_suspend = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0011: |
|
hdev->le_scan_int_discovery = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00012: |
|
hdev->le_scan_window_discovery = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00013: |
|
hdev->le_scan_int_adv_monitor = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00014: |
|
hdev->le_scan_window_adv_monitor = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00015: |
|
hdev->le_scan_int_connect = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00016: |
|
hdev->le_scan_window_connect = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00017: |
|
hdev->le_conn_min_interval = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00018: |
|
hdev->le_conn_max_interval = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x00019: |
|
hdev->le_conn_latency = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0001a: |
|
hdev->le_supv_timeout = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0001b: |
|
hdev->def_le_autoconnect_timeout = |
|
msecs_to_jiffies(TLV_GET_LE16(buffer)); |
|
break; |
|
case 0x0001d: |
|
hdev->advmon_allowlist_duration = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0001e: |
|
hdev->advmon_no_filter_duration = TLV_GET_LE16(buffer); |
|
break; |
|
case 0x0001f: |
|
hdev->enable_advmon_interleave_scan = TLV_GET_U8(buffer); |
|
break; |
|
default: |
|
bt_dev_warn(hdev, "unsupported parameter %u", type); |
|
break; |
|
} |
|
|
|
buffer_left -= exp_len; |
|
buffer += exp_len; |
|
} |
|
|
|
return mgmt_cmd_complete(sk, hdev->id, |
|
MGMT_OP_SET_DEF_SYSTEM_CONFIG, 0, NULL, 0); |
|
} |
|
|
|
int read_def_runtime_config(struct sock *sk, struct hci_dev *hdev, void *data, |
|
u16 data_len) |
|
{ |
|
bt_dev_dbg(hdev, "sock %p", sk); |
|
|
|
return mgmt_cmd_complete(sk, hdev->id, |
|
MGMT_OP_READ_DEF_RUNTIME_CONFIG, 0, NULL, 0); |
|
} |
|
|
|
int set_def_runtime_config(struct sock *sk, struct hci_dev *hdev, void *data, |
|
u16 data_len) |
|
{ |
|
bt_dev_dbg(hdev, "sock %p", sk); |
|
|
|
return mgmt_cmd_status(sk, hdev->id, MGMT_OP_SET_DEF_SYSTEM_CONFIG, |
|
MGMT_STATUS_INVALID_PARAMS); |
|
}
|
|
|