wmi_unified_pmo_tlv.c 58 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958
  1. /*
  2. * Copyright (c) 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 <osdep.h>
  19. #include "wmi.h"
  20. #include "wmi_unified_priv.h"
  21. #include "wmi_unified_pmo_api.h"
  22. #ifdef FEATURE_WLAN_D0WOW
  23. /**
  24. * send_d0wow_enable_cmd_tlv() - WMI d0 wow enable function
  25. * @param wmi_handle: handle to WMI.
  26. * @mac_id: radio context
  27. *
  28. * Return: 0 on success and error code on failure.
  29. */
  30. static QDF_STATUS send_d0wow_enable_cmd_tlv(wmi_unified_t wmi_handle,
  31. uint8_t mac_id)
  32. {
  33. wmi_d0_wow_enable_disable_cmd_fixed_param *cmd;
  34. wmi_buf_t buf;
  35. int32_t len;
  36. QDF_STATUS status;
  37. len = sizeof(wmi_d0_wow_enable_disable_cmd_fixed_param);
  38. buf = wmi_buf_alloc(wmi_handle, len);
  39. if (!buf) {
  40. return QDF_STATUS_E_NOMEM;
  41. }
  42. cmd = (wmi_d0_wow_enable_disable_cmd_fixed_param *) wmi_buf_data(buf);
  43. WMITLV_SET_HDR(&cmd->tlv_header,
  44. WMITLV_TAG_STRUC_wmi_d0_wow_enable_disable_cmd_fixed_param,
  45. WMITLV_GET_STRUCT_TLVLEN
  46. (wmi_d0_wow_enable_disable_cmd_fixed_param));
  47. cmd->enable = true;
  48. wmi_mtrace(WMI_D0_WOW_ENABLE_DISABLE_CMDID, NO_SESSION, 0);
  49. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  50. WMI_D0_WOW_ENABLE_DISABLE_CMDID);
  51. if (QDF_IS_STATUS_ERROR(status))
  52. wmi_buf_free(buf);
  53. return status;
  54. }
  55. /**
  56. * send_d0wow_disable_cmd_tlv() - WMI d0 wow disable function
  57. * @param wmi_handle: handle to WMI.
  58. * @mac_id: radio context
  59. *
  60. * Return: 0 on success and error code on failure.
  61. */
  62. static QDF_STATUS send_d0wow_disable_cmd_tlv(wmi_unified_t wmi_handle,
  63. uint8_t mac_id)
  64. {
  65. wmi_d0_wow_enable_disable_cmd_fixed_param *cmd;
  66. wmi_buf_t buf;
  67. int32_t len;
  68. QDF_STATUS status;
  69. len = sizeof(wmi_d0_wow_enable_disable_cmd_fixed_param);
  70. buf = wmi_buf_alloc(wmi_handle, len);
  71. if (!buf) {
  72. return QDF_STATUS_E_NOMEM;
  73. }
  74. cmd = (wmi_d0_wow_enable_disable_cmd_fixed_param *) wmi_buf_data(buf);
  75. WMITLV_SET_HDR(&cmd->tlv_header,
  76. WMITLV_TAG_STRUC_wmi_d0_wow_enable_disable_cmd_fixed_param,
  77. WMITLV_GET_STRUCT_TLVLEN
  78. (wmi_d0_wow_enable_disable_cmd_fixed_param));
  79. cmd->enable = false;
  80. wmi_mtrace(WMI_D0_WOW_ENABLE_DISABLE_CMDID, NO_SESSION, 0);
  81. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  82. WMI_D0_WOW_ENABLE_DISABLE_CMDID);
  83. if (QDF_IS_STATUS_ERROR(status))
  84. wmi_buf_free(buf);
  85. return status;
  86. }
  87. void wmi_d0wow_attach_tlv(struct wmi_unified *wmi_handle)
  88. {
  89. struct wmi_ops *ops = wmi_handle->ops;
  90. ops->send_d0wow_enable_cmd = send_d0wow_enable_cmd_tlv;
  91. ops->send_d0wow_disable_cmd = send_d0wow_disable_cmd_tlv;
  92. }
  93. #endif /* FEATURE_WLAN_D0WOW */
  94. /**
  95. * send_add_wow_wakeup_event_cmd_tlv() - Configures wow wakeup events.
  96. * @wmi_handle: wmi handle
  97. * @vdev_id: vdev id
  98. * @bitmap: Event bitmap
  99. * @enable: enable/disable
  100. *
  101. * Return: CDF status
  102. */
  103. static QDF_STATUS send_add_wow_wakeup_event_cmd_tlv(wmi_unified_t wmi_handle,
  104. uint32_t vdev_id,
  105. uint32_t *bitmap,
  106. bool enable)
  107. {
  108. WMI_WOW_ADD_DEL_EVT_CMD_fixed_param *cmd;
  109. uint16_t len;
  110. wmi_buf_t buf;
  111. int ret;
  112. len = sizeof(WMI_WOW_ADD_DEL_EVT_CMD_fixed_param);
  113. buf = wmi_buf_alloc(wmi_handle, len);
  114. if (!buf) {
  115. return QDF_STATUS_E_NOMEM;
  116. }
  117. cmd = (WMI_WOW_ADD_DEL_EVT_CMD_fixed_param *) wmi_buf_data(buf);
  118. WMITLV_SET_HDR(&cmd->tlv_header,
  119. WMITLV_TAG_STRUC_WMI_WOW_ADD_DEL_EVT_CMD_fixed_param,
  120. WMITLV_GET_STRUCT_TLVLEN
  121. (WMI_WOW_ADD_DEL_EVT_CMD_fixed_param));
  122. cmd->vdev_id = vdev_id;
  123. cmd->is_add = enable;
  124. qdf_mem_copy(&(cmd->event_bitmaps[0]), bitmap, sizeof(uint32_t) *
  125. WMI_WOW_MAX_EVENT_BM_LEN);
  126. WMI_LOGD("Wakeup pattern 0x%x%x%x%x %s in fw", cmd->event_bitmaps[0],
  127. cmd->event_bitmaps[1], cmd->event_bitmaps[2],
  128. cmd->event_bitmaps[3], enable ? "enabled" : "disabled");
  129. wmi_mtrace(WMI_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID, cmd->vdev_id, 0);
  130. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  131. WMI_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID);
  132. if (ret) {
  133. WMI_LOGE("Failed to config wow wakeup event");
  134. wmi_buf_free(buf);
  135. return QDF_STATUS_E_FAILURE;
  136. }
  137. return QDF_STATUS_SUCCESS;
  138. }
  139. /**
  140. * send_wow_patterns_to_fw_cmd_tlv() - Sends WOW patterns to FW.
  141. * @wmi_handle: wmi handle
  142. * @vdev_id: vdev id
  143. * @ptrn_id: pattern id
  144. * @ptrn: pattern
  145. * @ptrn_len: pattern length
  146. * @ptrn_offset: pattern offset
  147. * @mask: mask
  148. * @mask_len: mask length
  149. * @user: true for user configured pattern and false for default pattern
  150. * @default_patterns: default patterns
  151. *
  152. * Return: CDF status
  153. */
  154. static QDF_STATUS send_wow_patterns_to_fw_cmd_tlv(wmi_unified_t wmi_handle,
  155. uint8_t vdev_id, uint8_t ptrn_id,
  156. const uint8_t *ptrn, uint8_t ptrn_len,
  157. uint8_t ptrn_offset, const uint8_t *mask,
  158. uint8_t mask_len, bool user,
  159. uint8_t default_patterns)
  160. {
  161. WMI_WOW_ADD_PATTERN_CMD_fixed_param *cmd;
  162. WOW_BITMAP_PATTERN_T *bitmap_pattern;
  163. wmi_buf_t buf;
  164. uint8_t *buf_ptr;
  165. int32_t len;
  166. int ret;
  167. len = sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param) +
  168. WMI_TLV_HDR_SIZE +
  169. 1 * sizeof(WOW_BITMAP_PATTERN_T) +
  170. WMI_TLV_HDR_SIZE +
  171. 0 * sizeof(WOW_IPV4_SYNC_PATTERN_T) +
  172. WMI_TLV_HDR_SIZE +
  173. 0 * sizeof(WOW_IPV6_SYNC_PATTERN_T) +
  174. WMI_TLV_HDR_SIZE +
  175. 0 * sizeof(WOW_MAGIC_PATTERN_CMD) +
  176. WMI_TLV_HDR_SIZE +
  177. 0 * sizeof(uint32_t) + WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t);
  178. buf = wmi_buf_alloc(wmi_handle, len);
  179. if (!buf) {
  180. return QDF_STATUS_E_NOMEM;
  181. }
  182. cmd = (WMI_WOW_ADD_PATTERN_CMD_fixed_param *) wmi_buf_data(buf);
  183. buf_ptr = (uint8_t *) cmd;
  184. WMITLV_SET_HDR(&cmd->tlv_header,
  185. WMITLV_TAG_STRUC_WMI_WOW_ADD_PATTERN_CMD_fixed_param,
  186. WMITLV_GET_STRUCT_TLVLEN
  187. (WMI_WOW_ADD_PATTERN_CMD_fixed_param));
  188. cmd->vdev_id = vdev_id;
  189. cmd->pattern_id = ptrn_id;
  190. cmd->pattern_type = WOW_BITMAP_PATTERN;
  191. buf_ptr += sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param);
  192. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  193. sizeof(WOW_BITMAP_PATTERN_T));
  194. buf_ptr += WMI_TLV_HDR_SIZE;
  195. bitmap_pattern = (WOW_BITMAP_PATTERN_T *) buf_ptr;
  196. WMITLV_SET_HDR(&bitmap_pattern->tlv_header,
  197. WMITLV_TAG_STRUC_WOW_BITMAP_PATTERN_T,
  198. WMITLV_GET_STRUCT_TLVLEN(WOW_BITMAP_PATTERN_T));
  199. qdf_mem_copy(&bitmap_pattern->patternbuf[0], ptrn, ptrn_len);
  200. qdf_mem_copy(&bitmap_pattern->bitmaskbuf[0], mask, mask_len);
  201. bitmap_pattern->pattern_offset = ptrn_offset;
  202. bitmap_pattern->pattern_len = ptrn_len;
  203. if (bitmap_pattern->pattern_len > WOW_DEFAULT_BITMAP_PATTERN_SIZE)
  204. bitmap_pattern->pattern_len = WOW_DEFAULT_BITMAP_PATTERN_SIZE;
  205. if (bitmap_pattern->pattern_len > WOW_DEFAULT_BITMASK_SIZE)
  206. bitmap_pattern->pattern_len = WOW_DEFAULT_BITMASK_SIZE;
  207. bitmap_pattern->bitmask_len = bitmap_pattern->pattern_len;
  208. bitmap_pattern->pattern_id = ptrn_id;
  209. WMI_LOGD("vdev: %d, ptrn id: %d, ptrn len: %d, ptrn offset: %d user %d",
  210. cmd->vdev_id, cmd->pattern_id, bitmap_pattern->pattern_len,
  211. bitmap_pattern->pattern_offset, user);
  212. WMI_LOGD("Pattern : ");
  213. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
  214. &bitmap_pattern->patternbuf[0],
  215. bitmap_pattern->pattern_len);
  216. WMI_LOGD("Mask : ");
  217. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
  218. &bitmap_pattern->bitmaskbuf[0],
  219. bitmap_pattern->pattern_len);
  220. buf_ptr += sizeof(WOW_BITMAP_PATTERN_T);
  221. /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV4_SYNC_PATTERN_T but no data. */
  222. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  223. buf_ptr += WMI_TLV_HDR_SIZE;
  224. /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV6_SYNC_PATTERN_T but no data. */
  225. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  226. buf_ptr += WMI_TLV_HDR_SIZE;
  227. /* Fill TLV for WMITLV_TAG_STRUC_WOW_MAGIC_PATTERN_CMD but no data. */
  228. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  229. buf_ptr += WMI_TLV_HDR_SIZE;
  230. /* Fill TLV for pattern_info_timeout but no data. */
  231. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, 0);
  232. buf_ptr += WMI_TLV_HDR_SIZE;
  233. /* Fill TLV for ratelimit_interval with dummy data as this fix elem */
  234. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, 1 * sizeof(uint32_t));
  235. buf_ptr += WMI_TLV_HDR_SIZE;
  236. *(uint32_t *) buf_ptr = 0;
  237. wmi_mtrace(WMI_WOW_ADD_WAKE_PATTERN_CMDID, cmd->vdev_id, 0);
  238. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  239. WMI_WOW_ADD_WAKE_PATTERN_CMDID);
  240. if (ret) {
  241. WMI_LOGE("%s: Failed to send wow ptrn to fw", __func__);
  242. wmi_buf_free(buf);
  243. return QDF_STATUS_E_FAILURE;
  244. }
  245. return QDF_STATUS_SUCCESS;
  246. }
  247. /**
  248. * fill_arp_offload_params_tlv() - Fill ARP offload data
  249. * @wmi_handle: wmi handle
  250. * @offload_req: offload request
  251. * @buf_ptr: buffer pointer
  252. *
  253. * To fill ARP offload data to firmware
  254. * when target goes to wow mode.
  255. *
  256. * Return: None
  257. */
  258. static void fill_arp_offload_params_tlv(wmi_unified_t wmi_handle,
  259. struct pmo_arp_offload_params *offload_req, uint8_t **buf_ptr)
  260. {
  261. int i;
  262. WMI_ARP_OFFLOAD_TUPLE *arp_tuple;
  263. bool enable_or_disable = offload_req->enable;
  264. WMITLV_SET_HDR(*buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  265. (WMI_MAX_ARP_OFFLOADS*sizeof(WMI_ARP_OFFLOAD_TUPLE)));
  266. *buf_ptr += WMI_TLV_HDR_SIZE;
  267. for (i = 0; i < WMI_MAX_ARP_OFFLOADS; i++) {
  268. arp_tuple = (WMI_ARP_OFFLOAD_TUPLE *)*buf_ptr;
  269. WMITLV_SET_HDR(&arp_tuple->tlv_header,
  270. WMITLV_TAG_STRUC_WMI_ARP_OFFLOAD_TUPLE,
  271. WMITLV_GET_STRUCT_TLVLEN(WMI_ARP_OFFLOAD_TUPLE));
  272. /* Fill data for ARP and NS in the first tupple for LA */
  273. if ((enable_or_disable & PMO_OFFLOAD_ENABLE) && (i == 0)) {
  274. /* Copy the target ip addr and flags */
  275. arp_tuple->flags = WMI_ARPOFF_FLAGS_VALID;
  276. qdf_mem_copy(&arp_tuple->target_ipaddr,
  277. offload_req->host_ipv4_addr,
  278. WMI_IPV4_ADDR_LEN);
  279. WMI_LOGD("ARPOffload IP4 address: %pI4",
  280. offload_req->host_ipv4_addr);
  281. }
  282. *buf_ptr += sizeof(WMI_ARP_OFFLOAD_TUPLE);
  283. }
  284. }
  285. #ifdef WLAN_NS_OFFLOAD
  286. /**
  287. * fill_ns_offload_params_tlv() - Fill NS offload data
  288. * @wmi|_handle: wmi handle
  289. * @offload_req: offload request
  290. * @buf_ptr: buffer pointer
  291. *
  292. * To fill NS offload data to firmware
  293. * when target goes to wow mode.
  294. *
  295. * Return: None
  296. */
  297. static void fill_ns_offload_params_tlv(wmi_unified_t wmi_handle,
  298. struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr)
  299. {
  300. int i;
  301. WMI_NS_OFFLOAD_TUPLE *ns_tuple;
  302. WMITLV_SET_HDR(*buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  303. (WMI_MAX_NS_OFFLOADS * sizeof(WMI_NS_OFFLOAD_TUPLE)));
  304. *buf_ptr += WMI_TLV_HDR_SIZE;
  305. for (i = 0; i < WMI_MAX_NS_OFFLOADS; i++) {
  306. ns_tuple = (WMI_NS_OFFLOAD_TUPLE *)*buf_ptr;
  307. WMITLV_SET_HDR(&ns_tuple->tlv_header,
  308. WMITLV_TAG_STRUC_WMI_NS_OFFLOAD_TUPLE,
  309. (sizeof(WMI_NS_OFFLOAD_TUPLE) - WMI_TLV_HDR_SIZE));
  310. /*
  311. * Fill data only for NS offload in the first ARP tuple for LA
  312. */
  313. if ((ns_req->enable & PMO_OFFLOAD_ENABLE)) {
  314. ns_tuple->flags |= WMI_NSOFF_FLAGS_VALID;
  315. /* Copy the target/solicitation/remote ip addr */
  316. if (ns_req->target_ipv6_addr_valid[i])
  317. qdf_mem_copy(&ns_tuple->target_ipaddr[0],
  318. &ns_req->target_ipv6_addr[i],
  319. sizeof(WMI_IPV6_ADDR));
  320. qdf_mem_copy(&ns_tuple->solicitation_ipaddr,
  321. &ns_req->self_ipv6_addr[i],
  322. sizeof(WMI_IPV6_ADDR));
  323. if (ns_req->target_ipv6_addr_ac_type[i]) {
  324. ns_tuple->flags |=
  325. WMI_NSOFF_FLAGS_IS_IPV6_ANYCAST;
  326. }
  327. WMI_LOGD("Index %d NS solicitedIp %pI6, targetIp %pI6",
  328. i, &ns_req->self_ipv6_addr[i],
  329. &ns_req->target_ipv6_addr[i]);
  330. /* target MAC is optional, check if it is valid,
  331. * if this is not valid, the target will use the known
  332. * local MAC address rather than the tuple
  333. */
  334. WMI_CHAR_ARRAY_TO_MAC_ADDR(
  335. ns_req->self_macaddr.bytes,
  336. &ns_tuple->target_mac);
  337. if ((ns_tuple->target_mac.mac_addr31to0 != 0) ||
  338. (ns_tuple->target_mac.mac_addr47to32 != 0)) {
  339. ns_tuple->flags |= WMI_NSOFF_FLAGS_MAC_VALID;
  340. }
  341. }
  342. *buf_ptr += sizeof(WMI_NS_OFFLOAD_TUPLE);
  343. }
  344. }
  345. /**
  346. * fill_nsoffload_ext_tlv() - Fill NS offload ext data
  347. * @wmi: wmi handle
  348. * @offload_req: offload request
  349. * @buf_ptr: buffer pointer
  350. *
  351. * To fill extended NS offload extended data to firmware
  352. * when target goes to wow mode.
  353. *
  354. * Return: None
  355. */
  356. static void fill_nsoffload_ext_tlv(wmi_unified_t wmi_handle,
  357. struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr)
  358. {
  359. int i;
  360. WMI_NS_OFFLOAD_TUPLE *ns_tuple;
  361. uint32_t count, num_ns_ext_tuples;
  362. count = ns_req->num_ns_offload_count;
  363. num_ns_ext_tuples = ns_req->num_ns_offload_count -
  364. WMI_MAX_NS_OFFLOADS;
  365. /* Populate extended NS offload tuples */
  366. WMITLV_SET_HDR(*buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  367. (num_ns_ext_tuples * sizeof(WMI_NS_OFFLOAD_TUPLE)));
  368. *buf_ptr += WMI_TLV_HDR_SIZE;
  369. for (i = WMI_MAX_NS_OFFLOADS; i < count; i++) {
  370. ns_tuple = (WMI_NS_OFFLOAD_TUPLE *)*buf_ptr;
  371. WMITLV_SET_HDR(&ns_tuple->tlv_header,
  372. WMITLV_TAG_STRUC_WMI_NS_OFFLOAD_TUPLE,
  373. (sizeof(WMI_NS_OFFLOAD_TUPLE)-WMI_TLV_HDR_SIZE));
  374. /*
  375. * Fill data only for NS offload in the first ARP tuple for LA
  376. */
  377. if ((ns_req->enable & PMO_OFFLOAD_ENABLE)) {
  378. ns_tuple->flags |= WMI_NSOFF_FLAGS_VALID;
  379. /* Copy the target/solicitation/remote ip addr */
  380. if (ns_req->target_ipv6_addr_valid[i])
  381. qdf_mem_copy(&ns_tuple->target_ipaddr[0],
  382. &ns_req->target_ipv6_addr[i],
  383. sizeof(WMI_IPV6_ADDR));
  384. qdf_mem_copy(&ns_tuple->solicitation_ipaddr,
  385. &ns_req->self_ipv6_addr[i],
  386. sizeof(WMI_IPV6_ADDR));
  387. if (ns_req->target_ipv6_addr_ac_type[i]) {
  388. ns_tuple->flags |=
  389. WMI_NSOFF_FLAGS_IS_IPV6_ANYCAST;
  390. }
  391. WMI_LOGD("Index %d NS solicitedIp %pI6, targetIp %pI6",
  392. i, &ns_req->self_ipv6_addr[i],
  393. &ns_req->target_ipv6_addr[i]);
  394. /* target MAC is optional, check if it is valid,
  395. * if this is not valid, the target will use the
  396. * known local MAC address rather than the tuple
  397. */
  398. WMI_CHAR_ARRAY_TO_MAC_ADDR(
  399. ns_req->self_macaddr.bytes,
  400. &ns_tuple->target_mac);
  401. if ((ns_tuple->target_mac.mac_addr31to0 != 0) ||
  402. (ns_tuple->target_mac.mac_addr47to32 != 0)) {
  403. ns_tuple->flags |= WMI_NSOFF_FLAGS_MAC_VALID;
  404. }
  405. }
  406. *buf_ptr += sizeof(WMI_NS_OFFLOAD_TUPLE);
  407. }
  408. }
  409. #else
  410. static void fill_ns_offload_params_tlv(wmi_unified_t wmi_handle,
  411. struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr)
  412. {
  413. }
  414. static void fill_nsoffload_ext_tlv(wmi_unified_t wmi_handle,
  415. struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr)
  416. {
  417. }
  418. #endif
  419. /**
  420. * send_enable_arp_ns_offload_cmd_tlv() - enable ARP NS offload
  421. * @wma: wmi handle
  422. * @arp_offload_req: arp offload request
  423. * @ns_offload_req: ns offload request
  424. * @arp_only: flag
  425. *
  426. * To configure ARP NS off load data to firmware
  427. * when target goes to wow mode.
  428. *
  429. * Return: QDF Status
  430. */
  431. static QDF_STATUS send_enable_arp_ns_offload_cmd_tlv(wmi_unified_t wmi_handle,
  432. struct pmo_arp_offload_params *arp_offload_req,
  433. struct pmo_ns_offload_params *ns_offload_req,
  434. uint8_t vdev_id)
  435. {
  436. int32_t res;
  437. WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param *cmd;
  438. uint8_t *buf_ptr;
  439. wmi_buf_t buf;
  440. int32_t len;
  441. uint32_t count = 0, num_ns_ext_tuples = 0;
  442. count = ns_offload_req->num_ns_offload_count;
  443. /*
  444. * TLV place holder size for array of NS tuples
  445. * TLV place holder size for array of ARP tuples
  446. */
  447. len = sizeof(WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param) +
  448. WMI_TLV_HDR_SIZE +
  449. WMI_MAX_NS_OFFLOADS * sizeof(WMI_NS_OFFLOAD_TUPLE) +
  450. WMI_TLV_HDR_SIZE +
  451. WMI_MAX_ARP_OFFLOADS * sizeof(WMI_ARP_OFFLOAD_TUPLE);
  452. /*
  453. * If there are more than WMI_MAX_NS_OFFLOADS addresses then allocate
  454. * extra length for extended NS offload tuples which follows ARP offload
  455. * tuples. Host needs to fill this structure in following format:
  456. * 2 NS ofload tuples
  457. * 2 ARP offload tuples
  458. * N numbers of extended NS offload tuples if HDD has given more than
  459. * 2 NS offload addresses
  460. */
  461. if (count > WMI_MAX_NS_OFFLOADS) {
  462. num_ns_ext_tuples = count - WMI_MAX_NS_OFFLOADS;
  463. len += WMI_TLV_HDR_SIZE + num_ns_ext_tuples
  464. * sizeof(WMI_NS_OFFLOAD_TUPLE);
  465. }
  466. buf = wmi_buf_alloc(wmi_handle, len);
  467. if (!buf) {
  468. return QDF_STATUS_E_NOMEM;
  469. }
  470. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  471. cmd = (WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param *) buf_ptr;
  472. WMITLV_SET_HDR(&cmd->tlv_header,
  473. WMITLV_TAG_STRUC_WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param,
  474. WMITLV_GET_STRUCT_TLVLEN
  475. (WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param));
  476. cmd->flags = 0;
  477. cmd->vdev_id = vdev_id;
  478. cmd->num_ns_ext_tuples = num_ns_ext_tuples;
  479. WMI_LOGD("ARP NS Offload vdev_id: %d", cmd->vdev_id);
  480. buf_ptr += sizeof(WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param);
  481. fill_ns_offload_params_tlv(wmi_handle, ns_offload_req, &buf_ptr);
  482. fill_arp_offload_params_tlv(wmi_handle, arp_offload_req, &buf_ptr);
  483. if (num_ns_ext_tuples)
  484. fill_nsoffload_ext_tlv(wmi_handle, ns_offload_req, &buf_ptr);
  485. wmi_mtrace(WMI_SET_ARP_NS_OFFLOAD_CMDID, cmd->vdev_id, 0);
  486. res = wmi_unified_cmd_send(wmi_handle, buf, len,
  487. WMI_SET_ARP_NS_OFFLOAD_CMDID);
  488. if (res) {
  489. WMI_LOGE("Failed to enable ARP NDP/NSffload");
  490. wmi_buf_free(buf);
  491. return QDF_STATUS_E_FAILURE;
  492. }
  493. return QDF_STATUS_SUCCESS;
  494. }
  495. /**
  496. * send_add_clear_mcbc_filter_cmd_tlv() - set mcast filter command to fw
  497. * @wmi_handle: wmi handle
  498. * @vdev_id: vdev id
  499. * @multicastAddr: mcast address
  500. * @clearList: clear list flag
  501. *
  502. * Return: QDF_STATUS_SUCCESS for success or error code
  503. */
  504. static QDF_STATUS send_add_clear_mcbc_filter_cmd_tlv(wmi_unified_t wmi_handle,
  505. uint8_t vdev_id,
  506. struct qdf_mac_addr multicast_addr,
  507. bool clearList)
  508. {
  509. WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param *cmd;
  510. wmi_buf_t buf;
  511. int err;
  512. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  513. if (!buf) {
  514. return QDF_STATUS_E_NOMEM;
  515. }
  516. cmd = (WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param *) wmi_buf_data(buf);
  517. qdf_mem_zero(cmd, sizeof(*cmd));
  518. WMITLV_SET_HDR(&cmd->tlv_header,
  519. WMITLV_TAG_STRUC_WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param,
  520. WMITLV_GET_STRUCT_TLVLEN
  521. (WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param));
  522. cmd->action =
  523. (clearList ? WMI_MCAST_FILTER_DELETE : WMI_MCAST_FILTER_SET);
  524. cmd->vdev_id = vdev_id;
  525. WMI_CHAR_ARRAY_TO_MAC_ADDR(multicast_addr.bytes, &cmd->mcastbdcastaddr);
  526. WMI_LOGD("Action:%d; vdev_id:%d; clearList:%d; MCBC MAC Addr: %pM",
  527. cmd->action, vdev_id, clearList, multicast_addr.bytes);
  528. wmi_mtrace(WMI_SET_MCASTBCAST_FILTER_CMDID, cmd->vdev_id, 0);
  529. err = wmi_unified_cmd_send(wmi_handle, buf,
  530. sizeof(*cmd),
  531. WMI_SET_MCASTBCAST_FILTER_CMDID);
  532. if (err) {
  533. WMI_LOGE("Failed to send set_param cmd");
  534. wmi_buf_free(buf);
  535. return QDF_STATUS_E_FAILURE;
  536. }
  537. return QDF_STATUS_SUCCESS;
  538. }
  539. /**
  540. * send_multiple_add_clear_mcbc_filter_cmd_tlv() - send multiple mcast filter
  541. * command to fw
  542. * @wmi_handle: wmi handle
  543. * @vdev_id: vdev id
  544. * @mcast_filter_params: mcast filter params
  545. *
  546. * Return: QDF_STATUS_SUCCESS for success or error code
  547. */
  548. static QDF_STATUS send_multiple_add_clear_mcbc_filter_cmd_tlv(
  549. wmi_unified_t wmi_handle,
  550. uint8_t vdev_id,
  551. struct pmo_mcast_filter_params *filter_param)
  552. {
  553. WMI_SET_MULTIPLE_MCAST_FILTER_CMD_fixed_param *cmd;
  554. uint8_t *buf_ptr;
  555. wmi_buf_t buf;
  556. int err;
  557. int i;
  558. uint8_t *mac_addr_src_ptr = NULL;
  559. wmi_mac_addr *mac_addr_dst_ptr;
  560. uint32_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE +
  561. sizeof(wmi_mac_addr) * filter_param->multicast_addr_cnt;
  562. buf = wmi_buf_alloc(wmi_handle, len);
  563. if (!buf) {
  564. return QDF_STATUS_E_NOMEM;
  565. }
  566. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  567. cmd = (WMI_SET_MULTIPLE_MCAST_FILTER_CMD_fixed_param *)
  568. wmi_buf_data(buf);
  569. qdf_mem_zero(cmd, sizeof(*cmd));
  570. WMITLV_SET_HDR(&cmd->tlv_header,
  571. WMITLV_TAG_STRUC_wmi_set_multiple_mcast_filter_cmd_fixed_param,
  572. WMITLV_GET_STRUCT_TLVLEN
  573. (WMI_SET_MULTIPLE_MCAST_FILTER_CMD_fixed_param));
  574. cmd->operation =
  575. ((filter_param->action == 0) ? WMI_MULTIPLE_MCAST_FILTER_DELETE
  576. : WMI_MULTIPLE_MCAST_FILTER_ADD);
  577. cmd->vdev_id = vdev_id;
  578. cmd->num_mcastaddrs = filter_param->multicast_addr_cnt;
  579. buf_ptr += sizeof(*cmd);
  580. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC,
  581. sizeof(wmi_mac_addr) *
  582. filter_param->multicast_addr_cnt);
  583. if (filter_param->multicast_addr_cnt == 0)
  584. goto send_cmd;
  585. mac_addr_src_ptr = (uint8_t *)&filter_param->multicast_addr;
  586. mac_addr_dst_ptr = (wmi_mac_addr *)
  587. (buf_ptr + WMI_TLV_HDR_SIZE);
  588. for (i = 0; i < filter_param->multicast_addr_cnt; i++) {
  589. WMI_CHAR_ARRAY_TO_MAC_ADDR(mac_addr_src_ptr, mac_addr_dst_ptr);
  590. mac_addr_src_ptr += ATH_MAC_LEN;
  591. mac_addr_dst_ptr++;
  592. }
  593. send_cmd:
  594. wmi_mtrace(WMI_SET_MULTIPLE_MCAST_FILTER_CMDID, cmd->vdev_id, 0);
  595. err = wmi_unified_cmd_send(wmi_handle, buf,
  596. len,
  597. WMI_SET_MULTIPLE_MCAST_FILTER_CMDID);
  598. if (err) {
  599. WMI_LOGE("Failed to send set_param cmd");
  600. wmi_buf_free(buf);
  601. return QDF_STATUS_E_FAILURE;
  602. }
  603. return QDF_STATUS_SUCCESS;
  604. }
  605. static QDF_STATUS send_conf_hw_filter_cmd_tlv(wmi_unified_t wmi,
  606. struct pmo_hw_filter_params *req)
  607. {
  608. QDF_STATUS status;
  609. wmi_hw_data_filter_cmd_fixed_param *cmd;
  610. wmi_buf_t wmi_buf;
  611. if (!req) {
  612. WMI_LOGE("req is null");
  613. return QDF_STATUS_E_INVAL;
  614. }
  615. wmi_buf = wmi_buf_alloc(wmi, sizeof(*cmd));
  616. if (!wmi_buf) {
  617. return QDF_STATUS_E_NOMEM;
  618. }
  619. cmd = (wmi_hw_data_filter_cmd_fixed_param *)wmi_buf_data(wmi_buf);
  620. WMITLV_SET_HDR(&cmd->tlv_header,
  621. WMITLV_TAG_STRUC_wmi_hw_data_filter_cmd_fixed_param,
  622. WMITLV_GET_STRUCT_TLVLEN(wmi_hw_data_filter_cmd_fixed_param));
  623. cmd->vdev_id = req->vdev_id;
  624. cmd->enable = req->enable;
  625. /* Set all modes in case of disable */
  626. if (!cmd->enable)
  627. cmd->hw_filter_bitmap = ((uint32_t)~0U);
  628. else
  629. cmd->hw_filter_bitmap = req->mode_bitmap;
  630. WMI_LOGD("Send %s hw filter mode: 0x%X for vdev id %d",
  631. req->enable ? "enable" : "disable", req->mode_bitmap,
  632. req->vdev_id);
  633. wmi_mtrace(WMI_HW_DATA_FILTER_CMDID, cmd->vdev_id, 0);
  634. status = wmi_unified_cmd_send(wmi, wmi_buf, sizeof(*cmd),
  635. WMI_HW_DATA_FILTER_CMDID);
  636. if (QDF_IS_STATUS_ERROR(status)) {
  637. WMI_LOGE("Failed to configure hw filter");
  638. wmi_buf_free(wmi_buf);
  639. }
  640. return status;
  641. }
  642. static void
  643. fill_fils_tlv_params(WMI_GTK_OFFLOAD_CMD_fixed_param *cmd,
  644. uint8_t vdev_id,
  645. struct pmo_gtk_req *params)
  646. {
  647. uint8_t *buf_ptr;
  648. wmi_gtk_offload_fils_tlv_param *ext_param;
  649. buf_ptr = (uint8_t *) cmd + sizeof(*cmd);
  650. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  651. sizeof(*ext_param));
  652. buf_ptr += WMI_TLV_HDR_SIZE;
  653. ext_param = (wmi_gtk_offload_fils_tlv_param *)buf_ptr;
  654. WMITLV_SET_HDR(&ext_param->tlv_header,
  655. WMITLV_TAG_STRUC_wmi_gtk_offload_extended_tlv_param,
  656. WMITLV_GET_STRUCT_TLVLEN(
  657. wmi_gtk_offload_fils_tlv_param));
  658. ext_param->vdev_id = vdev_id;
  659. ext_param->flags = cmd->flags;
  660. ext_param->kek_len = params->kek_len;
  661. qdf_mem_copy(ext_param->KEK, params->kek, params->kek_len);
  662. qdf_mem_copy(ext_param->KCK, params->kck,
  663. WMI_GTK_OFFLOAD_KCK_BYTES);
  664. qdf_mem_copy(ext_param->replay_counter, &params->replay_counter,
  665. GTK_REPLAY_COUNTER_BYTES);
  666. }
  667. /**
  668. * send_gtk_offload_cmd_tlv() - send GTK offload command to fw
  669. * @wmi_handle: wmi handle
  670. * @vdev_id: vdev id
  671. * @params: GTK offload parameters
  672. *
  673. * Return: CDF status
  674. */
  675. static
  676. QDF_STATUS send_gtk_offload_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id,
  677. struct pmo_gtk_req *params,
  678. bool enable_offload,
  679. uint32_t gtk_offload_opcode)
  680. {
  681. int len;
  682. wmi_buf_t buf;
  683. WMI_GTK_OFFLOAD_CMD_fixed_param *cmd;
  684. QDF_STATUS status = QDF_STATUS_SUCCESS;
  685. WMI_LOGD("%s Enter", __func__);
  686. len = sizeof(*cmd);
  687. if (params->is_fils_connection)
  688. len += WMI_TLV_HDR_SIZE +
  689. sizeof(wmi_gtk_offload_fils_tlv_param);
  690. /* alloc wmi buffer */
  691. buf = wmi_buf_alloc(wmi_handle, len);
  692. if (!buf) {
  693. status = QDF_STATUS_E_NOMEM;
  694. goto out;
  695. }
  696. cmd = (WMI_GTK_OFFLOAD_CMD_fixed_param *) wmi_buf_data(buf);
  697. WMITLV_SET_HDR(&cmd->tlv_header,
  698. WMITLV_TAG_STRUC_WMI_GTK_OFFLOAD_CMD_fixed_param,
  699. WMITLV_GET_STRUCT_TLVLEN
  700. (WMI_GTK_OFFLOAD_CMD_fixed_param));
  701. cmd->vdev_id = vdev_id;
  702. /* Request target to enable GTK offload */
  703. if (enable_offload == PMO_GTK_OFFLOAD_ENABLE) {
  704. cmd->flags = gtk_offload_opcode;
  705. /* Copy the keys and replay counter */
  706. qdf_mem_copy(cmd->KCK, params->kck, PMO_KCK_LEN);
  707. qdf_mem_copy(cmd->KEK, params->kek, PMO_KEK_LEN_LEGACY);
  708. qdf_mem_copy(cmd->replay_counter, &params->replay_counter,
  709. GTK_REPLAY_COUNTER_BYTES);
  710. } else {
  711. cmd->flags = gtk_offload_opcode;
  712. }
  713. if (params->is_fils_connection)
  714. fill_fils_tlv_params(cmd, vdev_id, params);
  715. WMI_LOGD("VDEVID: %d, GTK_FLAGS: x%x kek len %d", vdev_id, cmd->flags, params->kek_len);
  716. /* send the wmi command */
  717. wmi_mtrace(WMI_GTK_OFFLOAD_CMDID, cmd->vdev_id, 0);
  718. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  719. WMI_GTK_OFFLOAD_CMDID)) {
  720. WMI_LOGE("Failed to send WMI_GTK_OFFLOAD_CMDID");
  721. wmi_buf_free(buf);
  722. status = QDF_STATUS_E_FAILURE;
  723. }
  724. out:
  725. WMI_LOGD("%s Exit", __func__);
  726. return status;
  727. }
  728. /**
  729. * send_process_gtk_offload_getinfo_cmd_tlv() - send GTK offload cmd to fw
  730. * @wmi_handle: wmi handle
  731. * @params: GTK offload params
  732. *
  733. * Return: CDF status
  734. */
  735. static QDF_STATUS send_process_gtk_offload_getinfo_cmd_tlv(
  736. wmi_unified_t wmi_handle,
  737. uint8_t vdev_id,
  738. uint64_t offload_req_opcode)
  739. {
  740. int len;
  741. wmi_buf_t buf;
  742. WMI_GTK_OFFLOAD_CMD_fixed_param *cmd;
  743. QDF_STATUS status = QDF_STATUS_SUCCESS;
  744. len = sizeof(*cmd);
  745. /* alloc wmi buffer */
  746. buf = wmi_buf_alloc(wmi_handle, len);
  747. if (!buf) {
  748. status = QDF_STATUS_E_NOMEM;
  749. goto out;
  750. }
  751. cmd = (WMI_GTK_OFFLOAD_CMD_fixed_param *) wmi_buf_data(buf);
  752. WMITLV_SET_HDR(&cmd->tlv_header,
  753. WMITLV_TAG_STRUC_WMI_GTK_OFFLOAD_CMD_fixed_param,
  754. WMITLV_GET_STRUCT_TLVLEN
  755. (WMI_GTK_OFFLOAD_CMD_fixed_param));
  756. /* Request for GTK offload status */
  757. cmd->flags = offload_req_opcode;
  758. cmd->vdev_id = vdev_id;
  759. /* send the wmi command */
  760. wmi_mtrace(WMI_GTK_OFFLOAD_CMDID, cmd->vdev_id, 0);
  761. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  762. WMI_GTK_OFFLOAD_CMDID)) {
  763. WMI_LOGE("Failed to send WMI_GTK_OFFLOAD_CMDID for req info");
  764. wmi_buf_free(buf);
  765. status = QDF_STATUS_E_FAILURE;
  766. }
  767. out:
  768. return status;
  769. }
  770. /**
  771. * send_enable_enhance_multicast_offload_tlv() - send enhance multicast offload
  772. * @wmi_handle: wmi handle
  773. * @vdev_id: vdev id
  774. * @action: true for enable else false
  775. *
  776. * To enable enhance multicast offload to firmware
  777. * when target goes to wow mode.
  778. *
  779. * Return: QDF Status
  780. */
  781. static
  782. QDF_STATUS send_enable_enhance_multicast_offload_tlv(
  783. wmi_unified_t wmi_handle,
  784. uint8_t vdev_id, bool action)
  785. {
  786. QDF_STATUS status;
  787. wmi_buf_t buf;
  788. wmi_config_enhanced_mcast_filter_cmd_fixed_param *cmd;
  789. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  790. if (!buf) {
  791. return QDF_STATUS_E_NOMEM;
  792. }
  793. cmd = (wmi_config_enhanced_mcast_filter_cmd_fixed_param *)
  794. wmi_buf_data(buf);
  795. WMITLV_SET_HDR(&cmd->tlv_header,
  796. WMITLV_TAG_STRUC_wmi_config_enhanced_mcast_filter_fixed_param,
  797. WMITLV_GET_STRUCT_TLVLEN(
  798. wmi_config_enhanced_mcast_filter_cmd_fixed_param));
  799. cmd->vdev_id = vdev_id;
  800. cmd->enable = ((action == 0) ? ENHANCED_MCAST_FILTER_DISABLED :
  801. ENHANCED_MCAST_FILTER_ENABLED);
  802. WMI_LOGD("%s: config enhance multicast offload action %d for vdev %d",
  803. __func__, action, vdev_id);
  804. wmi_mtrace(WMI_CONFIG_ENHANCED_MCAST_FILTER_CMDID, cmd->vdev_id, 0);
  805. status = wmi_unified_cmd_send(wmi_handle, buf,
  806. sizeof(*cmd), WMI_CONFIG_ENHANCED_MCAST_FILTER_CMDID);
  807. if (status != QDF_STATUS_SUCCESS) {
  808. wmi_buf_free(buf);
  809. WMI_LOGE("%s:Failed to send ENHANCED_MCAST_FILTER_CMDID",
  810. __func__);
  811. }
  812. return status;
  813. }
  814. /**
  815. * extract_gtk_rsp_event_tlv() - extract gtk rsp params from event
  816. * @wmi_handle: wmi handle
  817. * @param evt_buf: pointer to event buffer
  818. * @param hdr: Pointer to hold header
  819. * @param bufp: Pointer to hold pointer to rx param buffer
  820. *
  821. * Return: QDF_STATUS_SUCCESS for success or error code
  822. */
  823. static QDF_STATUS extract_gtk_rsp_event_tlv(wmi_unified_t wmi_handle,
  824. void *evt_buf, struct pmo_gtk_rsp_params *gtk_rsp_param, uint32_t len)
  825. {
  826. WMI_GTK_OFFLOAD_STATUS_EVENT_fixed_param *fixed_param;
  827. WMI_GTK_OFFLOAD_STATUS_EVENTID_param_tlvs *param_buf;
  828. param_buf = (WMI_GTK_OFFLOAD_STATUS_EVENTID_param_tlvs *)evt_buf;
  829. if (!param_buf) {
  830. WMI_LOGE("gtk param_buf is NULL");
  831. return QDF_STATUS_E_INVAL;
  832. }
  833. if (len < sizeof(WMI_GTK_OFFLOAD_STATUS_EVENT_fixed_param)) {
  834. WMI_LOGE("Invalid length for GTK status");
  835. return QDF_STATUS_E_INVAL;
  836. }
  837. fixed_param = (WMI_GTK_OFFLOAD_STATUS_EVENT_fixed_param *)
  838. param_buf->fixed_param;
  839. if (fixed_param->vdev_id >= WLAN_UMAC_PSOC_MAX_VDEVS) {
  840. wmi_err_rl("Invalid vdev_id %u", fixed_param->vdev_id);
  841. return QDF_STATUS_E_INVAL;
  842. }
  843. gtk_rsp_param->vdev_id = fixed_param->vdev_id;
  844. gtk_rsp_param->status_flag = QDF_STATUS_SUCCESS;
  845. gtk_rsp_param->refresh_cnt = fixed_param->refresh_cnt;
  846. qdf_mem_copy(&gtk_rsp_param->replay_counter,
  847. &fixed_param->replay_counter,
  848. GTK_REPLAY_COUNTER_BYTES);
  849. return QDF_STATUS_SUCCESS;
  850. }
  851. #ifdef FEATURE_WLAN_RA_FILTERING
  852. /**
  853. * send_wow_sta_ra_filter_cmd_tlv() - set RA filter pattern in fw
  854. * @wmi_handle: wmi handle
  855. * @vdev_id: vdev id
  856. *
  857. * Return: CDF status
  858. */
  859. static QDF_STATUS send_wow_sta_ra_filter_cmd_tlv(wmi_unified_t wmi_handle,
  860. uint8_t vdev_id,
  861. uint8_t default_pattern,
  862. uint16_t rate_limit_interval)
  863. {
  864. WMI_WOW_ADD_PATTERN_CMD_fixed_param *cmd;
  865. wmi_buf_t buf;
  866. uint8_t *buf_ptr;
  867. int32_t len;
  868. int ret;
  869. len = sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param) +
  870. WMI_TLV_HDR_SIZE +
  871. 0 * sizeof(WOW_BITMAP_PATTERN_T) +
  872. WMI_TLV_HDR_SIZE +
  873. 0 * sizeof(WOW_IPV4_SYNC_PATTERN_T) +
  874. WMI_TLV_HDR_SIZE +
  875. 0 * sizeof(WOW_IPV6_SYNC_PATTERN_T) +
  876. WMI_TLV_HDR_SIZE +
  877. 0 * sizeof(WOW_MAGIC_PATTERN_CMD) +
  878. WMI_TLV_HDR_SIZE +
  879. 0 * sizeof(uint32_t) + WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t);
  880. buf = wmi_buf_alloc(wmi_handle, len);
  881. if (!buf) {
  882. return QDF_STATUS_E_NOMEM;
  883. }
  884. cmd = (WMI_WOW_ADD_PATTERN_CMD_fixed_param *) wmi_buf_data(buf);
  885. buf_ptr = (uint8_t *) cmd;
  886. WMITLV_SET_HDR(&cmd->tlv_header,
  887. WMITLV_TAG_STRUC_WMI_WOW_ADD_PATTERN_CMD_fixed_param,
  888. WMITLV_GET_STRUCT_TLVLEN
  889. (WMI_WOW_ADD_PATTERN_CMD_fixed_param));
  890. cmd->vdev_id = vdev_id;
  891. cmd->pattern_id = default_pattern,
  892. cmd->pattern_type = WOW_IPV6_RA_PATTERN;
  893. buf_ptr += sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param);
  894. /* Fill TLV for WMITLV_TAG_STRUC_WOW_BITMAP_PATTERN_T but no data. */
  895. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  896. buf_ptr += WMI_TLV_HDR_SIZE;
  897. /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV4_SYNC_PATTERN_T but no data. */
  898. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  899. buf_ptr += WMI_TLV_HDR_SIZE;
  900. /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV6_SYNC_PATTERN_T but no data. */
  901. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  902. buf_ptr += WMI_TLV_HDR_SIZE;
  903. /* Fill TLV for WMITLV_TAG_STRUC_WOW_MAGIC_PATTERN_CMD but no data. */
  904. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  905. buf_ptr += WMI_TLV_HDR_SIZE;
  906. /* Fill TLV for pattern_info_timeout but no data. */
  907. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, 0);
  908. buf_ptr += WMI_TLV_HDR_SIZE;
  909. /* Fill TLV for ra_ratelimit_interval. */
  910. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, sizeof(uint32_t));
  911. buf_ptr += WMI_TLV_HDR_SIZE;
  912. *((uint32_t *) buf_ptr) = rate_limit_interval;
  913. WMI_LOGD("%s: send RA rate limit [%d] to fw vdev = %d", __func__,
  914. rate_limit_interval, vdev_id);
  915. wmi_mtrace(WMI_WOW_ADD_WAKE_PATTERN_CMDID, cmd->vdev_id, 0);
  916. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  917. WMI_WOW_ADD_WAKE_PATTERN_CMDID);
  918. if (ret) {
  919. WMI_LOGE("%s: Failed to send RA rate limit to fw", __func__);
  920. wmi_buf_free(buf);
  921. return QDF_STATUS_E_FAILURE;
  922. }
  923. return QDF_STATUS_SUCCESS;
  924. }
  925. void wmi_ra_filtering_attach_tlv(struct wmi_unified *wmi_handle)
  926. {
  927. struct wmi_ops *ops = wmi_handle->ops;
  928. ops->send_wow_sta_ra_filter_cmd = send_wow_sta_ra_filter_cmd_tlv;
  929. }
  930. #endif /* FEATURE_WLAN_RA_FILTERING */
  931. /**
  932. * send_action_frame_patterns_cmd_tlv() - send wmi cmd of action filter params
  933. * @wmi_handle: wmi handler
  934. * @action_params: pointer to action_params
  935. *
  936. * Return: 0 for success, otherwise appropriate error code
  937. */
  938. static QDF_STATUS send_action_frame_patterns_cmd_tlv(wmi_unified_t wmi_handle,
  939. struct pmo_action_wakeup_set_params *action_params)
  940. {
  941. WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param *cmd;
  942. wmi_buf_t buf;
  943. int i;
  944. int32_t err;
  945. uint32_t len = 0, *cmd_args;
  946. uint8_t *buf_ptr;
  947. len = (PMO_SUPPORTED_ACTION_CATE * sizeof(uint32_t))
  948. + WMI_TLV_HDR_SIZE + sizeof(*cmd);
  949. buf = wmi_buf_alloc(wmi_handle, len);
  950. if (!buf) {
  951. return QDF_STATUS_E_NOMEM;
  952. }
  953. cmd = (WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param *) wmi_buf_data(buf);
  954. buf_ptr = (uint8_t *)cmd;
  955. WMITLV_SET_HDR(&cmd->tlv_header,
  956. WMITLV_TAG_STRUC_wmi_wow_set_action_wake_up_cmd_fixed_param,
  957. WMITLV_GET_STRUCT_TLVLEN(
  958. WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param));
  959. cmd->vdev_id = action_params->vdev_id;
  960. cmd->operation = action_params->operation;
  961. for (i = 0; i < MAX_SUPPORTED_ACTION_CATEGORY_ELE_LIST; i++)
  962. cmd->action_category_map[i] =
  963. action_params->action_category_map[i];
  964. buf_ptr += sizeof(WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param);
  965. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  966. (PMO_SUPPORTED_ACTION_CATE * sizeof(uint32_t)));
  967. buf_ptr += WMI_TLV_HDR_SIZE;
  968. cmd_args = (uint32_t *) buf_ptr;
  969. for (i = 0; i < PMO_SUPPORTED_ACTION_CATE; i++)
  970. cmd_args[i] = action_params->action_per_category[i];
  971. wmi_mtrace(WMI_WOW_SET_ACTION_WAKE_UP_CMDID, cmd->vdev_id, 0);
  972. err = wmi_unified_cmd_send(wmi_handle, buf,
  973. len, WMI_WOW_SET_ACTION_WAKE_UP_CMDID);
  974. if (err) {
  975. WMI_LOGE("Failed to send ap_ps_egap cmd");
  976. wmi_buf_free(buf);
  977. return QDF_STATUS_E_FAILURE;
  978. }
  979. return QDF_STATUS_SUCCESS;
  980. }
  981. #ifdef FEATURE_WLAN_LPHB
  982. /**
  983. * send_lphb_config_hbenable_cmd_tlv() - enable command of LPHB configuration
  984. * @wmi_handle: wmi handle
  985. * @lphb_conf_req: configuration info
  986. *
  987. * Return: CDF status
  988. */
  989. static QDF_STATUS send_lphb_config_hbenable_cmd_tlv(wmi_unified_t wmi_handle,
  990. wmi_hb_set_enable_cmd_fixed_param *params)
  991. {
  992. QDF_STATUS status;
  993. wmi_buf_t buf = NULL;
  994. uint8_t *buf_ptr;
  995. wmi_hb_set_enable_cmd_fixed_param *hb_enable_fp;
  996. int len = sizeof(wmi_hb_set_enable_cmd_fixed_param);
  997. buf = wmi_buf_alloc(wmi_handle, len);
  998. if (!buf) {
  999. return QDF_STATUS_E_NOMEM;
  1000. }
  1001. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1002. hb_enable_fp = (wmi_hb_set_enable_cmd_fixed_param *) buf_ptr;
  1003. WMITLV_SET_HDR(&hb_enable_fp->tlv_header,
  1004. WMITLV_TAG_STRUC_wmi_hb_set_enable_cmd_fixed_param,
  1005. WMITLV_GET_STRUCT_TLVLEN
  1006. (wmi_hb_set_enable_cmd_fixed_param));
  1007. /* fill in values */
  1008. hb_enable_fp->vdev_id = params->session;
  1009. hb_enable_fp->enable = params->enable;
  1010. hb_enable_fp->item = params->item;
  1011. hb_enable_fp->session = params->session;
  1012. wmi_mtrace(WMI_HB_SET_ENABLE_CMDID, NO_SESSION, 0);
  1013. status = wmi_unified_cmd_send(wmi_handle, buf,
  1014. len, WMI_HB_SET_ENABLE_CMDID);
  1015. if (QDF_IS_STATUS_ERROR(status)) {
  1016. WMI_LOGE("cmd_send WMI_HB_SET_ENABLE returned Error %d",
  1017. status);
  1018. wmi_buf_free(buf);
  1019. }
  1020. return status;
  1021. }
  1022. /**
  1023. * send_lphb_config_tcp_params_cmd_tlv() - set tcp params of LPHB configuration
  1024. * @wmi_handle: wmi handle
  1025. * @lphb_conf_req: lphb config request
  1026. *
  1027. * Return: CDF status
  1028. */
  1029. static QDF_STATUS send_lphb_config_tcp_params_cmd_tlv(wmi_unified_t wmi_handle,
  1030. wmi_hb_set_tcp_params_cmd_fixed_param *lphb_conf_req)
  1031. {
  1032. QDF_STATUS status;
  1033. wmi_buf_t buf = NULL;
  1034. uint8_t *buf_ptr;
  1035. wmi_hb_set_tcp_params_cmd_fixed_param *hb_tcp_params_fp;
  1036. int len = sizeof(wmi_hb_set_tcp_params_cmd_fixed_param);
  1037. buf = wmi_buf_alloc(wmi_handle, len);
  1038. if (!buf) {
  1039. return QDF_STATUS_E_NOMEM;
  1040. }
  1041. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1042. hb_tcp_params_fp = (wmi_hb_set_tcp_params_cmd_fixed_param *) buf_ptr;
  1043. WMITLV_SET_HDR(&hb_tcp_params_fp->tlv_header,
  1044. WMITLV_TAG_STRUC_wmi_hb_set_tcp_params_cmd_fixed_param,
  1045. WMITLV_GET_STRUCT_TLVLEN
  1046. (wmi_hb_set_tcp_params_cmd_fixed_param));
  1047. /* fill in values */
  1048. hb_tcp_params_fp->vdev_id = lphb_conf_req->vdev_id;
  1049. hb_tcp_params_fp->srv_ip = lphb_conf_req->srv_ip;
  1050. hb_tcp_params_fp->dev_ip = lphb_conf_req->dev_ip;
  1051. hb_tcp_params_fp->seq = lphb_conf_req->seq;
  1052. hb_tcp_params_fp->src_port = lphb_conf_req->src_port;
  1053. hb_tcp_params_fp->dst_port = lphb_conf_req->dst_port;
  1054. hb_tcp_params_fp->interval = lphb_conf_req->interval;
  1055. hb_tcp_params_fp->timeout = lphb_conf_req->timeout;
  1056. hb_tcp_params_fp->session = lphb_conf_req->session;
  1057. qdf_mem_copy(&hb_tcp_params_fp->gateway_mac,
  1058. &lphb_conf_req->gateway_mac,
  1059. sizeof(hb_tcp_params_fp->gateway_mac));
  1060. wmi_mtrace(WMI_HB_SET_TCP_PARAMS_CMDID, NO_SESSION, 0);
  1061. status = wmi_unified_cmd_send(wmi_handle, buf,
  1062. len, WMI_HB_SET_TCP_PARAMS_CMDID);
  1063. if (QDF_IS_STATUS_ERROR(status)) {
  1064. WMI_LOGE("cmd_send WMI_HB_SET_TCP_PARAMS returned Error %d",
  1065. status);
  1066. wmi_buf_free(buf);
  1067. }
  1068. return status;
  1069. }
  1070. /**
  1071. * send_lphb_config_tcp_pkt_filter_cmd_tlv() - configure tcp packet filter cmd
  1072. * @wmi_handle: wmi handle
  1073. * @lphb_conf_req: lphb config request
  1074. *
  1075. * Return: CDF status
  1076. */
  1077. static
  1078. QDF_STATUS send_lphb_config_tcp_pkt_filter_cmd_tlv(wmi_unified_t wmi_handle,
  1079. wmi_hb_set_tcp_pkt_filter_cmd_fixed_param *g_hb_tcp_filter_fp)
  1080. {
  1081. QDF_STATUS status;
  1082. wmi_buf_t buf = NULL;
  1083. uint8_t *buf_ptr;
  1084. wmi_hb_set_tcp_pkt_filter_cmd_fixed_param *hb_tcp_filter_fp;
  1085. int len = sizeof(wmi_hb_set_tcp_pkt_filter_cmd_fixed_param);
  1086. buf = wmi_buf_alloc(wmi_handle, len);
  1087. if (!buf) {
  1088. return QDF_STATUS_E_NOMEM;
  1089. }
  1090. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1091. hb_tcp_filter_fp =
  1092. (wmi_hb_set_tcp_pkt_filter_cmd_fixed_param *) buf_ptr;
  1093. WMITLV_SET_HDR(&hb_tcp_filter_fp->tlv_header,
  1094. WMITLV_TAG_STRUC_wmi_hb_set_tcp_pkt_filter_cmd_fixed_param,
  1095. WMITLV_GET_STRUCT_TLVLEN
  1096. (wmi_hb_set_tcp_pkt_filter_cmd_fixed_param));
  1097. /* fill in values */
  1098. hb_tcp_filter_fp->vdev_id = g_hb_tcp_filter_fp->vdev_id;
  1099. hb_tcp_filter_fp->length = g_hb_tcp_filter_fp->length;
  1100. hb_tcp_filter_fp->offset = g_hb_tcp_filter_fp->offset;
  1101. hb_tcp_filter_fp->session = g_hb_tcp_filter_fp->session;
  1102. memcpy((void *)&hb_tcp_filter_fp->filter,
  1103. (void *)&g_hb_tcp_filter_fp->filter,
  1104. WMI_WLAN_HB_MAX_FILTER_SIZE);
  1105. wmi_mtrace(WMI_HB_SET_TCP_PKT_FILTER_CMDID, NO_SESSION, 0);
  1106. status = wmi_unified_cmd_send(wmi_handle, buf,
  1107. len, WMI_HB_SET_TCP_PKT_FILTER_CMDID);
  1108. if (QDF_IS_STATUS_ERROR(status)) {
  1109. WMI_LOGE("cmd_send WMI_HB_SET_TCP_PKT_FILTER returned Error %d",
  1110. status);
  1111. wmi_buf_free(buf);
  1112. }
  1113. return status;
  1114. }
  1115. /**
  1116. * send_lphb_config_udp_params_cmd_tlv() - configure udp param command of LPHB
  1117. * @wmi_handle: wmi handle
  1118. * @lphb_conf_req: lphb config request
  1119. *
  1120. * Return: CDF status
  1121. */
  1122. static QDF_STATUS send_lphb_config_udp_params_cmd_tlv(wmi_unified_t wmi_handle,
  1123. wmi_hb_set_udp_params_cmd_fixed_param *lphb_conf_req)
  1124. {
  1125. QDF_STATUS status;
  1126. wmi_buf_t buf = NULL;
  1127. uint8_t *buf_ptr;
  1128. wmi_hb_set_udp_params_cmd_fixed_param *hb_udp_params_fp;
  1129. int len = sizeof(wmi_hb_set_udp_params_cmd_fixed_param);
  1130. buf = wmi_buf_alloc(wmi_handle, len);
  1131. if (!buf) {
  1132. return QDF_STATUS_E_NOMEM;
  1133. }
  1134. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1135. hb_udp_params_fp = (wmi_hb_set_udp_params_cmd_fixed_param *) buf_ptr;
  1136. WMITLV_SET_HDR(&hb_udp_params_fp->tlv_header,
  1137. WMITLV_TAG_STRUC_wmi_hb_set_udp_params_cmd_fixed_param,
  1138. WMITLV_GET_STRUCT_TLVLEN
  1139. (wmi_hb_set_udp_params_cmd_fixed_param));
  1140. /* fill in values */
  1141. hb_udp_params_fp->vdev_id = lphb_conf_req->vdev_id;
  1142. hb_udp_params_fp->srv_ip = lphb_conf_req->srv_ip;
  1143. hb_udp_params_fp->dev_ip = lphb_conf_req->dev_ip;
  1144. hb_udp_params_fp->src_port = lphb_conf_req->src_port;
  1145. hb_udp_params_fp->dst_port = lphb_conf_req->dst_port;
  1146. hb_udp_params_fp->interval = lphb_conf_req->interval;
  1147. hb_udp_params_fp->timeout = lphb_conf_req->timeout;
  1148. hb_udp_params_fp->session = lphb_conf_req->session;
  1149. qdf_mem_copy(&hb_udp_params_fp->gateway_mac,
  1150. &lphb_conf_req->gateway_mac,
  1151. sizeof(lphb_conf_req->gateway_mac));
  1152. wmi_mtrace(WMI_HB_SET_UDP_PARAMS_CMDID, NO_SESSION, 0);
  1153. status = wmi_unified_cmd_send(wmi_handle, buf,
  1154. len, WMI_HB_SET_UDP_PARAMS_CMDID);
  1155. if (QDF_IS_STATUS_ERROR(status)) {
  1156. WMI_LOGE("cmd_send WMI_HB_SET_UDP_PARAMS returned Error %d",
  1157. status);
  1158. wmi_buf_free(buf);
  1159. }
  1160. return status;
  1161. }
  1162. /**
  1163. * send_lphb_config_udp_pkt_filter_cmd_tlv() - configure udp pkt filter command
  1164. * @wmi_handle: wmi handle
  1165. * @lphb_conf_req: lphb config request
  1166. *
  1167. * Return: CDF status
  1168. */
  1169. static
  1170. QDF_STATUS send_lphb_config_udp_pkt_filter_cmd_tlv(wmi_unified_t wmi_handle,
  1171. wmi_hb_set_udp_pkt_filter_cmd_fixed_param *lphb_conf_req)
  1172. {
  1173. QDF_STATUS status;
  1174. wmi_buf_t buf = NULL;
  1175. uint8_t *buf_ptr;
  1176. wmi_hb_set_udp_pkt_filter_cmd_fixed_param *hb_udp_filter_fp;
  1177. int len = sizeof(wmi_hb_set_udp_pkt_filter_cmd_fixed_param);
  1178. buf = wmi_buf_alloc(wmi_handle, len);
  1179. if (!buf) {
  1180. return QDF_STATUS_E_NOMEM;
  1181. }
  1182. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1183. hb_udp_filter_fp =
  1184. (wmi_hb_set_udp_pkt_filter_cmd_fixed_param *) buf_ptr;
  1185. WMITLV_SET_HDR(&hb_udp_filter_fp->tlv_header,
  1186. WMITLV_TAG_STRUC_wmi_hb_set_udp_pkt_filter_cmd_fixed_param,
  1187. WMITLV_GET_STRUCT_TLVLEN
  1188. (wmi_hb_set_udp_pkt_filter_cmd_fixed_param));
  1189. /* fill in values */
  1190. hb_udp_filter_fp->vdev_id = lphb_conf_req->vdev_id;
  1191. hb_udp_filter_fp->length = lphb_conf_req->length;
  1192. hb_udp_filter_fp->offset = lphb_conf_req->offset;
  1193. hb_udp_filter_fp->session = lphb_conf_req->session;
  1194. memcpy((void *)&hb_udp_filter_fp->filter,
  1195. (void *)&lphb_conf_req->filter,
  1196. WMI_WLAN_HB_MAX_FILTER_SIZE);
  1197. wmi_mtrace(WMI_HB_SET_UDP_PKT_FILTER_CMDID, NO_SESSION, 0);
  1198. status = wmi_unified_cmd_send(wmi_handle, buf,
  1199. len, WMI_HB_SET_UDP_PKT_FILTER_CMDID);
  1200. if (QDF_IS_STATUS_ERROR(status)) {
  1201. WMI_LOGE("cmd_send WMI_HB_SET_UDP_PKT_FILTER returned Error %d",
  1202. status);
  1203. wmi_buf_free(buf);
  1204. }
  1205. return status;
  1206. }
  1207. void wmi_lphb_attach_tlv(struct wmi_unified *wmi_handle)
  1208. {
  1209. struct wmi_ops *ops = wmi_handle->ops;
  1210. ops->send_lphb_config_hbenable_cmd =
  1211. send_lphb_config_hbenable_cmd_tlv;
  1212. ops->send_lphb_config_tcp_params_cmd =
  1213. send_lphb_config_tcp_params_cmd_tlv;
  1214. ops->send_lphb_config_tcp_pkt_filter_cmd =
  1215. send_lphb_config_tcp_pkt_filter_cmd_tlv;
  1216. ops->send_lphb_config_udp_params_cmd =
  1217. send_lphb_config_udp_params_cmd_tlv;
  1218. ops->send_lphb_config_udp_pkt_filter_cmd =
  1219. send_lphb_config_udp_pkt_filter_cmd_tlv;
  1220. }
  1221. #endif /* FEATURE_WLAN_LPHB */
  1222. #ifdef WLAN_FEATURE_PACKET_FILTERING
  1223. /**
  1224. * send_enable_disable_packet_filter_cmd_tlv() - enable/disable packet filter
  1225. * @wmi_handle: wmi handle
  1226. * @vdev_id: vdev id
  1227. * @enable: Flag to enable/disable packet filter
  1228. *
  1229. * Return: QDF_STATUS_SUCCESS for success or error code
  1230. */
  1231. static QDF_STATUS send_enable_disable_packet_filter_cmd_tlv(
  1232. wmi_unified_t wmi_handle, uint8_t vdev_id, bool enable)
  1233. {
  1234. int32_t len;
  1235. int ret = 0;
  1236. wmi_buf_t buf;
  1237. WMI_PACKET_FILTER_ENABLE_CMD_fixed_param *cmd;
  1238. len = sizeof(WMI_PACKET_FILTER_ENABLE_CMD_fixed_param);
  1239. buf = wmi_buf_alloc(wmi_handle, len);
  1240. if (!buf) {
  1241. return QDF_STATUS_E_NOMEM;
  1242. }
  1243. cmd = (WMI_PACKET_FILTER_ENABLE_CMD_fixed_param *) wmi_buf_data(buf);
  1244. WMITLV_SET_HDR(&cmd->tlv_header,
  1245. WMITLV_TAG_STRUC_wmi_packet_filter_enable_fixed_param,
  1246. WMITLV_GET_STRUCT_TLVLEN(
  1247. WMI_PACKET_FILTER_ENABLE_CMD_fixed_param));
  1248. cmd->vdev_id = vdev_id;
  1249. if (enable)
  1250. cmd->enable = PACKET_FILTER_SET_ENABLE;
  1251. else
  1252. cmd->enable = PACKET_FILTER_SET_DISABLE;
  1253. WMI_LOGE("%s: Packet filter enable %d for vdev_id %d",
  1254. __func__, cmd->enable, vdev_id);
  1255. wmi_mtrace(WMI_PACKET_FILTER_ENABLE_CMDID, cmd->vdev_id, 0);
  1256. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1257. WMI_PACKET_FILTER_ENABLE_CMDID);
  1258. if (ret) {
  1259. WMI_LOGE("Failed to send packet filter wmi cmd to fw");
  1260. wmi_buf_free(buf);
  1261. }
  1262. return ret;
  1263. }
  1264. /**
  1265. * send_config_packet_filter_cmd_tlv() - configure packet filter in target
  1266. * @wmi_handle: wmi handle
  1267. * @vdev_id: vdev id
  1268. * @rcv_filter_param: Packet filter parameters
  1269. * @filter_id: Filter id
  1270. * @enable: Flag to add/delete packet filter configuration
  1271. *
  1272. * Return: QDF_STATUS_SUCCESS for success or error code
  1273. */
  1274. static QDF_STATUS send_config_packet_filter_cmd_tlv(wmi_unified_t wmi_handle,
  1275. uint8_t vdev_id, struct pmo_rcv_pkt_fltr_cfg *rcv_filter_param,
  1276. uint8_t filter_id, bool enable)
  1277. {
  1278. int len, i;
  1279. int err = 0;
  1280. wmi_buf_t buf;
  1281. WMI_PACKET_FILTER_CONFIG_CMD_fixed_param *cmd;
  1282. /* allocate the memory */
  1283. len = sizeof(*cmd);
  1284. buf = wmi_buf_alloc(wmi_handle, len);
  1285. if (!buf) {
  1286. return QDF_STATUS_E_NOMEM;
  1287. }
  1288. cmd = (WMI_PACKET_FILTER_CONFIG_CMD_fixed_param *)wmi_buf_data(buf);
  1289. WMITLV_SET_HDR(&cmd->tlv_header,
  1290. WMITLV_TAG_STRUC_wmi_packet_filter_config_fixed_param,
  1291. WMITLV_GET_STRUCT_TLVLEN
  1292. (WMI_PACKET_FILTER_CONFIG_CMD_fixed_param));
  1293. cmd->vdev_id = vdev_id;
  1294. cmd->filter_id = filter_id;
  1295. if (enable)
  1296. cmd->filter_action = PACKET_FILTER_SET_ACTIVE;
  1297. else
  1298. cmd->filter_action = PACKET_FILTER_SET_INACTIVE;
  1299. if (enable) {
  1300. cmd->num_params = QDF_MIN(
  1301. WMI_PACKET_FILTER_MAX_CMP_PER_PACKET_FILTER,
  1302. rcv_filter_param->num_params);
  1303. cmd->filter_type = rcv_filter_param->filter_type;
  1304. cmd->coalesce_time = rcv_filter_param->coalesce_time;
  1305. for (i = 0; i < cmd->num_params; i++) {
  1306. cmd->paramsData[i].proto_type =
  1307. rcv_filter_param->params_data[i].protocol_layer;
  1308. cmd->paramsData[i].cmp_type =
  1309. rcv_filter_param->params_data[i].compare_flag;
  1310. cmd->paramsData[i].data_length =
  1311. rcv_filter_param->params_data[i].data_length;
  1312. cmd->paramsData[i].data_offset =
  1313. rcv_filter_param->params_data[i].data_offset;
  1314. memcpy(&cmd->paramsData[i].compareData,
  1315. rcv_filter_param->params_data[i].compare_data,
  1316. sizeof(cmd->paramsData[i].compareData));
  1317. memcpy(&cmd->paramsData[i].dataMask,
  1318. rcv_filter_param->params_data[i].data_mask,
  1319. sizeof(cmd->paramsData[i].dataMask));
  1320. }
  1321. }
  1322. WMI_LOGE("Packet filter action %d filter with id: %d, num_params=%d",
  1323. cmd->filter_action, cmd->filter_id, cmd->num_params);
  1324. /* send the command along with data */
  1325. wmi_mtrace(WMI_PACKET_FILTER_CONFIG_CMDID, cmd->vdev_id, 0);
  1326. err = wmi_unified_cmd_send(wmi_handle, buf, len,
  1327. WMI_PACKET_FILTER_CONFIG_CMDID);
  1328. if (err) {
  1329. WMI_LOGE("Failed to send pkt_filter cmd");
  1330. wmi_buf_free(buf);
  1331. return QDF_STATUS_E_FAILURE;
  1332. }
  1333. return QDF_STATUS_SUCCESS;
  1334. }
  1335. void wmi_packet_filtering_attach_tlv(struct wmi_unified *wmi_handle)
  1336. {
  1337. struct wmi_ops *ops = wmi_handle->ops;
  1338. ops->send_enable_disable_packet_filter_cmd =
  1339. send_enable_disable_packet_filter_cmd_tlv;
  1340. ops->send_config_packet_filter_cmd =
  1341. send_config_packet_filter_cmd_tlv;
  1342. }
  1343. #endif /* WLAN_FEATURE_PACKET_FILTERING */
  1344. /**
  1345. * send_wow_delete_pattern_cmd_tlv() - delete wow pattern in target
  1346. * @wmi_handle: wmi handle
  1347. * @ptrn_id: pattern id
  1348. * @vdev_id: vdev id
  1349. *
  1350. * Return: CDF status
  1351. */
  1352. static QDF_STATUS send_wow_delete_pattern_cmd_tlv(wmi_unified_t wmi_handle,
  1353. uint8_t ptrn_id,
  1354. uint8_t vdev_id)
  1355. {
  1356. WMI_WOW_DEL_PATTERN_CMD_fixed_param *cmd;
  1357. wmi_buf_t buf;
  1358. int32_t len;
  1359. int ret;
  1360. len = sizeof(WMI_WOW_DEL_PATTERN_CMD_fixed_param);
  1361. buf = wmi_buf_alloc(wmi_handle, len);
  1362. if (!buf) {
  1363. return QDF_STATUS_E_NOMEM;
  1364. }
  1365. cmd = (WMI_WOW_DEL_PATTERN_CMD_fixed_param *) wmi_buf_data(buf);
  1366. WMITLV_SET_HDR(&cmd->tlv_header,
  1367. WMITLV_TAG_STRUC_WMI_WOW_DEL_PATTERN_CMD_fixed_param,
  1368. WMITLV_GET_STRUCT_TLVLEN(
  1369. WMI_WOW_DEL_PATTERN_CMD_fixed_param));
  1370. cmd->vdev_id = vdev_id;
  1371. cmd->pattern_id = ptrn_id;
  1372. cmd->pattern_type = WOW_BITMAP_PATTERN;
  1373. WMI_LOGI("Deleting pattern id: %d vdev id %d in fw",
  1374. cmd->pattern_id, vdev_id);
  1375. wmi_mtrace(WMI_WOW_DEL_WAKE_PATTERN_CMDID, cmd->vdev_id, 0);
  1376. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1377. WMI_WOW_DEL_WAKE_PATTERN_CMDID);
  1378. if (ret) {
  1379. WMI_LOGE("%s: Failed to delete wow ptrn from fw", __func__);
  1380. wmi_buf_free(buf);
  1381. return QDF_STATUS_E_FAILURE;
  1382. }
  1383. return QDF_STATUS_SUCCESS;
  1384. }
  1385. /**
  1386. * send_host_wakeup_ind_to_fw_cmd_tlv() - send wakeup ind to fw
  1387. * @wmi_handle: wmi handle
  1388. *
  1389. * Sends host wakeup indication to FW. On receiving this indication,
  1390. * FW will come out of WOW.
  1391. *
  1392. * Return: CDF status
  1393. */
  1394. static QDF_STATUS send_host_wakeup_ind_to_fw_cmd_tlv(wmi_unified_t wmi_handle)
  1395. {
  1396. wmi_wow_hostwakeup_from_sleep_cmd_fixed_param *cmd;
  1397. wmi_buf_t buf;
  1398. QDF_STATUS qdf_status = QDF_STATUS_SUCCESS;
  1399. int32_t len;
  1400. int ret;
  1401. len = sizeof(wmi_wow_hostwakeup_from_sleep_cmd_fixed_param);
  1402. buf = wmi_buf_alloc(wmi_handle, len);
  1403. if (!buf) {
  1404. return QDF_STATUS_E_NOMEM;
  1405. }
  1406. cmd = (wmi_wow_hostwakeup_from_sleep_cmd_fixed_param *)
  1407. wmi_buf_data(buf);
  1408. WMITLV_SET_HDR(&cmd->tlv_header,
  1409. WMITLV_TAG_STRUC_wmi_wow_hostwakeup_from_sleep_cmd_fixed_param,
  1410. WMITLV_GET_STRUCT_TLVLEN
  1411. (wmi_wow_hostwakeup_from_sleep_cmd_fixed_param));
  1412. wmi_mtrace(WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID, NO_SESSION, 0);
  1413. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1414. WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID);
  1415. if (ret) {
  1416. WMI_LOGE("Failed to send host wakeup indication to fw");
  1417. wmi_buf_free(buf);
  1418. return QDF_STATUS_E_FAILURE;
  1419. }
  1420. return qdf_status;
  1421. }
  1422. /**
  1423. * send_wow_timer_pattern_cmd_tlv() - set timer pattern tlv, so that firmware
  1424. * will wake up host after specified time is elapsed
  1425. * @wmi_handle: wmi handle
  1426. * @vdev_id: vdev id
  1427. * @cookie: value to identify reason why host set up wake call.
  1428. * @time: time in ms
  1429. *
  1430. * Return: QDF status
  1431. */
  1432. static QDF_STATUS send_wow_timer_pattern_cmd_tlv(wmi_unified_t wmi_handle,
  1433. uint8_t vdev_id, uint32_t cookie, uint32_t time)
  1434. {
  1435. WMI_WOW_ADD_PATTERN_CMD_fixed_param *cmd;
  1436. wmi_buf_t buf;
  1437. uint8_t *buf_ptr;
  1438. int32_t len;
  1439. int ret;
  1440. len = sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param) +
  1441. WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_BITMAP_PATTERN_T) +
  1442. WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_IPV4_SYNC_PATTERN_T) +
  1443. WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_IPV6_SYNC_PATTERN_T) +
  1444. WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_MAGIC_PATTERN_CMD) +
  1445. WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t) +
  1446. WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t);
  1447. buf = wmi_buf_alloc(wmi_handle, len);
  1448. if (!buf) {
  1449. return QDF_STATUS_E_NOMEM;
  1450. }
  1451. cmd = (WMI_WOW_ADD_PATTERN_CMD_fixed_param *) wmi_buf_data(buf);
  1452. buf_ptr = (uint8_t *) cmd;
  1453. WMITLV_SET_HDR(&cmd->tlv_header,
  1454. WMITLV_TAG_STRUC_WMI_WOW_ADD_PATTERN_CMD_fixed_param,
  1455. WMITLV_GET_STRUCT_TLVLEN
  1456. (WMI_WOW_ADD_PATTERN_CMD_fixed_param));
  1457. cmd->vdev_id = vdev_id;
  1458. cmd->pattern_id = cookie,
  1459. cmd->pattern_type = WOW_TIMER_PATTERN;
  1460. buf_ptr += sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param);
  1461. /* Fill TLV for WMITLV_TAG_STRUC_WOW_BITMAP_PATTERN_T but no data. */
  1462. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  1463. buf_ptr += WMI_TLV_HDR_SIZE;
  1464. /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV4_SYNC_PATTERN_T but no data. */
  1465. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  1466. buf_ptr += WMI_TLV_HDR_SIZE;
  1467. /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV6_SYNC_PATTERN_T but no data. */
  1468. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  1469. buf_ptr += WMI_TLV_HDR_SIZE;
  1470. /* Fill TLV for WMITLV_TAG_STRUC_WOW_MAGIC_PATTERN_CMD but no data. */
  1471. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  1472. buf_ptr += WMI_TLV_HDR_SIZE;
  1473. /* Fill TLV for pattern_info_timeout, and time value */
  1474. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, sizeof(uint32_t));
  1475. buf_ptr += WMI_TLV_HDR_SIZE;
  1476. *((uint32_t *) buf_ptr) = time;
  1477. buf_ptr += sizeof(uint32_t);
  1478. /* Fill TLV for ra_ratelimit_interval. with dummy 0 value */
  1479. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, sizeof(uint32_t));
  1480. buf_ptr += WMI_TLV_HDR_SIZE;
  1481. *((uint32_t *) buf_ptr) = 0;
  1482. WMI_LOGD("%s: send wake timer pattern with time[%d] to fw vdev = %d",
  1483. __func__, time, vdev_id);
  1484. wmi_mtrace(WMI_WOW_ADD_WAKE_PATTERN_CMDID, cmd->vdev_id, 0);
  1485. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1486. WMI_WOW_ADD_WAKE_PATTERN_CMDID);
  1487. if (ret) {
  1488. WMI_LOGE("%s: Failed to send wake timer pattern to fw",
  1489. __func__);
  1490. wmi_buf_free(buf);
  1491. return QDF_STATUS_E_FAILURE;
  1492. }
  1493. return QDF_STATUS_SUCCESS;
  1494. }
  1495. #ifdef WLAN_FEATURE_EXTWOW_SUPPORT
  1496. /**
  1497. * send_enable_ext_wow_cmd_tlv() - enable ext wow in fw
  1498. * @wmi_handle: wmi handle
  1499. * @params: ext wow params
  1500. *
  1501. * Return:0 for success or error code
  1502. */
  1503. static QDF_STATUS send_enable_ext_wow_cmd_tlv(wmi_unified_t wmi_handle,
  1504. struct ext_wow_params *params)
  1505. {
  1506. wmi_extwow_enable_cmd_fixed_param *cmd;
  1507. wmi_buf_t buf;
  1508. int32_t len;
  1509. int ret;
  1510. len = sizeof(wmi_extwow_enable_cmd_fixed_param);
  1511. buf = wmi_buf_alloc(wmi_handle, len);
  1512. if (!buf) {
  1513. return QDF_STATUS_E_NOMEM;
  1514. }
  1515. cmd = (wmi_extwow_enable_cmd_fixed_param *) wmi_buf_data(buf);
  1516. WMITLV_SET_HDR(&cmd->tlv_header,
  1517. WMITLV_TAG_STRUC_wmi_extwow_enable_cmd_fixed_param,
  1518. WMITLV_GET_STRUCT_TLVLEN
  1519. (wmi_extwow_enable_cmd_fixed_param));
  1520. cmd->vdev_id = params->vdev_id;
  1521. cmd->type = params->type;
  1522. cmd->wakeup_pin_num = params->wakeup_pin_num;
  1523. WMI_LOGD("%s: vdev_id %d type %d Wakeup_pin_num %x",
  1524. __func__, cmd->vdev_id, cmd->type, cmd->wakeup_pin_num);
  1525. wmi_mtrace(WMI_EXTWOW_ENABLE_CMDID, cmd->vdev_id, 0);
  1526. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1527. WMI_EXTWOW_ENABLE_CMDID);
  1528. if (ret) {
  1529. WMI_LOGE("%s: Failed to set EXTWOW Enable", __func__);
  1530. wmi_buf_free(buf);
  1531. return QDF_STATUS_E_FAILURE;
  1532. }
  1533. return QDF_STATUS_SUCCESS;
  1534. }
  1535. /**
  1536. * send_set_app_type2_params_in_fw_cmd_tlv() - set app type2 params in fw
  1537. * @wmi_handle: wmi handle
  1538. * @appType2Params: app type2 params
  1539. *
  1540. * Return: CDF status
  1541. */
  1542. static QDF_STATUS send_set_app_type2_params_in_fw_cmd_tlv(wmi_unified_t wmi_handle,
  1543. struct app_type2_params *appType2Params)
  1544. {
  1545. wmi_extwow_set_app_type2_params_cmd_fixed_param *cmd;
  1546. wmi_buf_t buf;
  1547. int32_t len;
  1548. int ret;
  1549. len = sizeof(wmi_extwow_set_app_type2_params_cmd_fixed_param);
  1550. buf = wmi_buf_alloc(wmi_handle, len);
  1551. if (!buf) {
  1552. return QDF_STATUS_E_NOMEM;
  1553. }
  1554. cmd = (wmi_extwow_set_app_type2_params_cmd_fixed_param *)
  1555. wmi_buf_data(buf);
  1556. WMITLV_SET_HDR(&cmd->tlv_header,
  1557. WMITLV_TAG_STRUC_wmi_extwow_set_app_type2_params_cmd_fixed_param,
  1558. WMITLV_GET_STRUCT_TLVLEN
  1559. (wmi_extwow_set_app_type2_params_cmd_fixed_param));
  1560. cmd->vdev_id = appType2Params->vdev_id;
  1561. qdf_mem_copy(cmd->rc4_key, appType2Params->rc4_key, 16);
  1562. cmd->rc4_key_len = appType2Params->rc4_key_len;
  1563. cmd->ip_id = appType2Params->ip_id;
  1564. cmd->ip_device_ip = appType2Params->ip_device_ip;
  1565. cmd->ip_server_ip = appType2Params->ip_server_ip;
  1566. cmd->tcp_src_port = appType2Params->tcp_src_port;
  1567. cmd->tcp_dst_port = appType2Params->tcp_dst_port;
  1568. cmd->tcp_seq = appType2Params->tcp_seq;
  1569. cmd->tcp_ack_seq = appType2Params->tcp_ack_seq;
  1570. cmd->keepalive_init = appType2Params->keepalive_init;
  1571. cmd->keepalive_min = appType2Params->keepalive_min;
  1572. cmd->keepalive_max = appType2Params->keepalive_max;
  1573. cmd->keepalive_inc = appType2Params->keepalive_inc;
  1574. WMI_CHAR_ARRAY_TO_MAC_ADDR(appType2Params->gateway_mac.bytes,
  1575. &cmd->gateway_mac);
  1576. cmd->tcp_tx_timeout_val = appType2Params->tcp_tx_timeout_val;
  1577. cmd->tcp_rx_timeout_val = appType2Params->tcp_rx_timeout_val;
  1578. WMI_LOGD("%s: vdev_id %d gateway_mac %pM "
  1579. "rc4_key %.16s rc4_key_len %u "
  1580. "ip_id %x ip_device_ip %x ip_server_ip %x "
  1581. "tcp_src_port %u tcp_dst_port %u tcp_seq %u "
  1582. "tcp_ack_seq %u keepalive_init %u keepalive_min %u "
  1583. "keepalive_max %u keepalive_inc %u "
  1584. "tcp_tx_timeout_val %u tcp_rx_timeout_val %u",
  1585. __func__, cmd->vdev_id, appType2Params->gateway_mac.bytes,
  1586. cmd->rc4_key, cmd->rc4_key_len,
  1587. cmd->ip_id, cmd->ip_device_ip, cmd->ip_server_ip,
  1588. cmd->tcp_src_port, cmd->tcp_dst_port, cmd->tcp_seq,
  1589. cmd->tcp_ack_seq, cmd->keepalive_init, cmd->keepalive_min,
  1590. cmd->keepalive_max, cmd->keepalive_inc,
  1591. cmd->tcp_tx_timeout_val, cmd->tcp_rx_timeout_val);
  1592. wmi_mtrace(WMI_EXTWOW_SET_APP_TYPE2_PARAMS_CMDID, cmd->vdev_id, 0);
  1593. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1594. WMI_EXTWOW_SET_APP_TYPE2_PARAMS_CMDID);
  1595. if (ret) {
  1596. WMI_LOGE("%s: Failed to set APP TYPE2 PARAMS", __func__);
  1597. wmi_buf_free(buf);
  1598. return QDF_STATUS_E_FAILURE;
  1599. }
  1600. return QDF_STATUS_SUCCESS;
  1601. }
  1602. /**
  1603. * send_app_type1_params_in_fw_cmd_tlv() - set app type1 params in fw
  1604. * @wmi_handle: wmi handle
  1605. * @app_type1_params: app type1 params
  1606. *
  1607. * Return: CDF status
  1608. */
  1609. static QDF_STATUS send_app_type1_params_in_fw_cmd_tlv(wmi_unified_t wmi_handle,
  1610. struct app_type1_params *app_type1_params)
  1611. {
  1612. wmi_extwow_set_app_type1_params_cmd_fixed_param *cmd;
  1613. wmi_buf_t buf;
  1614. int32_t len;
  1615. int ret;
  1616. len = sizeof(wmi_extwow_set_app_type1_params_cmd_fixed_param);
  1617. buf = wmi_buf_alloc(wmi_handle, len);
  1618. if (!buf) {
  1619. return QDF_STATUS_E_NOMEM;
  1620. }
  1621. cmd = (wmi_extwow_set_app_type1_params_cmd_fixed_param *)
  1622. wmi_buf_data(buf);
  1623. WMITLV_SET_HDR(&cmd->tlv_header,
  1624. WMITLV_TAG_STRUC_wmi_extwow_set_app_type1_params_cmd_fixed_param,
  1625. WMITLV_GET_STRUCT_TLVLEN
  1626. (wmi_extwow_set_app_type1_params_cmd_fixed_param));
  1627. cmd->vdev_id = app_type1_params->vdev_id;
  1628. WMI_CHAR_ARRAY_TO_MAC_ADDR(app_type1_params->wakee_mac_addr.bytes,
  1629. &cmd->wakee_mac);
  1630. qdf_mem_copy(cmd->ident, app_type1_params->identification_id, 8);
  1631. cmd->ident_len = app_type1_params->id_length;
  1632. qdf_mem_copy(cmd->passwd, app_type1_params->password, 16);
  1633. cmd->passwd_len = app_type1_params->pass_length;
  1634. WMI_LOGD("%s: vdev_id %d wakee_mac_addr %pM "
  1635. "identification_id %.8s id_length %u "
  1636. "password %.16s pass_length %u",
  1637. __func__, cmd->vdev_id, app_type1_params->wakee_mac_addr.bytes,
  1638. cmd->ident, cmd->ident_len, cmd->passwd, cmd->passwd_len);
  1639. wmi_mtrace(WMI_EXTWOW_SET_APP_TYPE1_PARAMS_CMDID, cmd->vdev_id, 0);
  1640. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1641. WMI_EXTWOW_SET_APP_TYPE1_PARAMS_CMDID);
  1642. if (ret) {
  1643. WMI_LOGE("%s: Failed to set APP TYPE1 PARAMS", __func__);
  1644. wmi_buf_free(buf);
  1645. return QDF_STATUS_E_FAILURE;
  1646. }
  1647. return QDF_STATUS_SUCCESS;
  1648. }
  1649. void wmi_extwow_attach_tlv(struct wmi_unified *wmi_handle)
  1650. {
  1651. struct wmi_ops *ops = wmi_handle->ops;
  1652. ops->send_enable_ext_wow_cmd = send_enable_ext_wow_cmd_tlv;
  1653. ops->send_set_app_type2_params_in_fw_cmd =
  1654. send_set_app_type2_params_in_fw_cmd_tlv;
  1655. ops->send_app_type1_params_in_fw_cmd =
  1656. send_app_type1_params_in_fw_cmd_tlv;
  1657. }
  1658. #endif /* WLAN_FEATURE_EXTWOW_SUPPORT */
  1659. void wmi_pmo_attach_tlv(wmi_unified_t wmi_handle)
  1660. {
  1661. struct wmi_ops *ops = wmi_handle->ops;
  1662. ops->send_add_wow_wakeup_event_cmd =
  1663. send_add_wow_wakeup_event_cmd_tlv;
  1664. ops->send_wow_patterns_to_fw_cmd = send_wow_patterns_to_fw_cmd_tlv;
  1665. ops->send_enable_arp_ns_offload_cmd =
  1666. send_enable_arp_ns_offload_cmd_tlv;
  1667. ops->send_add_clear_mcbc_filter_cmd =
  1668. send_add_clear_mcbc_filter_cmd_tlv;
  1669. ops->send_multiple_add_clear_mcbc_filter_cmd =
  1670. send_multiple_add_clear_mcbc_filter_cmd_tlv;
  1671. ops->send_conf_hw_filter_cmd = send_conf_hw_filter_cmd_tlv;
  1672. ops->send_gtk_offload_cmd = send_gtk_offload_cmd_tlv;
  1673. ops->send_process_gtk_offload_getinfo_cmd =
  1674. send_process_gtk_offload_getinfo_cmd_tlv;
  1675. ops->send_enable_enhance_multicast_offload_cmd =
  1676. send_enable_enhance_multicast_offload_tlv;
  1677. ops->extract_gtk_rsp_event = extract_gtk_rsp_event_tlv;
  1678. ops->send_action_frame_patterns_cmd =
  1679. send_action_frame_patterns_cmd_tlv;
  1680. ops->send_wow_delete_pattern_cmd = send_wow_delete_pattern_cmd_tlv;
  1681. ops->send_host_wakeup_ind_to_fw_cmd =
  1682. send_host_wakeup_ind_to_fw_cmd_tlv;
  1683. ops->send_wow_timer_pattern_cmd = send_wow_timer_pattern_cmd_tlv;
  1684. wmi_d0wow_attach_tlv(wmi_handle);
  1685. wmi_ra_filtering_attach_tlv(wmi_handle);
  1686. wmi_lphb_attach_tlv(wmi_handle);
  1687. wmi_packet_filtering_attach_tlv(wmi_handle);
  1688. wmi_extwow_attach_tlv(wmi_handle);
  1689. }