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