1 /* 2 * Copyright (c) 2016-2018, 2020 The Linux Foundation. All rights reserved. 3 * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved. 4 * 5 * Permission to use, copy, modify, and/or distribute this software for 6 * any purpose with or without fee is hereby granted, provided that the 7 * above copyright notice and this permission notice appear in all 8 * copies. 9 * 10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL 11 * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED 12 * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE 13 * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL 14 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR 15 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER 16 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR 17 * PERFORMANCE OF THIS SOFTWARE. 18 */ 19 20 #include "wmi_unified_action_oui_tlv.h" 21 #include "wmi_unified_priv.h" 22 23 bool wmi_get_action_oui_id(enum action_oui_id action_id, 24 wmi_vendor_oui_action_id *id) 25 { 26 switch (action_id) { 27 28 case ACTION_OUI_CONNECT_1X1: 29 *id = WMI_VENDOR_OUI_ACTION_CONNECTION_1X1; 30 return true; 31 32 case ACTION_OUI_ITO_EXTENSION: 33 *id = WMI_VENDOR_OUI_ACTION_ITO_EXTENSION; 34 return true; 35 36 case ACTION_OUI_CCKM_1X1: 37 *id = WMI_VENDOR_OUI_ACTION_CCKM_1X1; 38 return true; 39 40 case ACTION_OUI_ITO_ALTERNATE: 41 *id = WMI_VENDOR_OUI_ACTION_ALT_ITO; 42 return true; 43 44 case ACTION_OUI_SWITCH_TO_11N_MODE: 45 *id = WMI_VENDOR_OUI_ACTION_SWITCH_TO_11N_MODE; 46 return true; 47 48 case ACTION_OUI_CONNECT_1X1_WITH_1_CHAIN: 49 *id = WMI_VENDOR_OUI_ACTION_CONNECTION_1X1_NUM_TX_RX_CHAINS_1; 50 return true; 51 52 case ACTION_OUI_DISABLE_AGGRESSIVE_TX: 53 *id = WMI_VENDOR_OUI_ACTION_DISABLE_AGGRESSIVE_TX; 54 return true; 55 56 case ACTION_OUI_DISABLE_TWT: 57 *id = WMI_VENDOR_OUI_ACTION_DISABLE_FW_TRIGGERED_TWT; 58 return true; 59 60 case ACTION_OUI_EXTEND_WOW_ITO: 61 *id = WMI_VENDOR_OUI_ACTION_EXTEND_WOW_ITO; 62 return true; 63 case ACTION_OUI_11BE_OUI_ALLOW: 64 *id = WMI_VENDOR_OUI_ACTION_ALLOW_11BE; 65 return true; 66 default: 67 return false; 68 } 69 } 70 71 uint32_t wmi_get_action_oui_info_mask(uint32_t info_mask) 72 { 73 uint32_t info_presence = 0; 74 75 if (info_mask & ACTION_OUI_INFO_OUI) 76 info_presence |= WMI_BEACON_INFO_PRESENCE_OUI_EXT; 77 78 if (info_mask & ACTION_OUI_INFO_MAC_ADDRESS) 79 info_presence |= WMI_BEACON_INFO_PRESENCE_MAC_ADDRESS; 80 81 if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_NSS) 82 info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_NSS; 83 84 if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_HT) 85 info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_HT; 86 87 if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_VHT) 88 info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_VHT; 89 90 if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_BAND) 91 info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_BAND; 92 93 return info_presence; 94 } 95 96 void wmi_fill_oui_extensions(struct action_oui_extension *extension, 97 uint32_t no_oui_extns, 98 wmi_vendor_oui_ext *cmd_ext) 99 { 100 uint32_t i; 101 uint32_t buffer_length; 102 103 for (i = 0; i < no_oui_extns; i++) { 104 WMITLV_SET_HDR(&cmd_ext->tlv_header, 105 WMITLV_TAG_STRUC_wmi_vendor_oui_ext, 106 WMITLV_GET_STRUCT_TLVLEN(wmi_vendor_oui_ext)); 107 cmd_ext->info_presence_bit_mask = 108 wmi_get_action_oui_info_mask(extension->info_mask); 109 110 cmd_ext->oui_header_length = extension->oui_length; 111 cmd_ext->oui_data_length = extension->data_length; 112 cmd_ext->mac_address_length = extension->mac_addr_length; 113 cmd_ext->capability_data_length = 114 extension->capability_length; 115 116 buffer_length = extension->oui_length + 117 extension->data_length + 118 extension->data_mask_length + 119 extension->mac_addr_length + 120 extension->mac_mask_length + 121 extension->capability_length; 122 123 cmd_ext->buf_data_length = buffer_length + 1; 124 125 cmd_ext++; 126 extension++; 127 } 128 129 } 130 131 QDF_STATUS 132 wmi_fill_oui_extensions_buffer(struct action_oui_extension *extension, 133 wmi_vendor_oui_ext *cmd_ext, 134 uint32_t no_oui_extns, uint32_t rem_var_buf_len, 135 uint8_t *var_buf) 136 { 137 uint8_t i; 138 139 for (i = 0; i < (uint8_t)no_oui_extns; i++) { 140 if ((rem_var_buf_len - cmd_ext->buf_data_length) < 0) { 141 wmi_err("Invalid action oui command length"); 142 return QDF_STATUS_E_INVAL; 143 } 144 145 var_buf[0] = i; 146 var_buf++; 147 148 if (extension->oui_length) { 149 qdf_mem_copy(var_buf, extension->oui, 150 extension->oui_length); 151 var_buf += extension->oui_length; 152 } 153 154 if (extension->data_length) { 155 qdf_mem_copy(var_buf, extension->data, 156 extension->data_length); 157 var_buf += extension->data_length; 158 } 159 160 if (extension->data_mask_length) { 161 qdf_mem_copy(var_buf, extension->data_mask, 162 extension->data_mask_length); 163 var_buf += extension->data_mask_length; 164 } 165 166 if (extension->mac_addr_length) { 167 qdf_mem_copy(var_buf, extension->mac_addr, 168 extension->mac_addr_length); 169 var_buf += extension->mac_addr_length; 170 } 171 172 if (extension->mac_mask_length) { 173 qdf_mem_copy(var_buf, extension->mac_mask, 174 extension->mac_mask_length); 175 var_buf += extension->mac_mask_length; 176 } 177 178 if (extension->capability_length) { 179 qdf_mem_copy(var_buf, extension->capability, 180 extension->capability_length); 181 var_buf += extension->capability_length; 182 } 183 184 rem_var_buf_len -= cmd_ext->buf_data_length; 185 cmd_ext++; 186 extension++; 187 } 188 189 return QDF_STATUS_SUCCESS; 190 } 191 192 QDF_STATUS 193 send_action_oui_cmd_tlv(wmi_unified_t wmi_handle, 194 struct action_oui_request *req) 195 { 196 wmi_pdev_config_vendor_oui_action_fixed_param *cmd; 197 wmi_vendor_oui_ext *cmd_ext; 198 wmi_buf_t wmi_buf; 199 struct action_oui_extension *extension; 200 uint32_t len; 201 uint32_t i; 202 uint8_t *buf_ptr; 203 uint32_t no_oui_extns; 204 uint32_t total_no_oui_extns; 205 uint32_t var_buf_len = 0; 206 wmi_vendor_oui_action_id action_id; 207 bool valid; 208 uint32_t rem_var_buf_len; 209 QDF_STATUS status; 210 211 if (!req) { 212 wmi_err("action oui is empty"); 213 return QDF_STATUS_E_INVAL; 214 } 215 216 no_oui_extns = req->no_oui_extensions; 217 total_no_oui_extns = req->total_no_oui_extensions; 218 219 len = sizeof(*cmd); 220 len += WMI_TLV_HDR_SIZE; /* Array of wmi_vendor_oui_ext structures */ 221 222 if (no_oui_extns > WMI_MAX_VENDOR_OUI_ACTION_SUPPORTED_PER_ACTION || 223 (total_no_oui_extns > WMI_VENDOR_OUI_ACTION_MAX_ACTION_ID * 224 WMI_MAX_VENDOR_OUI_ACTION_SUPPORTED_PER_ACTION)) { 225 wmi_err("Invalid number of action oui extensions"); 226 return QDF_STATUS_E_INVAL; 227 } 228 229 valid = wmi_get_action_oui_id(req->action_id, &action_id); 230 if (!valid) { 231 wmi_err("Invalid action id"); 232 return QDF_STATUS_E_INVAL; 233 } 234 wmi_debug("wmi action_id %d num %d total_num %d", action_id, 235 no_oui_extns, total_no_oui_extns); 236 237 len += no_oui_extns * sizeof(*cmd_ext); 238 len += WMI_TLV_HDR_SIZE; /* Variable length buffer */ 239 240 extension = req->extension; 241 for (i = 0; i < no_oui_extns; i++) { 242 var_buf_len += extension->oui_length + 243 extension->data_length + 244 extension->data_mask_length + 245 extension->mac_addr_length + 246 extension->mac_mask_length + 247 extension->capability_length; 248 extension++; 249 } 250 251 var_buf_len += no_oui_extns; /* to store indexes */ 252 rem_var_buf_len = var_buf_len; 253 var_buf_len = (var_buf_len + 3) & ~0x3; 254 len += var_buf_len; 255 256 wmi_buf = wmi_buf_alloc(wmi_handle, len); 257 if (!wmi_buf) { 258 wmi_err("Failed to allocate wmi buffer"); 259 return QDF_STATUS_E_FAILURE; 260 } 261 262 buf_ptr = (uint8_t *)wmi_buf_data(wmi_buf); 263 cmd = (wmi_pdev_config_vendor_oui_action_fixed_param *)buf_ptr; 264 265 WMITLV_SET_HDR(&cmd->tlv_header, 266 WMITLV_TAG_STRUC_wmi_pdev_config_vendor_oui_action_fixed_param, 267 WMITLV_GET_STRUCT_TLVLEN( 268 wmi_pdev_config_vendor_oui_action_fixed_param)); 269 270 cmd->action_id = action_id; 271 cmd->total_num_vendor_oui = total_no_oui_extns; 272 cmd->num_vendor_oui_ext = no_oui_extns; 273 274 buf_ptr += sizeof(*cmd); 275 WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 276 no_oui_extns * sizeof(*cmd_ext)); 277 buf_ptr += WMI_TLV_HDR_SIZE; 278 cmd_ext = (wmi_vendor_oui_ext *)buf_ptr; 279 wmi_fill_oui_extensions(req->extension, no_oui_extns, cmd_ext); 280 281 buf_ptr += no_oui_extns * sizeof(*cmd_ext); 282 WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, var_buf_len); 283 buf_ptr += WMI_TLV_HDR_SIZE; 284 status = wmi_fill_oui_extensions_buffer(req->extension, 285 cmd_ext, no_oui_extns, 286 rem_var_buf_len, buf_ptr); 287 if (!QDF_IS_STATUS_SUCCESS(status)) { 288 wmi_buf_free(wmi_buf); 289 wmi_buf = NULL; 290 wmi_err("failed to fill oui ext status %d", status); 291 return QDF_STATUS_E_INVAL; 292 } 293 294 buf_ptr += var_buf_len; 295 296 if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, 297 WMI_PDEV_CONFIG_VENDOR_OUI_ACTION_CMDID)) { 298 wmi_err("WMI_PDEV_CONFIG_VENDOR_OUI_ACTION send fail"); 299 wmi_buf_free(wmi_buf); 300 wmi_buf = NULL; 301 return QDF_STATUS_E_FAILURE; 302 } 303 304 return QDF_STATUS_SUCCESS; 305 } 306