117896406SAlain Michaud // SPDX-License-Identifier: GPL-2.0-only 217896406SAlain Michaud 317896406SAlain Michaud /* 417896406SAlain Michaud * Copyright (C) 2020 Google Corporation 517896406SAlain Michaud */ 617896406SAlain Michaud 717896406SAlain Michaud #include <net/bluetooth/bluetooth.h> 817896406SAlain Michaud #include <net/bluetooth/hci_core.h> 917896406SAlain Michaud #include <net/bluetooth/mgmt.h> 1017896406SAlain Michaud 1117896406SAlain Michaud #include "mgmt_util.h" 1217896406SAlain Michaud #include "mgmt_config.h" 1317896406SAlain Michaud 1417896406SAlain Michaud #define HDEV_PARAM_U16(_param_code_, _param_name_) \ 1517896406SAlain Michaud { \ 1617896406SAlain Michaud { cpu_to_le16(_param_code_), sizeof(__u16) }, \ 1717896406SAlain Michaud { cpu_to_le16(hdev->_param_name_) } \ 1817896406SAlain Michaud } 1917896406SAlain Michaud 2017896406SAlain Michaud int read_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data, 2117896406SAlain Michaud u16 data_len) 2217896406SAlain Michaud { 2317896406SAlain Michaud struct { 2417896406SAlain Michaud struct mgmt_tlv entry; 2517896406SAlain Michaud union { 2617896406SAlain Michaud /* This is a simplification for now since all values 2717896406SAlain Michaud * are 16 bits. In the future, this code may need 2817896406SAlain Michaud * refactoring to account for variable length values 2917896406SAlain Michaud * and properly calculate the required buffer size. 3017896406SAlain Michaud */ 3117896406SAlain Michaud __le16 value; 3217896406SAlain Michaud }; 3317896406SAlain Michaud } __packed params[] = { 3417896406SAlain Michaud /* Please see mgmt-api.txt for documentation of these values */ 3517896406SAlain Michaud HDEV_PARAM_U16(0x0000, def_page_scan_type), 3617896406SAlain Michaud HDEV_PARAM_U16(0x0001, def_page_scan_int), 3717896406SAlain Michaud HDEV_PARAM_U16(0x0002, def_page_scan_window), 3817896406SAlain Michaud HDEV_PARAM_U16(0x0003, def_inq_scan_type), 3917896406SAlain Michaud HDEV_PARAM_U16(0x0004, def_inq_scan_int), 4017896406SAlain Michaud HDEV_PARAM_U16(0x0005, def_inq_scan_window), 4117896406SAlain Michaud HDEV_PARAM_U16(0x0006, def_br_lsto), 4217896406SAlain Michaud HDEV_PARAM_U16(0x0007, def_page_timeout), 4317896406SAlain Michaud HDEV_PARAM_U16(0x0008, sniff_min_interval), 4417896406SAlain Michaud HDEV_PARAM_U16(0x0009, sniff_max_interval), 4517896406SAlain Michaud HDEV_PARAM_U16(0x000a, le_adv_min_interval), 4617896406SAlain Michaud HDEV_PARAM_U16(0x000b, le_adv_max_interval), 4717896406SAlain Michaud HDEV_PARAM_U16(0x000c, def_multi_adv_rotation_duration), 4817896406SAlain Michaud HDEV_PARAM_U16(0x000d, le_scan_interval), 4917896406SAlain Michaud HDEV_PARAM_U16(0x000e, le_scan_window), 5017896406SAlain Michaud HDEV_PARAM_U16(0x000f, le_scan_int_suspend), 5117896406SAlain Michaud HDEV_PARAM_U16(0x0010, le_scan_window_suspend), 5217896406SAlain Michaud HDEV_PARAM_U16(0x0011, le_scan_int_discovery), 5317896406SAlain Michaud HDEV_PARAM_U16(0x0012, le_scan_window_discovery), 5417896406SAlain Michaud HDEV_PARAM_U16(0x0013, le_scan_int_adv_monitor), 5517896406SAlain Michaud HDEV_PARAM_U16(0x0014, le_scan_window_adv_monitor), 5617896406SAlain Michaud HDEV_PARAM_U16(0x0015, le_scan_int_connect), 5717896406SAlain Michaud HDEV_PARAM_U16(0x0016, le_scan_window_connect), 5817896406SAlain Michaud HDEV_PARAM_U16(0x0017, le_conn_min_interval), 5917896406SAlain Michaud HDEV_PARAM_U16(0x0018, le_conn_max_interval), 6017896406SAlain Michaud HDEV_PARAM_U16(0x0019, le_conn_latency), 6117896406SAlain Michaud HDEV_PARAM_U16(0x001a, le_supv_timeout), 6217896406SAlain Michaud }; 6317896406SAlain Michaud struct mgmt_rp_read_def_system_config *rp = (void *)params; 6417896406SAlain Michaud 6517896406SAlain Michaud bt_dev_dbg(hdev, "sock %p", sk); 6617896406SAlain Michaud 6717896406SAlain Michaud return mgmt_cmd_complete(sk, hdev->id, 6817896406SAlain Michaud MGMT_OP_READ_DEF_SYSTEM_CONFIG, 6917896406SAlain Michaud 0, rp, sizeof(params)); 7017896406SAlain Michaud } 7117896406SAlain Michaud 7217896406SAlain Michaud #define TO_TLV(x) ((struct mgmt_tlv *)(x)) 7317896406SAlain Michaud #define TLV_GET_LE16(tlv) le16_to_cpu(*((__le16 *)(TO_TLV(tlv)->value))) 7417896406SAlain Michaud 7517896406SAlain Michaud int set_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data, 7617896406SAlain Michaud u16 data_len) 7717896406SAlain Michaud { 7817896406SAlain Michaud u16 buffer_left = data_len; 7917896406SAlain Michaud u8 *buffer = data; 8017896406SAlain Michaud 8117896406SAlain Michaud if (buffer_left < sizeof(struct mgmt_tlv)) { 8217896406SAlain Michaud return mgmt_cmd_status(sk, hdev->id, 8317896406SAlain Michaud MGMT_OP_SET_DEF_SYSTEM_CONFIG, 8417896406SAlain Michaud MGMT_STATUS_INVALID_PARAMS); 8517896406SAlain Michaud } 8617896406SAlain Michaud 8717896406SAlain Michaud /* First pass to validate the tlv */ 8817896406SAlain Michaud while (buffer_left >= sizeof(struct mgmt_tlv)) { 8917896406SAlain Michaud const u8 len = TO_TLV(buffer)->length; 9017896406SAlain Michaud const u16 exp_len = sizeof(struct mgmt_tlv) + 9117896406SAlain Michaud len; 9217896406SAlain Michaud const u16 type = le16_to_cpu(TO_TLV(buffer)->type); 9317896406SAlain Michaud 9417896406SAlain Michaud if (buffer_left < exp_len) { 9517896406SAlain Michaud bt_dev_warn(hdev, "invalid len left %d, exp >= %d", 9617896406SAlain Michaud buffer_left, exp_len); 9717896406SAlain Michaud 9817896406SAlain Michaud return mgmt_cmd_status(sk, hdev->id, 9917896406SAlain Michaud MGMT_OP_SET_DEF_SYSTEM_CONFIG, 10017896406SAlain Michaud MGMT_STATUS_INVALID_PARAMS); 10117896406SAlain Michaud } 10217896406SAlain Michaud 10317896406SAlain Michaud /* Please see mgmt-api.txt for documentation of these values */ 10417896406SAlain Michaud switch (type) { 10517896406SAlain Michaud case 0x0000: 10617896406SAlain Michaud case 0x0001: 10717896406SAlain Michaud case 0x0002: 10817896406SAlain Michaud case 0x0003: 10917896406SAlain Michaud case 0x0004: 11017896406SAlain Michaud case 0x0005: 11117896406SAlain Michaud case 0x0006: 11217896406SAlain Michaud case 0x0007: 11317896406SAlain Michaud case 0x0008: 11417896406SAlain Michaud case 0x0009: 11517896406SAlain Michaud case 0x000a: 11617896406SAlain Michaud case 0x000b: 11717896406SAlain Michaud case 0x000c: 11817896406SAlain Michaud case 0x000d: 11917896406SAlain Michaud case 0x000e: 12017896406SAlain Michaud case 0x000f: 12117896406SAlain Michaud case 0x0010: 12217896406SAlain Michaud case 0x0011: 12317896406SAlain Michaud case 0x0012: 12417896406SAlain Michaud case 0x0013: 12517896406SAlain Michaud case 0x0014: 12617896406SAlain Michaud case 0x0015: 12717896406SAlain Michaud case 0x0016: 12817896406SAlain Michaud case 0x0017: 12917896406SAlain Michaud case 0x0018: 13017896406SAlain Michaud case 0x0019: 13117896406SAlain Michaud case 0x001a: 13217896406SAlain Michaud if (len != sizeof(u16)) { 13317896406SAlain Michaud bt_dev_warn(hdev, "invalid length %d, exp %zu for type %d", 13417896406SAlain Michaud len, sizeof(u16), type); 13517896406SAlain Michaud 13617896406SAlain Michaud return mgmt_cmd_status(sk, hdev->id, 13717896406SAlain Michaud MGMT_OP_SET_DEF_SYSTEM_CONFIG, 13817896406SAlain Michaud MGMT_STATUS_INVALID_PARAMS); 13917896406SAlain Michaud } 14017896406SAlain Michaud break; 14117896406SAlain Michaud default: 14217896406SAlain Michaud bt_dev_warn(hdev, "unsupported parameter %u", type); 14317896406SAlain Michaud break; 14417896406SAlain Michaud } 14517896406SAlain Michaud 14617896406SAlain Michaud buffer_left -= exp_len; 14717896406SAlain Michaud buffer += exp_len; 14817896406SAlain Michaud } 14917896406SAlain Michaud 15017896406SAlain Michaud buffer_left = data_len; 15117896406SAlain Michaud buffer = data; 15217896406SAlain Michaud while (buffer_left >= sizeof(struct mgmt_tlv)) { 15317896406SAlain Michaud const u8 len = TO_TLV(buffer)->length; 15417896406SAlain Michaud const u16 exp_len = sizeof(struct mgmt_tlv) + 15517896406SAlain Michaud len; 15617896406SAlain Michaud const u16 type = le16_to_cpu(TO_TLV(buffer)->type); 15717896406SAlain Michaud 15817896406SAlain Michaud switch (type) { 15917896406SAlain Michaud case 0x0000: 16017896406SAlain Michaud hdev->def_page_scan_type = TLV_GET_LE16(buffer); 16117896406SAlain Michaud break; 16217896406SAlain Michaud case 0x0001: 16317896406SAlain Michaud hdev->def_page_scan_int = TLV_GET_LE16(buffer); 16417896406SAlain Michaud break; 16517896406SAlain Michaud case 0x0002: 16617896406SAlain Michaud hdev->def_page_scan_window = TLV_GET_LE16(buffer); 16717896406SAlain Michaud break; 16817896406SAlain Michaud case 0x0003: 16917896406SAlain Michaud hdev->def_inq_scan_type = TLV_GET_LE16(buffer); 17017896406SAlain Michaud break; 17117896406SAlain Michaud case 0x0004: 17217896406SAlain Michaud hdev->def_inq_scan_int = TLV_GET_LE16(buffer); 17317896406SAlain Michaud break; 17417896406SAlain Michaud case 0x0005: 17517896406SAlain Michaud hdev->def_inq_scan_window = TLV_GET_LE16(buffer); 17617896406SAlain Michaud break; 17717896406SAlain Michaud case 0x0006: 17817896406SAlain Michaud hdev->def_br_lsto = TLV_GET_LE16(buffer); 17917896406SAlain Michaud break; 18017896406SAlain Michaud case 0x0007: 18117896406SAlain Michaud hdev->def_page_timeout = TLV_GET_LE16(buffer); 18217896406SAlain Michaud break; 18317896406SAlain Michaud case 0x0008: 18417896406SAlain Michaud hdev->sniff_min_interval = TLV_GET_LE16(buffer); 18517896406SAlain Michaud break; 18617896406SAlain Michaud case 0x0009: 18717896406SAlain Michaud hdev->sniff_max_interval = TLV_GET_LE16(buffer); 18817896406SAlain Michaud break; 18917896406SAlain Michaud case 0x000a: 19017896406SAlain Michaud hdev->le_adv_min_interval = TLV_GET_LE16(buffer); 19117896406SAlain Michaud break; 19217896406SAlain Michaud case 0x000b: 19317896406SAlain Michaud hdev->le_adv_max_interval = TLV_GET_LE16(buffer); 19417896406SAlain Michaud break; 19517896406SAlain Michaud case 0x000c: 19617896406SAlain Michaud hdev->def_multi_adv_rotation_duration = 19717896406SAlain Michaud TLV_GET_LE16(buffer); 19817896406SAlain Michaud break; 19917896406SAlain Michaud case 0x000d: 20017896406SAlain Michaud hdev->le_scan_interval = TLV_GET_LE16(buffer); 20117896406SAlain Michaud break; 20217896406SAlain Michaud case 0x000e: 20317896406SAlain Michaud hdev->le_scan_window = TLV_GET_LE16(buffer); 20417896406SAlain Michaud break; 20517896406SAlain Michaud case 0x000f: 20617896406SAlain Michaud hdev->le_scan_int_suspend = TLV_GET_LE16(buffer); 20717896406SAlain Michaud break; 20817896406SAlain Michaud case 0x0010: 20917896406SAlain Michaud hdev->le_scan_window_suspend = TLV_GET_LE16(buffer); 21017896406SAlain Michaud break; 21117896406SAlain Michaud case 0x0011: 21217896406SAlain Michaud hdev->le_scan_int_discovery = TLV_GET_LE16(buffer); 21317896406SAlain Michaud break; 21417896406SAlain Michaud case 0x00012: 21517896406SAlain Michaud hdev->le_scan_window_discovery = TLV_GET_LE16(buffer); 21617896406SAlain Michaud break; 21717896406SAlain Michaud case 0x00013: 21817896406SAlain Michaud hdev->le_scan_int_adv_monitor = TLV_GET_LE16(buffer); 21917896406SAlain Michaud break; 22017896406SAlain Michaud case 0x00014: 22117896406SAlain Michaud hdev->le_scan_window_adv_monitor = TLV_GET_LE16(buffer); 22217896406SAlain Michaud break; 22317896406SAlain Michaud case 0x00015: 22417896406SAlain Michaud hdev->le_scan_int_connect = TLV_GET_LE16(buffer); 22517896406SAlain Michaud break; 22617896406SAlain Michaud case 0x00016: 22717896406SAlain Michaud hdev->le_scan_window_connect = TLV_GET_LE16(buffer); 22817896406SAlain Michaud break; 22917896406SAlain Michaud case 0x00017: 23017896406SAlain Michaud hdev->le_conn_min_interval = TLV_GET_LE16(buffer); 23117896406SAlain Michaud break; 23217896406SAlain Michaud case 0x00018: 23317896406SAlain Michaud hdev->le_conn_max_interval = TLV_GET_LE16(buffer); 23417896406SAlain Michaud break; 23517896406SAlain Michaud case 0x00019: 23617896406SAlain Michaud hdev->le_conn_latency = TLV_GET_LE16(buffer); 23717896406SAlain Michaud break; 23817896406SAlain Michaud case 0x0001a: 23917896406SAlain Michaud hdev->le_supv_timeout = TLV_GET_LE16(buffer); 24017896406SAlain Michaud break; 24117896406SAlain Michaud default: 24217896406SAlain Michaud bt_dev_warn(hdev, "unsupported parameter %u", type); 24317896406SAlain Michaud break; 24417896406SAlain Michaud } 24517896406SAlain Michaud 24617896406SAlain Michaud buffer_left -= exp_len; 24717896406SAlain Michaud buffer += exp_len; 24817896406SAlain Michaud } 24917896406SAlain Michaud 25017896406SAlain Michaud return mgmt_cmd_status(sk, hdev->id, 25117896406SAlain Michaud MGMT_OP_SET_DEF_SYSTEM_CONFIG, 25217896406SAlain Michaud MGMT_STATUS_SUCCESS); 25317896406SAlain Michaud } 254