wmi_unified_action_oui_tlv.c 7.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277
  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. #include "wmi_unified_action_oui_tlv.h"
  19. bool wmi_get_action_oui_id(enum action_oui_id action_id,
  20. wmi_vendor_oui_action_id *id)
  21. {
  22. switch (action_id) {
  23. case ACTION_OUI_CONNECT_1X1:
  24. *id = WMI_VENDOR_OUI_ACTION_CONNECTION_1X1;
  25. return true;
  26. case ACTION_OUI_ITO_EXTENSION:
  27. *id = WMI_VENDOR_OUI_ACTION_ITO_EXTENSION;
  28. return true;
  29. case ACTION_OUI_CCKM_1X1:
  30. *id = WMI_VENDOR_OUI_ACTION_CCKM_1X1;
  31. return true;
  32. case ACTION_OUI_ITO_ALTERNATE:
  33. *id = WMI_VENDOR_OUI_ACTION_ALT_ITO;
  34. return true;
  35. case ACTION_OUI_SWITCH_TO_11N_MODE:
  36. *id = WMI_VENDOR_OUI_ACTION_SWITCH_TO_11N_MODE;
  37. return true;
  38. default:
  39. return false;
  40. }
  41. }
  42. uint32_t wmi_get_action_oui_info_mask(uint32_t info_mask)
  43. {
  44. uint32_t info_presence = WMI_BEACON_INFO_PRESENCE_OUI_EXT;
  45. if (info_mask & ACTION_OUI_INFO_MAC_ADDRESS)
  46. info_presence |= WMI_BEACON_INFO_PRESENCE_MAC_ADDRESS;
  47. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_NSS)
  48. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_NSS;
  49. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_HT)
  50. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_HT;
  51. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_VHT)
  52. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_VHT;
  53. if (info_mask & ACTION_OUI_INFO_AP_CAPABILITY_BAND)
  54. info_presence |= WMI_BEACON_INFO_PRESENCE_AP_CAPABILITY_BAND;
  55. return info_presence;
  56. }
  57. void wmi_fill_oui_extensions(struct action_oui_extension *extension,
  58. uint32_t no_oui_extns,
  59. wmi_vendor_oui_ext *cmd_ext)
  60. {
  61. uint32_t i;
  62. uint32_t buffer_length;
  63. for (i = 0; i < no_oui_extns; i++) {
  64. WMITLV_SET_HDR(&cmd_ext->tlv_header,
  65. WMITLV_TAG_STRUC_wmi_vendor_oui_ext,
  66. WMITLV_GET_STRUCT_TLVLEN(wmi_vendor_oui_ext));
  67. cmd_ext->info_presence_bit_mask =
  68. wmi_get_action_oui_info_mask(extension->info_mask);
  69. cmd_ext->oui_header_length = extension->oui_length;
  70. cmd_ext->oui_data_length = extension->data_length;
  71. cmd_ext->mac_address_length = extension->mac_addr_length;
  72. cmd_ext->capability_data_length =
  73. extension->capability_length;
  74. buffer_length = extension->oui_length +
  75. extension->data_length +
  76. extension->data_mask_length +
  77. extension->mac_addr_length +
  78. extension->mac_mask_length +
  79. extension->capability_length;
  80. cmd_ext->buf_data_length = buffer_length + 1;
  81. cmd_ext++;
  82. extension++;
  83. }
  84. }
  85. QDF_STATUS
  86. wmi_fill_oui_extensions_buffer(struct action_oui_extension *extension,
  87. wmi_vendor_oui_ext *cmd_ext,
  88. uint32_t no_oui_extns, uint32_t rem_var_buf_len,
  89. uint8_t *var_buf)
  90. {
  91. uint8_t i;
  92. for (i = 0; i < (uint8_t)no_oui_extns; i++) {
  93. if ((rem_var_buf_len - cmd_ext->buf_data_length) < 0) {
  94. WMI_LOGE(FL("Invalid action oui command length"));
  95. return QDF_STATUS_E_INVAL;
  96. }
  97. var_buf[0] = i;
  98. var_buf++;
  99. qdf_mem_copy(var_buf, extension->oui, extension->oui_length);
  100. var_buf += extension->oui_length;
  101. if (extension->data_length) {
  102. qdf_mem_copy(var_buf, extension->data,
  103. extension->data_length);
  104. var_buf += extension->data_length;
  105. }
  106. if (extension->data_mask_length) {
  107. qdf_mem_copy(var_buf, extension->data_mask,
  108. extension->data_mask_length);
  109. var_buf += extension->data_mask_length;
  110. }
  111. if (extension->mac_addr_length) {
  112. qdf_mem_copy(var_buf, extension->mac_addr,
  113. extension->mac_addr_length);
  114. var_buf += extension->mac_addr_length;
  115. }
  116. if (extension->mac_mask_length) {
  117. qdf_mem_copy(var_buf, extension->mac_mask,
  118. extension->mac_mask_length);
  119. var_buf += extension->mac_mask_length;
  120. }
  121. if (extension->capability_length) {
  122. qdf_mem_copy(var_buf, extension->capability,
  123. extension->capability_length);
  124. var_buf += extension->capability_length;
  125. }
  126. rem_var_buf_len -= cmd_ext->buf_data_length;
  127. cmd_ext++;
  128. extension++;
  129. }
  130. return QDF_STATUS_SUCCESS;
  131. }
  132. QDF_STATUS
  133. send_action_oui_cmd_tlv(wmi_unified_t wmi_handle,
  134. struct action_oui_request *req)
  135. {
  136. wmi_pdev_config_vendor_oui_action_fixed_param *cmd;
  137. wmi_vendor_oui_ext *cmd_ext;
  138. wmi_buf_t wmi_buf;
  139. struct action_oui_extension *extension;
  140. uint32_t len;
  141. uint32_t i;
  142. uint8_t *buf_ptr;
  143. uint32_t no_oui_extns;
  144. uint32_t total_no_oui_extns;
  145. uint32_t var_buf_len = 0;
  146. wmi_vendor_oui_action_id action_id;
  147. bool valid;
  148. uint32_t rem_var_buf_len;
  149. QDF_STATUS status;
  150. if (!req) {
  151. WMI_LOGE(FL("action oui is empty"));
  152. return QDF_STATUS_E_INVAL;
  153. }
  154. no_oui_extns = req->no_oui_extensions;
  155. total_no_oui_extns = req->total_no_oui_extensions;
  156. len = sizeof(*cmd);
  157. len += WMI_TLV_HDR_SIZE; /* Array of wmi_vendor_oui_ext structures */
  158. if (!no_oui_extns ||
  159. no_oui_extns > WMI_MAX_VENDOR_OUI_ACTION_SUPPORTED_PER_ACTION ||
  160. (total_no_oui_extns > WMI_VENDOR_OUI_ACTION_MAX_ACTION_ID *
  161. WMI_MAX_VENDOR_OUI_ACTION_SUPPORTED_PER_ACTION)) {
  162. WMI_LOGE(FL("Invalid number of action oui extensions"));
  163. return QDF_STATUS_E_INVAL;
  164. }
  165. valid = wmi_get_action_oui_id(req->action_id, &action_id);
  166. if (!valid) {
  167. WMI_LOGE(FL("Invalid action id"));
  168. return QDF_STATUS_E_INVAL;
  169. }
  170. len += no_oui_extns * sizeof(*cmd_ext);
  171. len += WMI_TLV_HDR_SIZE; /* Variable length buffer */
  172. extension = req->extension;
  173. for (i = 0; i < no_oui_extns; i++) {
  174. var_buf_len += extension->oui_length +
  175. extension->data_length +
  176. extension->data_mask_length +
  177. extension->mac_addr_length +
  178. extension->mac_mask_length +
  179. extension->capability_length;
  180. extension++;
  181. }
  182. var_buf_len += no_oui_extns; /* to store indexes */
  183. rem_var_buf_len = var_buf_len;
  184. var_buf_len = (var_buf_len + 3) & ~0x3;
  185. len += var_buf_len;
  186. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  187. if (!wmi_buf) {
  188. WMI_LOGE(FL("Failed to allocate wmi buffer"));
  189. return QDF_STATUS_E_FAILURE;
  190. }
  191. buf_ptr = (uint8_t *)wmi_buf_data(wmi_buf);
  192. cmd = (wmi_pdev_config_vendor_oui_action_fixed_param *)buf_ptr;
  193. WMITLV_SET_HDR(&cmd->tlv_header,
  194. WMITLV_TAG_STRUC_wmi_pdev_config_vendor_oui_action_fixed_param,
  195. WMITLV_GET_STRUCT_TLVLEN(
  196. wmi_pdev_config_vendor_oui_action_fixed_param));
  197. cmd->action_id = action_id;
  198. cmd->total_num_vendor_oui = total_no_oui_extns;
  199. cmd->num_vendor_oui_ext = no_oui_extns;
  200. buf_ptr += sizeof(*cmd);
  201. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  202. no_oui_extns * sizeof(*cmd_ext));
  203. buf_ptr += WMI_TLV_HDR_SIZE;
  204. cmd_ext = (wmi_vendor_oui_ext *)buf_ptr;
  205. wmi_fill_oui_extensions(req->extension, no_oui_extns, cmd_ext);
  206. buf_ptr += no_oui_extns * sizeof(*cmd_ext);
  207. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, var_buf_len);
  208. buf_ptr += WMI_TLV_HDR_SIZE;
  209. status = wmi_fill_oui_extensions_buffer(req->extension,
  210. cmd_ext, no_oui_extns,
  211. rem_var_buf_len, buf_ptr);
  212. if (!QDF_IS_STATUS_SUCCESS(status)) {
  213. wmi_buf_free(wmi_buf);
  214. wmi_buf = NULL;
  215. return QDF_STATUS_E_INVAL;
  216. }
  217. buf_ptr += var_buf_len;
  218. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  219. WMI_PDEV_CONFIG_VENDOR_OUI_ACTION_CMDID)) {
  220. WMI_LOGE(FL("WMI_PDEV_CONFIG_VENDOR_OUI_ACTION send fail"));
  221. wmi_buf_free(wmi_buf);
  222. wmi_buf = NULL;
  223. return QDF_STATUS_E_FAILURE;
  224. }
  225. return QDF_STATUS_SUCCESS;
  226. }