wmi_unified_action_oui_tlv.c 8.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314
  1. /*
  2. * Copyright (c) 2016-2018, 2020 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2022-2023 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. #include "wmi_unified_action_oui_tlv.h"
  20. #include "wmi_unified_priv.h"
  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. case ACTION_OUI_CONNECT_1X1:
  26. *id = WMI_VENDOR_OUI_ACTION_CONNECTION_1X1;
  27. return true;
  28. case ACTION_OUI_ITO_EXTENSION:
  29. *id = WMI_VENDOR_OUI_ACTION_ITO_EXTENSION;
  30. return true;
  31. case ACTION_OUI_CCKM_1X1:
  32. *id = WMI_VENDOR_OUI_ACTION_CCKM_1X1;
  33. return true;
  34. case ACTION_OUI_ITO_ALTERNATE:
  35. *id = WMI_VENDOR_OUI_ACTION_ALT_ITO;
  36. return true;
  37. case ACTION_OUI_SWITCH_TO_11N_MODE:
  38. *id = WMI_VENDOR_OUI_ACTION_SWITCH_TO_11N_MODE;
  39. return true;
  40. case ACTION_OUI_CONNECT_1X1_WITH_1_CHAIN:
  41. *id = WMI_VENDOR_OUI_ACTION_CONNECTION_1X1_NUM_TX_RX_CHAINS_1;
  42. return true;
  43. case ACTION_OUI_DISABLE_AGGRESSIVE_TX:
  44. *id = WMI_VENDOR_OUI_ACTION_DISABLE_AGGRESSIVE_TX;
  45. return true;
  46. case ACTION_OUI_DISABLE_TWT:
  47. *id = WMI_VENDOR_OUI_ACTION_DISABLE_FW_TRIGGERED_TWT;
  48. return true;
  49. case ACTION_OUI_EXTEND_WOW_ITO:
  50. *id = WMI_VENDOR_OUI_ACTION_EXTEND_WOW_ITO;
  51. return true;
  52. case ACTION_OUI_11BE_OUI_ALLOW:
  53. *id = WMI_VENDOR_OUI_ACTION_ALLOW_11BE;
  54. return true;
  55. case ACTION_OUI_DISABLE_DYNAMIC_QOS_NULL_TX_RATE:
  56. *id = WMI_VENDOR_OUI_ACTION_DISABLE_DYNAMIC_QOS_NULL_TX_RATE;
  57. return true;
  58. case ACTION_OUI_ENABLE_CTS2SELF_WITH_QOS_NULL:
  59. *id = WMI_VENDOR_OUI_ACTION_ENABLE_CTS2SELF_WITH_QOS_NULL;
  60. return true;
  61. case ACTION_OUI_SEND_SMPS_FRAME_WITH_OMN:
  62. *id = WMI_VENDOR_OUI_ACTION_SEND_SMPS_FRAME_WITH_OMN;
  63. return true;
  64. default:
  65. return false;
  66. }
  67. }
  68. uint32_t wmi_get_action_oui_info_mask(uint32_t info_mask)
  69. {
  70. uint32_t info_presence = 0;
  71. if (info_mask & ACTION_OUI_INFO_OUI)
  72. info_presence |= WMI_BEACON_INFO_PRESENCE_OUI_EXT;
  73. if (info_mask & ACTION_OUI_INFO_MAC_ADDRESS)
  74. info_presence |= WMI_BEACON_INFO_PRESENCE_MAC_ADDRESS;
  75. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_NSS)
  76. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_NSS;
  77. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_HT)
  78. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_HT;
  79. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_VHT)
  80. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_VHT;
  81. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_BAND)
  82. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_BAND;
  83. return info_presence;
  84. }
  85. void wmi_fill_oui_extensions(struct action_oui_extension *extension,
  86. uint32_t no_oui_extns,
  87. wmi_vendor_oui_ext *cmd_ext)
  88. {
  89. uint32_t i;
  90. uint32_t buffer_length;
  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. cmd_ext->oui_header_length = extension->oui_length;
  98. cmd_ext->oui_data_length = extension->data_length;
  99. cmd_ext->mac_address_length = extension->mac_addr_length;
  100. cmd_ext->capability_data_length =
  101. extension->capability_length;
  102. buffer_length = extension->oui_length +
  103. extension->data_length +
  104. extension->data_mask_length +
  105. extension->mac_addr_length +
  106. extension->mac_mask_length +
  107. extension->capability_length;
  108. cmd_ext->buf_data_length = buffer_length + 1;
  109. cmd_ext++;
  110. extension++;
  111. }
  112. }
  113. QDF_STATUS
  114. wmi_fill_oui_extensions_buffer(struct action_oui_extension *extension,
  115. wmi_vendor_oui_ext *cmd_ext,
  116. uint32_t no_oui_extns, uint32_t rem_var_buf_len,
  117. uint8_t *var_buf)
  118. {
  119. uint8_t i;
  120. for (i = 0; i < (uint8_t)no_oui_extns; i++) {
  121. if ((rem_var_buf_len - cmd_ext->buf_data_length) < 0) {
  122. wmi_err("Invalid action oui command length");
  123. return QDF_STATUS_E_INVAL;
  124. }
  125. var_buf[0] = i;
  126. var_buf++;
  127. if (extension->oui_length) {
  128. qdf_mem_copy(var_buf, extension->oui,
  129. extension->oui_length);
  130. var_buf += extension->oui_length;
  131. }
  132. if (extension->data_length) {
  133. qdf_mem_copy(var_buf, extension->data,
  134. extension->data_length);
  135. var_buf += extension->data_length;
  136. }
  137. if (extension->data_mask_length) {
  138. qdf_mem_copy(var_buf, extension->data_mask,
  139. extension->data_mask_length);
  140. var_buf += extension->data_mask_length;
  141. }
  142. if (extension->mac_addr_length) {
  143. qdf_mem_copy(var_buf, extension->mac_addr,
  144. extension->mac_addr_length);
  145. var_buf += extension->mac_addr_length;
  146. }
  147. if (extension->mac_mask_length) {
  148. qdf_mem_copy(var_buf, extension->mac_mask,
  149. extension->mac_mask_length);
  150. var_buf += extension->mac_mask_length;
  151. }
  152. if (extension->capability_length) {
  153. qdf_mem_copy(var_buf, extension->capability,
  154. extension->capability_length);
  155. var_buf += extension->capability_length;
  156. }
  157. rem_var_buf_len -= cmd_ext->buf_data_length;
  158. cmd_ext++;
  159. extension++;
  160. }
  161. return QDF_STATUS_SUCCESS;
  162. }
  163. QDF_STATUS
  164. send_action_oui_cmd_tlv(wmi_unified_t wmi_handle,
  165. struct action_oui_request *req)
  166. {
  167. wmi_pdev_config_vendor_oui_action_fixed_param *cmd;
  168. wmi_vendor_oui_ext *cmd_ext;
  169. wmi_buf_t wmi_buf;
  170. struct action_oui_extension *extension;
  171. uint32_t len;
  172. uint32_t i;
  173. uint8_t *buf_ptr;
  174. uint32_t no_oui_extns;
  175. uint32_t total_no_oui_extns;
  176. uint32_t var_buf_len = 0;
  177. wmi_vendor_oui_action_id action_id;
  178. bool valid;
  179. uint32_t rem_var_buf_len;
  180. QDF_STATUS status;
  181. if (!req) {
  182. wmi_err("action oui is empty");
  183. return QDF_STATUS_E_INVAL;
  184. }
  185. no_oui_extns = req->no_oui_extensions;
  186. total_no_oui_extns = req->total_no_oui_extensions;
  187. len = sizeof(*cmd);
  188. len += WMI_TLV_HDR_SIZE; /* Array of wmi_vendor_oui_ext structures */
  189. if (no_oui_extns > WMI_MAX_VENDOR_OUI_ACTION_SUPPORTED_PER_ACTION ||
  190. (total_no_oui_extns > WMI_VENDOR_OUI_ACTION_MAX_ACTION_ID *
  191. WMI_MAX_VENDOR_OUI_ACTION_SUPPORTED_PER_ACTION)) {
  192. wmi_err("Invalid number of action oui extensions");
  193. return QDF_STATUS_E_INVAL;
  194. }
  195. valid = wmi_get_action_oui_id(req->action_id, &action_id);
  196. if (!valid) {
  197. wmi_err("Invalid action id");
  198. return QDF_STATUS_E_INVAL;
  199. }
  200. wmi_debug("wmi action_id %d num %d total_num %d", action_id,
  201. no_oui_extns, total_no_oui_extns);
  202. len += no_oui_extns * sizeof(*cmd_ext);
  203. len += WMI_TLV_HDR_SIZE; /* Variable length buffer */
  204. extension = req->extension;
  205. for (i = 0; i < no_oui_extns; i++) {
  206. var_buf_len += extension->oui_length +
  207. extension->data_length +
  208. extension->data_mask_length +
  209. extension->mac_addr_length +
  210. extension->mac_mask_length +
  211. extension->capability_length;
  212. extension++;
  213. }
  214. var_buf_len += no_oui_extns; /* to store indexes */
  215. rem_var_buf_len = var_buf_len;
  216. var_buf_len = (var_buf_len + 3) & ~0x3;
  217. len += var_buf_len;
  218. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  219. if (!wmi_buf) {
  220. wmi_err("Failed to allocate wmi buffer");
  221. return QDF_STATUS_E_FAILURE;
  222. }
  223. buf_ptr = (uint8_t *)wmi_buf_data(wmi_buf);
  224. cmd = (wmi_pdev_config_vendor_oui_action_fixed_param *)buf_ptr;
  225. WMITLV_SET_HDR(&cmd->tlv_header,
  226. WMITLV_TAG_STRUC_wmi_pdev_config_vendor_oui_action_fixed_param,
  227. WMITLV_GET_STRUCT_TLVLEN(
  228. wmi_pdev_config_vendor_oui_action_fixed_param));
  229. cmd->action_id = action_id;
  230. cmd->total_num_vendor_oui = total_no_oui_extns;
  231. cmd->num_vendor_oui_ext = no_oui_extns;
  232. buf_ptr += sizeof(*cmd);
  233. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  234. no_oui_extns * sizeof(*cmd_ext));
  235. buf_ptr += WMI_TLV_HDR_SIZE;
  236. cmd_ext = (wmi_vendor_oui_ext *)buf_ptr;
  237. wmi_fill_oui_extensions(req->extension, no_oui_extns, cmd_ext);
  238. buf_ptr += no_oui_extns * sizeof(*cmd_ext);
  239. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, var_buf_len);
  240. buf_ptr += WMI_TLV_HDR_SIZE;
  241. status = wmi_fill_oui_extensions_buffer(req->extension,
  242. cmd_ext, no_oui_extns,
  243. rem_var_buf_len, buf_ptr);
  244. if (!QDF_IS_STATUS_SUCCESS(status)) {
  245. wmi_buf_free(wmi_buf);
  246. wmi_buf = NULL;
  247. wmi_err("failed to fill oui ext status %d", status);
  248. return QDF_STATUS_E_INVAL;
  249. }
  250. buf_ptr += var_buf_len;
  251. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  252. WMI_PDEV_CONFIG_VENDOR_OUI_ACTION_CMDID)) {
  253. wmi_err("WMI_PDEV_CONFIG_VENDOR_OUI_ACTION send fail");
  254. wmi_buf_free(wmi_buf);
  255. wmi_buf = NULL;
  256. return QDF_STATUS_E_FAILURE;
  257. }
  258. return QDF_STATUS_SUCCESS;
  259. }