Back to home page

OSCL-LXR
 
 

     

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 
0003 /*
0004  * Copyright (C) 2020 Google Corporation
0005  */
0006 
0007 #include <net/bluetooth/bluetooth.h>
0008 #include <net/bluetooth/hci_core.h>
0009 #include <net/bluetooth/mgmt.h>
0010 
0011 #include "mgmt_util.h"
0012 #include "mgmt_config.h"
0013 
0014 #define HDEV_PARAM_U16(_param_name_) \
0015     struct {\
0016         struct mgmt_tlv entry; \
0017         __le16 value; \
0018     } __packed _param_name_
0019 
0020 #define HDEV_PARAM_U8(_param_name_) \
0021     struct {\
0022         struct mgmt_tlv entry; \
0023         __u8 value; \
0024     } __packed _param_name_
0025 
0026 #define TLV_SET_U16(_param_code_, _param_name_) \
0027     { \
0028         { cpu_to_le16(_param_code_), sizeof(__u16) }, \
0029         cpu_to_le16(hdev->_param_name_) \
0030     }
0031 
0032 #define TLV_SET_U8(_param_code_, _param_name_) \
0033     { \
0034         { cpu_to_le16(_param_code_), sizeof(__u8) }, \
0035         hdev->_param_name_ \
0036     }
0037 
0038 #define TLV_SET_U16_JIFFIES_TO_MSECS(_param_code_, _param_name_) \
0039     { \
0040         { cpu_to_le16(_param_code_), sizeof(__u16) }, \
0041         cpu_to_le16(jiffies_to_msecs(hdev->_param_name_)) \
0042     }
0043 
0044 int read_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data,
0045                u16 data_len)
0046 {
0047     int ret;
0048     struct mgmt_rp_read_def_system_config {
0049         /* Please see mgmt-api.txt for documentation of these values */
0050         HDEV_PARAM_U16(def_page_scan_type);
0051         HDEV_PARAM_U16(def_page_scan_int);
0052         HDEV_PARAM_U16(def_page_scan_window);
0053         HDEV_PARAM_U16(def_inq_scan_type);
0054         HDEV_PARAM_U16(def_inq_scan_int);
0055         HDEV_PARAM_U16(def_inq_scan_window);
0056         HDEV_PARAM_U16(def_br_lsto);
0057         HDEV_PARAM_U16(def_page_timeout);
0058         HDEV_PARAM_U16(sniff_min_interval);
0059         HDEV_PARAM_U16(sniff_max_interval);
0060         HDEV_PARAM_U16(le_adv_min_interval);
0061         HDEV_PARAM_U16(le_adv_max_interval);
0062         HDEV_PARAM_U16(def_multi_adv_rotation_duration);
0063         HDEV_PARAM_U16(le_scan_interval);
0064         HDEV_PARAM_U16(le_scan_window);
0065         HDEV_PARAM_U16(le_scan_int_suspend);
0066         HDEV_PARAM_U16(le_scan_window_suspend);
0067         HDEV_PARAM_U16(le_scan_int_discovery);
0068         HDEV_PARAM_U16(le_scan_window_discovery);
0069         HDEV_PARAM_U16(le_scan_int_adv_monitor);
0070         HDEV_PARAM_U16(le_scan_window_adv_monitor);
0071         HDEV_PARAM_U16(le_scan_int_connect);
0072         HDEV_PARAM_U16(le_scan_window_connect);
0073         HDEV_PARAM_U16(le_conn_min_interval);
0074         HDEV_PARAM_U16(le_conn_max_interval);
0075         HDEV_PARAM_U16(le_conn_latency);
0076         HDEV_PARAM_U16(le_supv_timeout);
0077         HDEV_PARAM_U16(def_le_autoconnect_timeout);
0078         HDEV_PARAM_U16(advmon_allowlist_duration);
0079         HDEV_PARAM_U16(advmon_no_filter_duration);
0080         HDEV_PARAM_U8(enable_advmon_interleave_scan);
0081     } __packed rp = {
0082         TLV_SET_U16(0x0000, def_page_scan_type),
0083         TLV_SET_U16(0x0001, def_page_scan_int),
0084         TLV_SET_U16(0x0002, def_page_scan_window),
0085         TLV_SET_U16(0x0003, def_inq_scan_type),
0086         TLV_SET_U16(0x0004, def_inq_scan_int),
0087         TLV_SET_U16(0x0005, def_inq_scan_window),
0088         TLV_SET_U16(0x0006, def_br_lsto),
0089         TLV_SET_U16(0x0007, def_page_timeout),
0090         TLV_SET_U16(0x0008, sniff_min_interval),
0091         TLV_SET_U16(0x0009, sniff_max_interval),
0092         TLV_SET_U16(0x000a, le_adv_min_interval),
0093         TLV_SET_U16(0x000b, le_adv_max_interval),
0094         TLV_SET_U16(0x000c, def_multi_adv_rotation_duration),
0095         TLV_SET_U16(0x000d, le_scan_interval),
0096         TLV_SET_U16(0x000e, le_scan_window),
0097         TLV_SET_U16(0x000f, le_scan_int_suspend),
0098         TLV_SET_U16(0x0010, le_scan_window_suspend),
0099         TLV_SET_U16(0x0011, le_scan_int_discovery),
0100         TLV_SET_U16(0x0012, le_scan_window_discovery),
0101         TLV_SET_U16(0x0013, le_scan_int_adv_monitor),
0102         TLV_SET_U16(0x0014, le_scan_window_adv_monitor),
0103         TLV_SET_U16(0x0015, le_scan_int_connect),
0104         TLV_SET_U16(0x0016, le_scan_window_connect),
0105         TLV_SET_U16(0x0017, le_conn_min_interval),
0106         TLV_SET_U16(0x0018, le_conn_max_interval),
0107         TLV_SET_U16(0x0019, le_conn_latency),
0108         TLV_SET_U16(0x001a, le_supv_timeout),
0109         TLV_SET_U16_JIFFIES_TO_MSECS(0x001b,
0110                          def_le_autoconnect_timeout),
0111         TLV_SET_U16(0x001d, advmon_allowlist_duration),
0112         TLV_SET_U16(0x001e, advmon_no_filter_duration),
0113         TLV_SET_U8(0x001f, enable_advmon_interleave_scan),
0114     };
0115 
0116     bt_dev_dbg(hdev, "sock %p", sk);
0117 
0118     ret = mgmt_cmd_complete(sk, hdev->id,
0119                 MGMT_OP_READ_DEF_SYSTEM_CONFIG,
0120                 0, &rp, sizeof(rp));
0121     return ret;
0122 }
0123 
0124 #define TO_TLV(x)       ((struct mgmt_tlv *)(x))
0125 #define TLV_GET_LE16(tlv)   le16_to_cpu(*((__le16 *)(TO_TLV(tlv)->value)))
0126 #define TLV_GET_U8(tlv)     (*((__u8 *)(TO_TLV(tlv)->value)))
0127 
0128 int set_def_system_config(struct sock *sk, struct hci_dev *hdev, void *data,
0129               u16 data_len)
0130 {
0131     u16 buffer_left = data_len;
0132     u8 *buffer = data;
0133 
0134     if (buffer_left < sizeof(struct mgmt_tlv)) {
0135         return mgmt_cmd_status(sk, hdev->id,
0136                        MGMT_OP_SET_DEF_SYSTEM_CONFIG,
0137                        MGMT_STATUS_INVALID_PARAMS);
0138     }
0139 
0140     /* First pass to validate the tlv */
0141     while (buffer_left >= sizeof(struct mgmt_tlv)) {
0142         const u8 len = TO_TLV(buffer)->length;
0143         size_t exp_type_len;
0144         const u16 exp_len = sizeof(struct mgmt_tlv) +
0145                     len;
0146         const u16 type = le16_to_cpu(TO_TLV(buffer)->type);
0147 
0148         if (buffer_left < exp_len) {
0149             bt_dev_warn(hdev, "invalid len left %u, exp >= %u",
0150                     buffer_left, exp_len);
0151 
0152             return mgmt_cmd_status(sk, hdev->id,
0153                     MGMT_OP_SET_DEF_SYSTEM_CONFIG,
0154                     MGMT_STATUS_INVALID_PARAMS);
0155         }
0156 
0157         /* Please see mgmt-api.txt for documentation of these values */
0158         switch (type) {
0159         case 0x0000:
0160         case 0x0001:
0161         case 0x0002:
0162         case 0x0003:
0163         case 0x0004:
0164         case 0x0005:
0165         case 0x0006:
0166         case 0x0007:
0167         case 0x0008:
0168         case 0x0009:
0169         case 0x000a:
0170         case 0x000b:
0171         case 0x000c:
0172         case 0x000d:
0173         case 0x000e:
0174         case 0x000f:
0175         case 0x0010:
0176         case 0x0011:
0177         case 0x0012:
0178         case 0x0013:
0179         case 0x0014:
0180         case 0x0015:
0181         case 0x0016:
0182         case 0x0017:
0183         case 0x0018:
0184         case 0x0019:
0185         case 0x001a:
0186         case 0x001b:
0187         case 0x001d:
0188         case 0x001e:
0189             exp_type_len = sizeof(u16);
0190             break;
0191         case 0x001f:
0192             exp_type_len = sizeof(u8);
0193             break;
0194         default:
0195             exp_type_len = 0;
0196             bt_dev_warn(hdev, "unsupported parameter %u", type);
0197             break;
0198         }
0199 
0200         if (exp_type_len && len != exp_type_len) {
0201             bt_dev_warn(hdev, "invalid length %d, exp %zu for type %u",
0202                     len, exp_type_len, type);
0203 
0204             return mgmt_cmd_status(sk, hdev->id,
0205                 MGMT_OP_SET_DEF_SYSTEM_CONFIG,
0206                 MGMT_STATUS_INVALID_PARAMS);
0207         }
0208 
0209         buffer_left -= exp_len;
0210         buffer += exp_len;
0211     }
0212 
0213     buffer_left = data_len;
0214     buffer = data;
0215     while (buffer_left >= sizeof(struct mgmt_tlv)) {
0216         const u8 len = TO_TLV(buffer)->length;
0217         const u16 exp_len = sizeof(struct mgmt_tlv) +
0218                     len;
0219         const u16 type = le16_to_cpu(TO_TLV(buffer)->type);
0220 
0221         switch (type) {
0222         case 0x0000:
0223             hdev->def_page_scan_type = TLV_GET_LE16(buffer);
0224             break;
0225         case 0x0001:
0226             hdev->def_page_scan_int = TLV_GET_LE16(buffer);
0227             break;
0228         case 0x0002:
0229             hdev->def_page_scan_window = TLV_GET_LE16(buffer);
0230             break;
0231         case 0x0003:
0232             hdev->def_inq_scan_type = TLV_GET_LE16(buffer);
0233             break;
0234         case 0x0004:
0235             hdev->def_inq_scan_int = TLV_GET_LE16(buffer);
0236             break;
0237         case 0x0005:
0238             hdev->def_inq_scan_window = TLV_GET_LE16(buffer);
0239             break;
0240         case 0x0006:
0241             hdev->def_br_lsto = TLV_GET_LE16(buffer);
0242             break;
0243         case 0x0007:
0244             hdev->def_page_timeout = TLV_GET_LE16(buffer);
0245             break;
0246         case 0x0008:
0247             hdev->sniff_min_interval = TLV_GET_LE16(buffer);
0248             break;
0249         case 0x0009:
0250             hdev->sniff_max_interval = TLV_GET_LE16(buffer);
0251             break;
0252         case 0x000a:
0253             hdev->le_adv_min_interval = TLV_GET_LE16(buffer);
0254             break;
0255         case 0x000b:
0256             hdev->le_adv_max_interval = TLV_GET_LE16(buffer);
0257             break;
0258         case 0x000c:
0259             hdev->def_multi_adv_rotation_duration =
0260                                TLV_GET_LE16(buffer);
0261             break;
0262         case 0x000d:
0263             hdev->le_scan_interval = TLV_GET_LE16(buffer);
0264             break;
0265         case 0x000e:
0266             hdev->le_scan_window = TLV_GET_LE16(buffer);
0267             break;
0268         case 0x000f:
0269             hdev->le_scan_int_suspend = TLV_GET_LE16(buffer);
0270             break;
0271         case 0x0010:
0272             hdev->le_scan_window_suspend = TLV_GET_LE16(buffer);
0273             break;
0274         case 0x0011:
0275             hdev->le_scan_int_discovery = TLV_GET_LE16(buffer);
0276             break;
0277         case 0x00012:
0278             hdev->le_scan_window_discovery = TLV_GET_LE16(buffer);
0279             break;
0280         case 0x00013:
0281             hdev->le_scan_int_adv_monitor = TLV_GET_LE16(buffer);
0282             break;
0283         case 0x00014:
0284             hdev->le_scan_window_adv_monitor = TLV_GET_LE16(buffer);
0285             break;
0286         case 0x00015:
0287             hdev->le_scan_int_connect = TLV_GET_LE16(buffer);
0288             break;
0289         case 0x00016:
0290             hdev->le_scan_window_connect = TLV_GET_LE16(buffer);
0291             break;
0292         case 0x00017:
0293             hdev->le_conn_min_interval = TLV_GET_LE16(buffer);
0294             break;
0295         case 0x00018:
0296             hdev->le_conn_max_interval = TLV_GET_LE16(buffer);
0297             break;
0298         case 0x00019:
0299             hdev->le_conn_latency = TLV_GET_LE16(buffer);
0300             break;
0301         case 0x0001a:
0302             hdev->le_supv_timeout = TLV_GET_LE16(buffer);
0303             break;
0304         case 0x0001b:
0305             hdev->def_le_autoconnect_timeout =
0306                     msecs_to_jiffies(TLV_GET_LE16(buffer));
0307             break;
0308         case 0x0001d:
0309             hdev->advmon_allowlist_duration = TLV_GET_LE16(buffer);
0310             break;
0311         case 0x0001e:
0312             hdev->advmon_no_filter_duration = TLV_GET_LE16(buffer);
0313             break;
0314         case 0x0001f:
0315             hdev->enable_advmon_interleave_scan = TLV_GET_U8(buffer);
0316             break;
0317         default:
0318             bt_dev_warn(hdev, "unsupported parameter %u", type);
0319             break;
0320         }
0321 
0322         buffer_left -= exp_len;
0323         buffer += exp_len;
0324     }
0325 
0326     return mgmt_cmd_complete(sk, hdev->id,
0327                  MGMT_OP_SET_DEF_SYSTEM_CONFIG, 0, NULL, 0);
0328 }
0329 
0330 int read_def_runtime_config(struct sock *sk, struct hci_dev *hdev, void *data,
0331                 u16 data_len)
0332 {
0333     bt_dev_dbg(hdev, "sock %p", sk);
0334 
0335     return mgmt_cmd_complete(sk, hdev->id,
0336                  MGMT_OP_READ_DEF_RUNTIME_CONFIG, 0, NULL, 0);
0337 }
0338 
0339 int set_def_runtime_config(struct sock *sk, struct hci_dev *hdev, void *data,
0340                u16 data_len)
0341 {
0342     bt_dev_dbg(hdev, "sock %p", sk);
0343 
0344     return mgmt_cmd_status(sk, hdev->id, MGMT_OP_SET_DEF_SYSTEM_CONFIG,
0345                    MGMT_STATUS_INVALID_PARAMS);
0346 }
[ Source navigation ] [ Diff markup ] [ Identifier search ] [ general search ]

This page was automatically generated by the 2.1.0 LXR engine.

The LXR team
Valid CSS 2.1! Valid HTML 4.01!