wmi_unified_sta_tlv.c 77 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498
  1. /*
  2. * Copyright (c) 2013-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_version.h"
  21. #include "wmi_unified_priv.h"
  22. #include "wmi_unified_sta_param.h"
  23. #include "wmi_unified_sta_api.h"
  24. /**
  25. * send_set_sta_sa_query_param_cmd_tlv() - set sta sa query parameters
  26. * @wmi_handle: wmi handle
  27. * @vdev_id: vdev id
  28. * @max_retries: max retries
  29. * @retry_interval: retry interval
  30. * This function sets sta query related parameters in fw.
  31. *
  32. * Return: QDF_STATUS_SUCCESS for success otherwise failure
  33. */
  34. static QDF_STATUS send_set_sta_sa_query_param_cmd_tlv(wmi_unified_t wmi_handle,
  35. uint8_t vdev_id,
  36. uint32_t max_retries,
  37. uint32_t retry_interval)
  38. {
  39. wmi_buf_t buf;
  40. WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param *cmd;
  41. int len;
  42. len = sizeof(*cmd);
  43. buf = wmi_buf_alloc(wmi_handle, len);
  44. if (!buf) {
  45. return QDF_STATUS_E_FAILURE;
  46. }
  47. cmd = (WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param *)wmi_buf_data(buf);
  48. WMITLV_SET_HDR(&cmd->tlv_header,
  49. WMITLV_TAG_STRUC_WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param,
  50. WMITLV_GET_STRUCT_TLVLEN
  51. (WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param));
  52. cmd->vdev_id = vdev_id;
  53. cmd->sa_query_max_retry_count = max_retries;
  54. cmd->sa_query_retry_interval = retry_interval;
  55. WMI_LOGD(FL("STA sa query: vdev_id:%d interval:%u retry count:%d"),
  56. vdev_id, retry_interval, max_retries);
  57. wmi_mtrace(WMI_PMF_OFFLOAD_SET_SA_QUERY_CMDID, cmd->vdev_id, 0);
  58. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  59. WMI_PMF_OFFLOAD_SET_SA_QUERY_CMDID)) {
  60. WMI_LOGE(FL("Failed to offload STA SA Query"));
  61. wmi_buf_free(buf);
  62. return QDF_STATUS_E_FAILURE;
  63. }
  64. WMI_LOGD(FL("Exit :"));
  65. return 0;
  66. }
  67. /**
  68. * send_set_sta_keep_alive_cmd_tlv() - set sta keep alive parameters
  69. * @wmi_handle: wmi handle
  70. * @params: sta keep alive parameter
  71. *
  72. * This function sets keep alive related parameters in fw.
  73. *
  74. * Return: CDF status
  75. */
  76. static QDF_STATUS send_set_sta_keep_alive_cmd_tlv(wmi_unified_t wmi_handle,
  77. struct sta_params *params)
  78. {
  79. wmi_buf_t buf;
  80. WMI_STA_KEEPALIVE_CMD_fixed_param *cmd;
  81. WMI_STA_KEEPALVE_ARP_RESPONSE *arp_rsp;
  82. uint8_t *buf_ptr;
  83. int len;
  84. QDF_STATUS ret;
  85. WMI_LOGD("%s: Enter", __func__);
  86. len = sizeof(*cmd) + sizeof(*arp_rsp);
  87. buf = wmi_buf_alloc(wmi_handle, len);
  88. if (!buf) {
  89. return QDF_STATUS_E_FAILURE;
  90. }
  91. cmd = (WMI_STA_KEEPALIVE_CMD_fixed_param *) wmi_buf_data(buf);
  92. buf_ptr = (uint8_t *) cmd;
  93. WMITLV_SET_HDR(&cmd->tlv_header,
  94. WMITLV_TAG_STRUC_WMI_STA_KEEPALIVE_CMD_fixed_param,
  95. WMITLV_GET_STRUCT_TLVLEN
  96. (WMI_STA_KEEPALIVE_CMD_fixed_param));
  97. cmd->interval = params->timeperiod;
  98. cmd->enable = (params->timeperiod) ? 1 : 0;
  99. cmd->vdev_id = params->vdev_id;
  100. WMI_LOGD("Keep Alive: vdev_id:%d interval:%u method:%d", params->vdev_id,
  101. params->timeperiod, params->method);
  102. arp_rsp = (WMI_STA_KEEPALVE_ARP_RESPONSE *) (buf_ptr + sizeof(*cmd));
  103. WMITLV_SET_HDR(&arp_rsp->tlv_header,
  104. WMITLV_TAG_STRUC_WMI_STA_KEEPALVE_ARP_RESPONSE,
  105. WMITLV_GET_STRUCT_TLVLEN(WMI_STA_KEEPALVE_ARP_RESPONSE));
  106. if ((params->method == WMI_KEEP_ALIVE_UNSOLICIT_ARP_RSP) ||
  107. (params->method ==
  108. WMI_STA_KEEPALIVE_METHOD_GRATUITOUS_ARP_REQUEST)) {
  109. if ((NULL == params->hostv4addr) ||
  110. (NULL == params->destv4addr) ||
  111. (NULL == params->destmac)) {
  112. WMI_LOGE("%s: received null pointer, hostv4addr:%pK "
  113. "destv4addr:%pK destmac:%pK ", __func__,
  114. params->hostv4addr, params->destv4addr,
  115. params->destmac);
  116. wmi_buf_free(buf);
  117. return QDF_STATUS_E_FAILURE;
  118. }
  119. cmd->method = params->method;
  120. qdf_mem_copy(&arp_rsp->sender_prot_addr, params->hostv4addr,
  121. WMI_IPV4_ADDR_LEN);
  122. qdf_mem_copy(&arp_rsp->target_prot_addr, params->destv4addr,
  123. WMI_IPV4_ADDR_LEN);
  124. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->destmac, &arp_rsp->dest_mac_addr);
  125. } else {
  126. cmd->method = WMI_STA_KEEPALIVE_METHOD_NULL_FRAME;
  127. }
  128. wmi_mtrace(WMI_STA_KEEPALIVE_CMDID, cmd->vdev_id, 0);
  129. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  130. WMI_STA_KEEPALIVE_CMDID);
  131. if (QDF_IS_STATUS_ERROR(ret)) {
  132. WMI_LOGE("Failed to set KeepAlive");
  133. wmi_buf_free(buf);
  134. }
  135. WMI_LOGD("%s: Exit", __func__);
  136. return ret;
  137. }
  138. /**
  139. * send_vdev_set_gtx_cfg_cmd_tlv() - set GTX params
  140. * @wmi_handle: wmi handle
  141. * @if_id: vdev id
  142. * @gtx_info: GTX config params
  143. *
  144. * This function set GTX related params in firmware.
  145. *
  146. * Return: QDF_STATUS_SUCCESS for success or error code
  147. */
  148. static QDF_STATUS send_vdev_set_gtx_cfg_cmd_tlv(wmi_unified_t wmi_handle, uint32_t if_id,
  149. struct wmi_gtx_config *gtx_info)
  150. {
  151. wmi_vdev_set_gtx_params_cmd_fixed_param *cmd;
  152. wmi_buf_t buf;
  153. QDF_STATUS ret;
  154. int len = sizeof(wmi_vdev_set_gtx_params_cmd_fixed_param);
  155. buf = wmi_buf_alloc(wmi_handle, len);
  156. if (!buf) {
  157. return QDF_STATUS_E_NOMEM;
  158. }
  159. cmd = (wmi_vdev_set_gtx_params_cmd_fixed_param *) wmi_buf_data(buf);
  160. WMITLV_SET_HDR(&cmd->tlv_header,
  161. WMITLV_TAG_STRUC_wmi_vdev_set_gtx_params_cmd_fixed_param,
  162. WMITLV_GET_STRUCT_TLVLEN
  163. (wmi_vdev_set_gtx_params_cmd_fixed_param));
  164. cmd->vdev_id = if_id;
  165. cmd->gtxRTMask[0] = gtx_info->gtx_rt_mask[0];
  166. cmd->gtxRTMask[1] = gtx_info->gtx_rt_mask[1];
  167. cmd->userGtxMask = gtx_info->gtx_usrcfg;
  168. cmd->gtxPERThreshold = gtx_info->gtx_threshold;
  169. cmd->gtxPERMargin = gtx_info->gtx_margin;
  170. cmd->gtxTPCstep = gtx_info->gtx_tpcstep;
  171. cmd->gtxTPCMin = gtx_info->gtx_tpcmin;
  172. cmd->gtxBWMask = gtx_info->gtx_bwmask;
  173. WMI_LOGD("Setting vdev%d GTX values:htmcs 0x%x, vhtmcs 0x%x, usermask 0x%x, \
  174. gtxPERThreshold %d, gtxPERMargin %d, gtxTPCstep %d, gtxTPCMin %d, \
  175. gtxBWMask 0x%x.", if_id, cmd->gtxRTMask[0], cmd->gtxRTMask[1],
  176. cmd->userGtxMask, cmd->gtxPERThreshold, cmd->gtxPERMargin,
  177. cmd->gtxTPCstep, cmd->gtxTPCMin, cmd->gtxBWMask);
  178. wmi_mtrace(WMI_VDEV_SET_GTX_PARAMS_CMDID, cmd->vdev_id, 0);
  179. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  180. WMI_VDEV_SET_GTX_PARAMS_CMDID);
  181. if (QDF_IS_STATUS_ERROR(ret)) {
  182. WMI_LOGE("Failed to set GTX PARAMS");
  183. wmi_buf_free(buf);
  184. }
  185. return ret;
  186. }
  187. /**
  188. * send_process_dhcp_ind_cmd_tlv() - process dhcp indication from SME
  189. * @wmi_handle: wmi handle
  190. * @ta_dhcp_ind: DHCP indication parameter
  191. *
  192. * Return: CDF Status
  193. */
  194. static QDF_STATUS send_process_dhcp_ind_cmd_tlv(wmi_unified_t wmi_handle,
  195. wmi_peer_set_param_cmd_fixed_param *ta_dhcp_ind)
  196. {
  197. QDF_STATUS status;
  198. wmi_buf_t buf = NULL;
  199. uint8_t *buf_ptr;
  200. wmi_peer_set_param_cmd_fixed_param *peer_set_param_fp;
  201. int len = sizeof(wmi_peer_set_param_cmd_fixed_param);
  202. buf = wmi_buf_alloc(wmi_handle, len);
  203. if (!buf) {
  204. return QDF_STATUS_E_NOMEM;
  205. }
  206. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  207. peer_set_param_fp = (wmi_peer_set_param_cmd_fixed_param *) buf_ptr;
  208. WMITLV_SET_HDR(&peer_set_param_fp->tlv_header,
  209. WMITLV_TAG_STRUC_wmi_peer_set_param_cmd_fixed_param,
  210. WMITLV_GET_STRUCT_TLVLEN
  211. (wmi_peer_set_param_cmd_fixed_param));
  212. /* fill in values */
  213. peer_set_param_fp->vdev_id = ta_dhcp_ind->vdev_id;
  214. peer_set_param_fp->param_id = ta_dhcp_ind->param_id;
  215. peer_set_param_fp->param_value = ta_dhcp_ind->param_value;
  216. qdf_mem_copy(&peer_set_param_fp->peer_macaddr,
  217. &ta_dhcp_ind->peer_macaddr,
  218. sizeof(ta_dhcp_ind->peer_macaddr));
  219. wmi_mtrace(WMI_PEER_SET_PARAM_CMDID, NO_SESSION, 0);
  220. status = wmi_unified_cmd_send(wmi_handle, buf,
  221. len, WMI_PEER_SET_PARAM_CMDID);
  222. if (QDF_IS_STATUS_ERROR(status)) {
  223. WMI_LOGE("%s: wmi_unified_cmd_send WMI_PEER_SET_PARAM_CMD"
  224. " returned Error %d", __func__, status);
  225. wmi_buf_free(buf);
  226. }
  227. return status;
  228. }
  229. /**
  230. * send_get_link_speed_cmd_tlv() -send command to get linkspeed
  231. * @wmi_handle: wmi handle
  232. * @pLinkSpeed: link speed info
  233. *
  234. * Return: CDF status
  235. */
  236. static QDF_STATUS send_get_link_speed_cmd_tlv(wmi_unified_t wmi_handle,
  237. wmi_mac_addr peer_macaddr)
  238. {
  239. wmi_peer_get_estimated_linkspeed_cmd_fixed_param *cmd;
  240. wmi_buf_t wmi_buf;
  241. uint32_t len;
  242. uint8_t *buf_ptr;
  243. len = sizeof(wmi_peer_get_estimated_linkspeed_cmd_fixed_param);
  244. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  245. if (!wmi_buf) {
  246. return QDF_STATUS_E_NOMEM;
  247. }
  248. buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf);
  249. cmd = (wmi_peer_get_estimated_linkspeed_cmd_fixed_param *) buf_ptr;
  250. WMITLV_SET_HDR(&cmd->tlv_header,
  251. WMITLV_TAG_STRUC_wmi_peer_get_estimated_linkspeed_cmd_fixed_param,
  252. WMITLV_GET_STRUCT_TLVLEN
  253. (wmi_peer_get_estimated_linkspeed_cmd_fixed_param));
  254. /* Copy the peer macaddress to the wma buffer */
  255. qdf_mem_copy(&cmd->peer_macaddr,
  256. &peer_macaddr,
  257. sizeof(peer_macaddr));
  258. wmi_mtrace(WMI_PEER_GET_ESTIMATED_LINKSPEED_CMDID, cmd->vdev_id, 0);
  259. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  260. WMI_PEER_GET_ESTIMATED_LINKSPEED_CMDID)) {
  261. WMI_LOGE("%s: failed to send link speed command", __func__);
  262. wmi_buf_free(wmi_buf);
  263. return QDF_STATUS_E_FAILURE;
  264. }
  265. return QDF_STATUS_SUCCESS;
  266. }
  267. /**
  268. * send_fw_profiling_cmd_tlv() - send FW profiling cmd to WLAN FW
  269. * @wmi_handl: wmi handle
  270. * @cmd: Profiling command index
  271. * @value1: parameter1 value
  272. * @value2: parameter2 value
  273. *
  274. * Return: QDF_STATUS_SUCCESS for success else error code
  275. */
  276. static QDF_STATUS send_fw_profiling_cmd_tlv(wmi_unified_t wmi_handle,
  277. uint32_t cmd, uint32_t value1, uint32_t value2)
  278. {
  279. wmi_buf_t buf;
  280. int32_t len = 0;
  281. int ret;
  282. wmi_wlan_profile_trigger_cmd_fixed_param *prof_trig_cmd;
  283. wmi_wlan_profile_set_hist_intvl_cmd_fixed_param *hist_intvl_cmd;
  284. wmi_wlan_profile_enable_profile_id_cmd_fixed_param *profile_enable_cmd;
  285. wmi_wlan_profile_get_prof_data_cmd_fixed_param *profile_getdata_cmd;
  286. switch (cmd) {
  287. case WMI_WLAN_PROFILE_TRIGGER_CMDID:
  288. len = sizeof(wmi_wlan_profile_trigger_cmd_fixed_param);
  289. buf = wmi_buf_alloc(wmi_handle, len);
  290. if (!buf) {
  291. return QDF_STATUS_E_NOMEM;
  292. }
  293. prof_trig_cmd =
  294. (wmi_wlan_profile_trigger_cmd_fixed_param *)
  295. wmi_buf_data(buf);
  296. WMITLV_SET_HDR(&prof_trig_cmd->tlv_header,
  297. WMITLV_TAG_STRUC_wmi_wlan_profile_trigger_cmd_fixed_param,
  298. WMITLV_GET_STRUCT_TLVLEN
  299. (wmi_wlan_profile_trigger_cmd_fixed_param));
  300. prof_trig_cmd->enable = value1;
  301. wmi_mtrace(WMI_WLAN_PROFILE_TRIGGER_CMDID, NO_SESSION, 0);
  302. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  303. WMI_WLAN_PROFILE_TRIGGER_CMDID);
  304. if (ret) {
  305. WMI_LOGE("PROFILE_TRIGGER cmd Failed with value %d",
  306. value1);
  307. wmi_buf_free(buf);
  308. return ret;
  309. }
  310. break;
  311. case WMI_WLAN_PROFILE_GET_PROFILE_DATA_CMDID:
  312. len = sizeof(wmi_wlan_profile_get_prof_data_cmd_fixed_param);
  313. buf = wmi_buf_alloc(wmi_handle, len);
  314. if (!buf) {
  315. return QDF_STATUS_E_NOMEM;
  316. }
  317. profile_getdata_cmd =
  318. (wmi_wlan_profile_get_prof_data_cmd_fixed_param *)
  319. wmi_buf_data(buf);
  320. WMITLV_SET_HDR(&profile_getdata_cmd->tlv_header,
  321. WMITLV_TAG_STRUC_wmi_wlan_profile_get_prof_data_cmd_fixed_param,
  322. WMITLV_GET_STRUCT_TLVLEN
  323. (wmi_wlan_profile_get_prof_data_cmd_fixed_param));
  324. wmi_mtrace(WMI_WLAN_PROFILE_GET_PROFILE_DATA_CMDID,
  325. NO_SESSION, 0);
  326. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  327. WMI_WLAN_PROFILE_GET_PROFILE_DATA_CMDID);
  328. if (ret) {
  329. WMI_LOGE("PROFILE_DATA cmd Failed for id %d value %d",
  330. value1, value2);
  331. wmi_buf_free(buf);
  332. return ret;
  333. }
  334. break;
  335. case WMI_WLAN_PROFILE_SET_HIST_INTVL_CMDID:
  336. len = sizeof(wmi_wlan_profile_set_hist_intvl_cmd_fixed_param);
  337. buf = wmi_buf_alloc(wmi_handle, len);
  338. if (!buf) {
  339. return QDF_STATUS_E_NOMEM;
  340. }
  341. hist_intvl_cmd =
  342. (wmi_wlan_profile_set_hist_intvl_cmd_fixed_param *)
  343. wmi_buf_data(buf);
  344. WMITLV_SET_HDR(&hist_intvl_cmd->tlv_header,
  345. WMITLV_TAG_STRUC_wmi_wlan_profile_set_hist_intvl_cmd_fixed_param,
  346. WMITLV_GET_STRUCT_TLVLEN
  347. (wmi_wlan_profile_set_hist_intvl_cmd_fixed_param));
  348. hist_intvl_cmd->profile_id = value1;
  349. hist_intvl_cmd->value = value2;
  350. wmi_mtrace(WMI_WLAN_PROFILE_SET_HIST_INTVL_CMDID,
  351. NO_SESSION, 0);
  352. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  353. WMI_WLAN_PROFILE_SET_HIST_INTVL_CMDID);
  354. if (ret) {
  355. WMI_LOGE("HIST_INTVL cmd Failed for id %d value %d",
  356. value1, value2);
  357. wmi_buf_free(buf);
  358. return ret;
  359. }
  360. break;
  361. case WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID:
  362. len =
  363. sizeof(wmi_wlan_profile_enable_profile_id_cmd_fixed_param);
  364. buf = wmi_buf_alloc(wmi_handle, len);
  365. if (!buf) {
  366. return QDF_STATUS_E_NOMEM;
  367. }
  368. profile_enable_cmd =
  369. (wmi_wlan_profile_enable_profile_id_cmd_fixed_param *)
  370. wmi_buf_data(buf);
  371. WMITLV_SET_HDR(&profile_enable_cmd->tlv_header,
  372. WMITLV_TAG_STRUC_wmi_wlan_profile_enable_profile_id_cmd_fixed_param,
  373. WMITLV_GET_STRUCT_TLVLEN
  374. (wmi_wlan_profile_enable_profile_id_cmd_fixed_param));
  375. profile_enable_cmd->profile_id = value1;
  376. profile_enable_cmd->enable = value2;
  377. wmi_mtrace(WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID,
  378. NO_SESSION, 0);
  379. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  380. WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID);
  381. if (ret) {
  382. WMI_LOGE("enable cmd Failed for id %d value %d",
  383. value1, value2);
  384. wmi_buf_free(buf);
  385. return ret;
  386. }
  387. break;
  388. default:
  389. WMI_LOGD("%s: invalid profiling command", __func__);
  390. break;
  391. }
  392. return 0;
  393. }
  394. /**
  395. * send_nat_keepalive_en_cmd_tlv() - enable NAT keepalive filter
  396. * @wmi_handle: wmi handle
  397. * @vdev_id: vdev id
  398. *
  399. * Return: QDF_STATUS_SUCCESS for success or error code
  400. */
  401. static QDF_STATUS send_nat_keepalive_en_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id)
  402. {
  403. WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param *cmd;
  404. wmi_buf_t buf;
  405. int32_t len = sizeof(*cmd);
  406. WMI_LOGD("%s: vdev_id %d", __func__, vdev_id);
  407. buf = wmi_buf_alloc(wmi_handle, len);
  408. if (!buf) {
  409. return QDF_STATUS_E_NOMEM;
  410. }
  411. cmd = (WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param *)
  412. wmi_buf_data(buf);
  413. WMITLV_SET_HDR(&cmd->tlv_header,
  414. WMITLV_TAG_STRUC_WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param,
  415. WMITLV_GET_STRUCT_TLVLEN
  416. (WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param));
  417. cmd->vdev_id = vdev_id;
  418. cmd->action = IPSEC_NATKEEPALIVE_FILTER_ENABLE;
  419. wmi_mtrace(WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMDID, cmd->vdev_id, 0);
  420. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  421. WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMDID)) {
  422. WMI_LOGP("%s: Failed to send NAT keepalive enable command",
  423. __func__);
  424. wmi_buf_free(buf);
  425. return QDF_STATUS_E_FAILURE;
  426. }
  427. return 0;
  428. }
  429. static QDF_STATUS send_wlm_latency_level_cmd_tlv(wmi_unified_t wmi_handle,
  430. struct wlm_latency_level_param *params)
  431. {
  432. wmi_wlm_config_cmd_fixed_param *cmd;
  433. wmi_buf_t buf;
  434. uint32_t len = sizeof(*cmd);
  435. static uint32_t ll[4] = {100, 60, 40, 20};
  436. buf = wmi_buf_alloc(wmi_handle, len);
  437. if (!buf) {
  438. return QDF_STATUS_E_NOMEM;
  439. }
  440. cmd = (wmi_wlm_config_cmd_fixed_param *)wmi_buf_data(buf);
  441. WMITLV_SET_HDR(&cmd->tlv_header,
  442. WMITLV_TAG_STRUC_wmi_wlm_config_cmd_fixed_param,
  443. WMITLV_GET_STRUCT_TLVLEN
  444. (wmi_wlm_config_cmd_fixed_param));
  445. cmd->vdev_id = params->vdev_id;
  446. cmd->latency_level = params->wlm_latency_level;
  447. cmd->ul_latency = ll[params->wlm_latency_level];
  448. cmd->dl_latency = ll[params->wlm_latency_level];
  449. cmd->flags = params->wlm_latency_flags;
  450. wmi_mtrace(WMI_WLM_CONFIG_CMDID, cmd->vdev_id, 0);
  451. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  452. WMI_WLM_CONFIG_CMDID)) {
  453. WMI_LOGE("%s: Failed to send setting latency config command",
  454. __func__);
  455. wmi_buf_free(buf);
  456. return QDF_STATUS_E_FAILURE;
  457. }
  458. return 0;
  459. }
  460. /**
  461. * send_nan_req_cmd_tlv() - to send nan request to target
  462. * @wmi_handle: wmi handle
  463. * @nan_req: request data which will be non-null
  464. *
  465. * Return: CDF status
  466. */
  467. static QDF_STATUS send_nan_req_cmd_tlv(wmi_unified_t wmi_handle,
  468. struct nan_req_params *nan_req)
  469. {
  470. QDF_STATUS ret;
  471. wmi_nan_cmd_param *cmd;
  472. wmi_buf_t buf;
  473. uint16_t len = sizeof(*cmd);
  474. uint16_t nan_data_len, nan_data_len_aligned;
  475. uint8_t *buf_ptr;
  476. /*
  477. * <----- cmd ------------><-- WMI_TLV_HDR_SIZE --><--- data ---->
  478. * +------------+----------+-----------------------+--------------+
  479. * | tlv_header | data_len | WMITLV_TAG_ARRAY_BYTE | nan_req_data |
  480. * +------------+----------+-----------------------+--------------+
  481. */
  482. if (!nan_req) {
  483. WMI_LOGE("%s:nan req is not valid", __func__);
  484. return QDF_STATUS_E_FAILURE;
  485. }
  486. nan_data_len = nan_req->request_data_len;
  487. nan_data_len_aligned = roundup(nan_req->request_data_len,
  488. sizeof(uint32_t));
  489. if (nan_data_len_aligned < nan_req->request_data_len) {
  490. WMI_LOGE("%s: integer overflow while rounding up data_len",
  491. __func__);
  492. return QDF_STATUS_E_FAILURE;
  493. }
  494. if (nan_data_len_aligned > WMI_SVC_MSG_MAX_SIZE - WMI_TLV_HDR_SIZE) {
  495. WMI_LOGE("%s: wmi_max_msg_size overflow for given datalen",
  496. __func__);
  497. return QDF_STATUS_E_FAILURE;
  498. }
  499. len += WMI_TLV_HDR_SIZE + nan_data_len_aligned;
  500. buf = wmi_buf_alloc(wmi_handle, len);
  501. if (!buf) {
  502. return QDF_STATUS_E_NOMEM;
  503. }
  504. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  505. cmd = (wmi_nan_cmd_param *) buf_ptr;
  506. WMITLV_SET_HDR(&cmd->tlv_header,
  507. WMITLV_TAG_STRUC_wmi_nan_cmd_param,
  508. WMITLV_GET_STRUCT_TLVLEN(wmi_nan_cmd_param));
  509. cmd->data_len = nan_req->request_data_len;
  510. WMI_LOGD("%s: The data len value is %u",
  511. __func__, nan_req->request_data_len);
  512. buf_ptr += sizeof(wmi_nan_cmd_param);
  513. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, nan_data_len_aligned);
  514. buf_ptr += WMI_TLV_HDR_SIZE;
  515. qdf_mem_copy(buf_ptr, nan_req->request_data, cmd->data_len);
  516. wmi_mtrace(WMI_NAN_CMDID, NO_SESSION, 0);
  517. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  518. WMI_NAN_CMDID);
  519. if (QDF_IS_STATUS_ERROR(ret)) {
  520. WMI_LOGE("%s Failed to send set param command ret = %d",
  521. __func__, ret);
  522. wmi_buf_free(buf);
  523. }
  524. return ret;
  525. }
  526. #ifdef CONVERGED_TDLS_ENABLE
  527. /**
  528. * tdls_get_wmi_offchannel_mode - Get WMI tdls off channel mode
  529. * @tdls_sw_mode: tdls_sw_mode
  530. *
  531. * This function returns wmi tdls offchannel mode
  532. *
  533. * Return: enum value of wmi tdls offchannel mode
  534. */
  535. static uint8_t tdls_get_wmi_offchannel_mode(uint8_t tdls_sw_mode)
  536. {
  537. uint8_t off_chan_mode;
  538. switch (tdls_sw_mode) {
  539. case ENABLE_CHANSWITCH:
  540. off_chan_mode = WMI_TDLS_ENABLE_OFFCHANNEL;
  541. break;
  542. case DISABLE_CHANSWITCH:
  543. off_chan_mode = WMI_TDLS_DISABLE_OFFCHANNEL;
  544. break;
  545. default:
  546. WMI_LOGD(FL("unknown tdls_sw_mode %d"), tdls_sw_mode);
  547. off_chan_mode = WMI_TDLS_DISABLE_OFFCHANNEL;
  548. }
  549. return off_chan_mode;
  550. }
  551. /**
  552. * tdls_get_wmi_offchannel_bw - Get WMI tdls off channel Bandwidth
  553. * @tdls_sw_mode: tdls_sw_mode
  554. *
  555. * This function returns wmi tdls offchannel bandwidth
  556. *
  557. * Return: TDLS offchannel bandwidth
  558. */
  559. static uint8_t tdls_get_wmi_offchannel_bw(uint16_t tdls_off_ch_bw_offset)
  560. {
  561. uint8_t off_chan_bw;
  562. switch (tdls_off_ch_bw_offset) {
  563. case BW20:
  564. off_chan_bw = WMI_TDLS_OFFCHAN_20MHZ;
  565. break;
  566. case BW40_LOW_PRIMARY:
  567. case BW40_HIGH_PRIMARY:
  568. off_chan_bw = WMI_TDLS_OFFCHAN_40MHZ;
  569. break;
  570. case BW80:
  571. off_chan_bw = WMI_TDLS_OFFCHAN_80MHZ;
  572. case BWALL:
  573. off_chan_bw = WMI_TDLS_OFFCHAN_160MHZ;
  574. default:
  575. WMI_LOGD(FL("unknown tdls_offchannel bw offset %d"),
  576. off_chan_bw);
  577. off_chan_bw = WMI_TDLS_OFFCHAN_20MHZ;
  578. }
  579. return off_chan_bw;
  580. }
  581. /**
  582. * send_set_tdls_offchan_mode_cmd_tlv() - set tdls off channel mode
  583. * @wmi_handle: wmi handle
  584. * @chan_switch_params: Pointer to tdls channel switch parameter structure
  585. *
  586. * This function sets tdls off channel mode
  587. *
  588. * Return: 0 on success; Negative errno otherwise
  589. */
  590. static QDF_STATUS send_set_tdls_offchan_mode_cmd_tlv(wmi_unified_t wmi_handle,
  591. struct tdls_channel_switch_params *chan_switch_params)
  592. {
  593. wmi_tdls_set_offchan_mode_cmd_fixed_param *cmd;
  594. wmi_buf_t wmi_buf;
  595. u_int16_t len = sizeof(wmi_tdls_set_offchan_mode_cmd_fixed_param);
  596. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  597. if (!wmi_buf) {
  598. return QDF_STATUS_E_FAILURE;
  599. }
  600. cmd = (wmi_tdls_set_offchan_mode_cmd_fixed_param *)
  601. wmi_buf_data(wmi_buf);
  602. WMITLV_SET_HDR(&cmd->tlv_header,
  603. WMITLV_TAG_STRUC_wmi_tdls_set_offchan_mode_cmd_fixed_param,
  604. WMITLV_GET_STRUCT_TLVLEN(
  605. wmi_tdls_set_offchan_mode_cmd_fixed_param));
  606. WMI_CHAR_ARRAY_TO_MAC_ADDR(chan_switch_params->peer_mac_addr,
  607. &cmd->peer_macaddr);
  608. cmd->vdev_id = chan_switch_params->vdev_id;
  609. cmd->offchan_mode =
  610. tdls_get_wmi_offchannel_mode(chan_switch_params->tdls_sw_mode);
  611. cmd->is_peer_responder = chan_switch_params->is_responder;
  612. cmd->offchan_num = chan_switch_params->tdls_off_ch;
  613. cmd->offchan_bw_bitmap =
  614. tdls_get_wmi_offchannel_bw(
  615. chan_switch_params->tdls_off_ch_bw_offset);
  616. cmd->offchan_oper_class = chan_switch_params->oper_class;
  617. WMI_LOGD(FL("Peer MAC Addr mac_addr31to0: 0x%x, mac_addr47to32: 0x%x"),
  618. cmd->peer_macaddr.mac_addr31to0,
  619. cmd->peer_macaddr.mac_addr47to32);
  620. WMI_LOGD(FL(
  621. "vdev_id: %d, off channel mode: %d, off channel Num: %d, "
  622. "off channel offset: 0x%x, is_peer_responder: %d, operating class: %d"
  623. ),
  624. cmd->vdev_id,
  625. cmd->offchan_mode,
  626. cmd->offchan_num,
  627. cmd->offchan_bw_bitmap,
  628. cmd->is_peer_responder,
  629. cmd->offchan_oper_class);
  630. wmi_mtrace(WMI_TDLS_SET_OFFCHAN_MODE_CMDID, cmd->vdev_id, 0);
  631. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  632. WMI_TDLS_SET_OFFCHAN_MODE_CMDID)) {
  633. WMI_LOGP(FL("failed to send tdls off chan command"));
  634. wmi_buf_free(wmi_buf);
  635. return QDF_STATUS_E_FAILURE;
  636. }
  637. return QDF_STATUS_SUCCESS;
  638. }
  639. /**
  640. * send_update_fw_tdls_state_cmd_tlv() - send enable/disable tdls for a vdev
  641. * @wmi_handle: wmi handle
  642. * @pwmaTdlsparams: TDLS params
  643. *
  644. * Return: 0 for success or error code
  645. */
  646. static QDF_STATUS send_update_fw_tdls_state_cmd_tlv(wmi_unified_t wmi_handle,
  647. void *tdls_param, uint8_t tdls_state)
  648. {
  649. wmi_tdls_set_state_cmd_fixed_param *cmd;
  650. wmi_buf_t wmi_buf;
  651. struct wmi_tdls_params *wmi_tdls = (struct wmi_tdls_params *) tdls_param;
  652. uint16_t len = sizeof(wmi_tdls_set_state_cmd_fixed_param);
  653. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  654. if (!wmi_buf) {
  655. return QDF_STATUS_E_FAILURE;
  656. }
  657. cmd = (wmi_tdls_set_state_cmd_fixed_param *) wmi_buf_data(wmi_buf);
  658. WMITLV_SET_HDR(&cmd->tlv_header,
  659. WMITLV_TAG_STRUC_wmi_tdls_set_state_cmd_fixed_param,
  660. WMITLV_GET_STRUCT_TLVLEN
  661. (wmi_tdls_set_state_cmd_fixed_param));
  662. cmd->vdev_id = wmi_tdls->vdev_id;
  663. cmd->state = tdls_state;
  664. cmd->notification_interval_ms = wmi_tdls->notification_interval_ms;
  665. cmd->tx_discovery_threshold = wmi_tdls->tx_discovery_threshold;
  666. cmd->tx_teardown_threshold = wmi_tdls->tx_teardown_threshold;
  667. cmd->rssi_teardown_threshold = wmi_tdls->rssi_teardown_threshold;
  668. cmd->rssi_delta = wmi_tdls->rssi_delta;
  669. cmd->tdls_options = wmi_tdls->tdls_options;
  670. cmd->tdls_peer_traffic_ind_window = wmi_tdls->peer_traffic_ind_window;
  671. cmd->tdls_peer_traffic_response_timeout_ms =
  672. wmi_tdls->peer_traffic_response_timeout;
  673. cmd->tdls_puapsd_mask = wmi_tdls->puapsd_mask;
  674. cmd->tdls_puapsd_inactivity_time_ms = wmi_tdls->puapsd_inactivity_time;
  675. cmd->tdls_puapsd_rx_frame_threshold =
  676. wmi_tdls->puapsd_rx_frame_threshold;
  677. cmd->teardown_notification_ms =
  678. wmi_tdls->teardown_notification_ms;
  679. cmd->tdls_peer_kickout_threshold =
  680. wmi_tdls->tdls_peer_kickout_threshold;
  681. WMI_LOGD("%s: tdls_state: %d, state: %d, "
  682. "notification_interval_ms: %d, "
  683. "tx_discovery_threshold: %d, "
  684. "tx_teardown_threshold: %d, "
  685. "rssi_teardown_threshold: %d, "
  686. "rssi_delta: %d, "
  687. "tdls_options: 0x%x, "
  688. "tdls_peer_traffic_ind_window: %d, "
  689. "tdls_peer_traffic_response_timeout: %d, "
  690. "tdls_puapsd_mask: 0x%x, "
  691. "tdls_puapsd_inactivity_time: %d, "
  692. "tdls_puapsd_rx_frame_threshold: %d, "
  693. "teardown_notification_ms: %d, "
  694. "tdls_peer_kickout_threshold: %d",
  695. __func__, tdls_state, cmd->state,
  696. cmd->notification_interval_ms,
  697. cmd->tx_discovery_threshold,
  698. cmd->tx_teardown_threshold,
  699. cmd->rssi_teardown_threshold,
  700. cmd->rssi_delta,
  701. cmd->tdls_options,
  702. cmd->tdls_peer_traffic_ind_window,
  703. cmd->tdls_peer_traffic_response_timeout_ms,
  704. cmd->tdls_puapsd_mask,
  705. cmd->tdls_puapsd_inactivity_time_ms,
  706. cmd->tdls_puapsd_rx_frame_threshold,
  707. cmd->teardown_notification_ms,
  708. cmd->tdls_peer_kickout_threshold);
  709. wmi_mtrace(WMI_TDLS_SET_STATE_CMDID, cmd->vdev_id, 0);
  710. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  711. WMI_TDLS_SET_STATE_CMDID)) {
  712. WMI_LOGP("%s: failed to send tdls set state command", __func__);
  713. wmi_buf_free(wmi_buf);
  714. return QDF_STATUS_E_FAILURE;
  715. }
  716. WMI_LOGD("%s: vdev_id %d", __func__, wmi_tdls->vdev_id);
  717. return QDF_STATUS_SUCCESS;
  718. }
  719. /**
  720. * send_update_tdls_peer_state_cmd_tlv() - update TDLS peer state
  721. * @wmi_handle: wmi handle
  722. * @peerStateParams: TDLS peer state params
  723. *
  724. * Return: QDF_STATUS_SUCCESS for success or error code
  725. */
  726. static QDF_STATUS send_update_tdls_peer_state_cmd_tlv(wmi_unified_t wmi_handle,
  727. struct tdls_peer_state_params *peerStateParams,
  728. uint32_t *ch_mhz)
  729. {
  730. wmi_tdls_peer_update_cmd_fixed_param *cmd;
  731. wmi_tdls_peer_capabilities *peer_cap;
  732. wmi_channel *chan_info;
  733. wmi_buf_t wmi_buf;
  734. uint8_t *buf_ptr;
  735. uint32_t i;
  736. int32_t len = sizeof(wmi_tdls_peer_update_cmd_fixed_param) +
  737. sizeof(wmi_tdls_peer_capabilities);
  738. len += WMI_TLV_HDR_SIZE +
  739. sizeof(wmi_channel) * peerStateParams->peerCap.peerChanLen;
  740. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  741. if (!wmi_buf) {
  742. return QDF_STATUS_E_FAILURE;
  743. }
  744. buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf);
  745. cmd = (wmi_tdls_peer_update_cmd_fixed_param *) buf_ptr;
  746. WMITLV_SET_HDR(&cmd->tlv_header,
  747. WMITLV_TAG_STRUC_wmi_tdls_peer_update_cmd_fixed_param,
  748. WMITLV_GET_STRUCT_TLVLEN
  749. (wmi_tdls_peer_update_cmd_fixed_param));
  750. cmd->vdev_id = peerStateParams->vdevId;
  751. WMI_CHAR_ARRAY_TO_MAC_ADDR(peerStateParams->peerMacAddr,
  752. &cmd->peer_macaddr);
  753. cmd->peer_state = peerStateParams->peerState;
  754. WMI_LOGD("%s: vdev_id: %d, peerStateParams->peerMacAddr: %pM, "
  755. "peer_macaddr.mac_addr31to0: 0x%x, "
  756. "peer_macaddr.mac_addr47to32: 0x%x, peer_state: %d",
  757. __func__, cmd->vdev_id, peerStateParams->peerMacAddr,
  758. cmd->peer_macaddr.mac_addr31to0,
  759. cmd->peer_macaddr.mac_addr47to32, cmd->peer_state);
  760. buf_ptr += sizeof(wmi_tdls_peer_update_cmd_fixed_param);
  761. peer_cap = (wmi_tdls_peer_capabilities *) buf_ptr;
  762. WMITLV_SET_HDR(&peer_cap->tlv_header,
  763. WMITLV_TAG_STRUC_wmi_tdls_peer_capabilities,
  764. WMITLV_GET_STRUCT_TLVLEN(wmi_tdls_peer_capabilities));
  765. if ((peerStateParams->peerCap.peerUapsdQueue & 0x08) >> 3)
  766. WMI_SET_TDLS_PEER_VO_UAPSD(peer_cap);
  767. if ((peerStateParams->peerCap.peerUapsdQueue & 0x04) >> 2)
  768. WMI_SET_TDLS_PEER_VI_UAPSD(peer_cap);
  769. if ((peerStateParams->peerCap.peerUapsdQueue & 0x02) >> 1)
  770. WMI_SET_TDLS_PEER_BK_UAPSD(peer_cap);
  771. if (peerStateParams->peerCap.peerUapsdQueue & 0x01)
  772. WMI_SET_TDLS_PEER_BE_UAPSD(peer_cap);
  773. /* Ack and More Data Ack are sent as 0, so no need to set
  774. * but fill SP
  775. */
  776. WMI_SET_TDLS_PEER_SP_UAPSD(peer_cap,
  777. peerStateParams->peerCap.peerMaxSp);
  778. peer_cap->buff_sta_support =
  779. peerStateParams->peerCap.peerBuffStaSupport;
  780. peer_cap->off_chan_support =
  781. peerStateParams->peerCap.peerOffChanSupport;
  782. peer_cap->peer_curr_operclass =
  783. peerStateParams->peerCap.peerCurrOperClass;
  784. /* self curr operclass is not being used and so pass op class for
  785. * preferred off chan in it.
  786. */
  787. peer_cap->self_curr_operclass =
  788. peerStateParams->peerCap.opClassForPrefOffChan;
  789. peer_cap->peer_chan_len = peerStateParams->peerCap.peerChanLen;
  790. peer_cap->peer_operclass_len =
  791. peerStateParams->peerCap.peerOperClassLen;
  792. WMI_LOGD("%s: peer_operclass_len: %d",
  793. __func__, peer_cap->peer_operclass_len);
  794. for (i = 0; i < WMI_TDLS_MAX_SUPP_OPER_CLASSES; i++) {
  795. peer_cap->peer_operclass[i] =
  796. peerStateParams->peerCap.peerOperClass[i];
  797. WMI_LOGD("%s: peer_operclass[%d]: %d",
  798. __func__, i, peer_cap->peer_operclass[i]);
  799. }
  800. peer_cap->is_peer_responder = peerStateParams->peerCap.isPeerResponder;
  801. peer_cap->pref_offchan_num = peerStateParams->peerCap.prefOffChanNum;
  802. peer_cap->pref_offchan_bw =
  803. peerStateParams->peerCap.prefOffChanBandwidth;
  804. WMI_LOGD
  805. ("%s: peer_qos: 0x%x, buff_sta_support: %d, off_chan_support: %d, "
  806. "peer_curr_operclass: %d, self_curr_operclass: %d, peer_chan_len: "
  807. "%d, peer_operclass_len: %d, is_peer_responder: %d, pref_offchan_num:"
  808. " %d, pref_offchan_bw: %d",
  809. __func__, peer_cap->peer_qos, peer_cap->buff_sta_support,
  810. peer_cap->off_chan_support, peer_cap->peer_curr_operclass,
  811. peer_cap->self_curr_operclass, peer_cap->peer_chan_len,
  812. peer_cap->peer_operclass_len, peer_cap->is_peer_responder,
  813. peer_cap->pref_offchan_num, peer_cap->pref_offchan_bw);
  814. /* next fill variable size array of peer chan info */
  815. buf_ptr += sizeof(wmi_tdls_peer_capabilities);
  816. WMITLV_SET_HDR(buf_ptr,
  817. WMITLV_TAG_ARRAY_STRUC,
  818. sizeof(wmi_channel) *
  819. peerStateParams->peerCap.peerChanLen);
  820. chan_info = (wmi_channel *) (buf_ptr + WMI_TLV_HDR_SIZE);
  821. for (i = 0; i < peerStateParams->peerCap.peerChanLen; ++i) {
  822. WMITLV_SET_HDR(&chan_info->tlv_header,
  823. WMITLV_TAG_STRUC_wmi_channel,
  824. WMITLV_GET_STRUCT_TLVLEN(wmi_channel));
  825. chan_info->mhz = ch_mhz[i];
  826. chan_info->band_center_freq1 = chan_info->mhz;
  827. chan_info->band_center_freq2 = 0;
  828. WMI_LOGD("%s: chan[%d] = %u", __func__, i, chan_info->mhz);
  829. if (peerStateParams->peerCap.peerChan[i].dfsSet) {
  830. WMI_SET_CHANNEL_FLAG(chan_info, WMI_CHAN_FLAG_PASSIVE);
  831. WMI_LOGI("chan[%d] DFS[%d]\n",
  832. peerStateParams->peerCap.peerChan[i].chanId,
  833. peerStateParams->peerCap.peerChan[i].dfsSet);
  834. }
  835. if (chan_info->mhz < WMI_2_4_GHZ_MAX_FREQ)
  836. WMI_SET_CHANNEL_MODE(chan_info, MODE_11G);
  837. else
  838. WMI_SET_CHANNEL_MODE(chan_info, MODE_11A);
  839. WMI_SET_CHANNEL_MAX_TX_POWER(chan_info,
  840. peerStateParams->peerCap.
  841. peerChan[i].pwr);
  842. WMI_SET_CHANNEL_REG_POWER(chan_info,
  843. peerStateParams->peerCap.peerChan[i].
  844. pwr);
  845. WMI_LOGD("Channel TX power[%d] = %u: %d", i, chan_info->mhz,
  846. peerStateParams->peerCap.peerChan[i].pwr);
  847. chan_info++;
  848. }
  849. wmi_mtrace(WMI_TDLS_PEER_UPDATE_CMDID, cmd->vdev_id, 0);
  850. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  851. WMI_TDLS_PEER_UPDATE_CMDID)) {
  852. WMI_LOGE("%s: failed to send tdls peer update state command",
  853. __func__);
  854. wmi_buf_free(wmi_buf);
  855. return QDF_STATUS_E_FAILURE;
  856. }
  857. return QDF_STATUS_SUCCESS;
  858. }
  859. /**
  860. * extract_vdev_tdls_ev_param_tlv() - extract vdev tdls param from event
  861. * @wmi_handle: wmi handle
  862. * @param evt_buf: pointer to event buffer
  863. * @param param: Pointer to hold vdev tdls param
  864. *
  865. * Return: QDF_STATUS_SUCCESS for success or error code
  866. */
  867. static QDF_STATUS extract_vdev_tdls_ev_param_tlv(wmi_unified_t wmi_handle,
  868. void *evt_buf, struct tdls_event_info *param)
  869. {
  870. WMI_TDLS_PEER_EVENTID_param_tlvs *param_buf;
  871. wmi_tdls_peer_event_fixed_param *evt;
  872. param_buf = (WMI_TDLS_PEER_EVENTID_param_tlvs *)evt_buf;
  873. if (!param_buf) {
  874. WMI_LOGE("%s: NULL param_buf", __func__);
  875. return QDF_STATUS_E_NULL_VALUE;
  876. }
  877. evt = param_buf->fixed_param;
  878. qdf_mem_zero(param, sizeof(*param));
  879. param->vdev_id = evt->vdev_id;
  880. WMI_MAC_ADDR_TO_CHAR_ARRAY(&evt->peer_macaddr,
  881. param->peermac.bytes);
  882. switch (evt->peer_status) {
  883. case WMI_TDLS_SHOULD_DISCOVER:
  884. param->message_type = TDLS_SHOULD_DISCOVER;
  885. break;
  886. case WMI_TDLS_SHOULD_TEARDOWN:
  887. param->message_type = TDLS_SHOULD_TEARDOWN;
  888. break;
  889. case WMI_TDLS_PEER_DISCONNECTED:
  890. param->message_type = TDLS_PEER_DISCONNECTED;
  891. break;
  892. case WMI_TDLS_CONNECTION_TRACKER_NOTIFICATION:
  893. param->message_type = TDLS_CONNECTION_TRACKER_NOTIFY;
  894. break;
  895. default:
  896. WMI_LOGE("%s: Discarding unknown tdls event %d from target",
  897. __func__, evt->peer_status);
  898. return QDF_STATUS_E_INVAL;
  899. };
  900. switch (evt->peer_reason) {
  901. case WMI_TDLS_TEARDOWN_REASON_TX:
  902. param->peer_reason = TDLS_TEARDOWN_TX;
  903. break;
  904. case WMI_TDLS_TEARDOWN_REASON_RSSI:
  905. param->peer_reason = TDLS_TEARDOWN_RSSI;
  906. break;
  907. case WMI_TDLS_TEARDOWN_REASON_SCAN:
  908. param->peer_reason = TDLS_TEARDOWN_SCAN;
  909. break;
  910. case WMI_TDLS_DISCONNECTED_REASON_PEER_DELETE:
  911. param->peer_reason = TDLS_DISCONNECTED_PEER_DELETE;
  912. break;
  913. case WMI_TDLS_TEARDOWN_REASON_PTR_TIMEOUT:
  914. param->peer_reason = TDLS_TEARDOWN_PTR_TIMEOUT;
  915. break;
  916. case WMI_TDLS_TEARDOWN_REASON_BAD_PTR:
  917. param->peer_reason = TDLS_TEARDOWN_BAD_PTR;
  918. break;
  919. case WMI_TDLS_TEARDOWN_REASON_NO_RESPONSE:
  920. param->peer_reason = TDLS_TEARDOWN_NO_RSP;
  921. break;
  922. case WMI_TDLS_ENTER_BUF_STA:
  923. param->peer_reason = TDLS_PEER_ENTER_BUF_STA;
  924. break;
  925. case WMI_TDLS_EXIT_BUF_STA:
  926. param->peer_reason = TDLS_PEER_EXIT_BUF_STA;
  927. break;
  928. case WMI_TDLS_ENTER_BT_BUSY_MODE:
  929. param->peer_reason = TDLS_ENTER_BT_BUSY;
  930. break;
  931. case WMI_TDLS_EXIT_BT_BUSY_MODE:
  932. param->peer_reason = TDLS_EXIT_BT_BUSY;
  933. break;
  934. case WMI_TDLS_SCAN_STARTED_EVENT:
  935. param->peer_reason = TDLS_SCAN_STARTED;
  936. break;
  937. case WMI_TDLS_SCAN_COMPLETED_EVENT:
  938. param->peer_reason = TDLS_SCAN_COMPLETED;
  939. break;
  940. default:
  941. WMI_LOGE("%s: unknown reason %d in tdls event %d from target",
  942. __func__, evt->peer_reason, evt->peer_status);
  943. return QDF_STATUS_E_INVAL;
  944. };
  945. WMI_LOGD("%s: tdls event, peer: %pM, type: 0x%x, reason: %d, vdev: %d",
  946. __func__, param->peermac.bytes, param->message_type,
  947. param->peer_reason, param->vdev_id);
  948. return QDF_STATUS_SUCCESS;
  949. }
  950. void wmi_tdls_attach_tlv(struct wmi_unified *wmi_handle)
  951. {
  952. struct wmi_ops *ops = wmi_handle->ops;
  953. ops->send_set_tdls_offchan_mode_cmd =
  954. send_set_tdls_offchan_mode_cmd_tlv;
  955. ops->send_update_fw_tdls_state_cmd =
  956. send_update_fw_tdls_state_cmd_tlv;
  957. ops->send_update_tdls_peer_state_cmd =
  958. send_update_tdls_peer_state_cmd_tlv;
  959. ops->extract_vdev_tdls_ev_param = extract_vdev_tdls_ev_param_tlv;
  960. }
  961. #endif /* CONVERGED_TDLS_ENABLE */
  962. /*
  963. * send_process_set_ie_info_cmd_tlv() - Function to send IE info to firmware
  964. * @wmi_handle: Pointer to WMi handle
  965. * @ie_data: Pointer for ie data
  966. *
  967. * This function sends IE information to firmware
  968. *
  969. * Return: QDF_STATUS_SUCCESS for success otherwise failure
  970. *
  971. */
  972. static QDF_STATUS send_process_set_ie_info_cmd_tlv(wmi_unified_t wmi_handle,
  973. struct vdev_ie_info_param *ie_info)
  974. {
  975. wmi_vdev_set_ie_cmd_fixed_param *cmd;
  976. wmi_buf_t buf;
  977. uint8_t *buf_ptr;
  978. uint32_t len, ie_len_aligned;
  979. QDF_STATUS ret;
  980. ie_len_aligned = roundup(ie_info->length, sizeof(uint32_t));
  981. /* Allocate memory for the WMI command */
  982. len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + ie_len_aligned;
  983. buf = wmi_buf_alloc(wmi_handle, len);
  984. if (!buf) {
  985. return QDF_STATUS_E_NOMEM;
  986. }
  987. buf_ptr = wmi_buf_data(buf);
  988. qdf_mem_zero(buf_ptr, len);
  989. /* Populate the WMI command */
  990. cmd = (wmi_vdev_set_ie_cmd_fixed_param *)buf_ptr;
  991. WMITLV_SET_HDR(&cmd->tlv_header,
  992. WMITLV_TAG_STRUC_wmi_vdev_set_ie_cmd_fixed_param,
  993. WMITLV_GET_STRUCT_TLVLEN(
  994. wmi_vdev_set_ie_cmd_fixed_param));
  995. cmd->vdev_id = ie_info->vdev_id;
  996. cmd->ie_id = ie_info->ie_id;
  997. cmd->ie_len = ie_info->length;
  998. cmd->band = ie_info->band;
  999. WMI_LOGD(FL("IE:%d of size:%d sent for vdev:%d"), ie_info->ie_id,
  1000. ie_info->length, ie_info->vdev_id);
  1001. buf_ptr += sizeof(*cmd);
  1002. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, ie_len_aligned);
  1003. buf_ptr += WMI_TLV_HDR_SIZE;
  1004. qdf_mem_copy(buf_ptr, ie_info->data, cmd->ie_len);
  1005. wmi_mtrace(WMI_VDEV_SET_IE_CMDID, cmd->vdev_id, 0);
  1006. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1007. WMI_VDEV_SET_IE_CMDID);
  1008. if (QDF_IS_STATUS_ERROR(ret)) {
  1009. WMI_LOGE(FL("Failed to send set IE command ret = %d"), ret);
  1010. wmi_buf_free(buf);
  1011. }
  1012. return ret;
  1013. }
  1014. /**
  1015. * send_set_base_macaddr_indicate_cmd_tlv() - set base mac address in fw
  1016. * @wmi_handle: wmi handle
  1017. * @custom_addr: base mac address
  1018. *
  1019. * Return: QDF_STATUS_SUCCESS for success or error code
  1020. */
  1021. static QDF_STATUS send_set_base_macaddr_indicate_cmd_tlv(wmi_unified_t wmi_handle,
  1022. uint8_t *custom_addr)
  1023. {
  1024. wmi_pdev_set_base_macaddr_cmd_fixed_param *cmd;
  1025. wmi_buf_t buf;
  1026. int err;
  1027. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1028. if (!buf) {
  1029. return QDF_STATUS_E_NOMEM;
  1030. }
  1031. cmd = (wmi_pdev_set_base_macaddr_cmd_fixed_param *) wmi_buf_data(buf);
  1032. qdf_mem_zero(cmd, sizeof(*cmd));
  1033. WMITLV_SET_HDR(&cmd->tlv_header,
  1034. WMITLV_TAG_STRUC_wmi_pdev_set_base_macaddr_cmd_fixed_param,
  1035. WMITLV_GET_STRUCT_TLVLEN
  1036. (wmi_pdev_set_base_macaddr_cmd_fixed_param));
  1037. WMI_CHAR_ARRAY_TO_MAC_ADDR(custom_addr, &cmd->base_macaddr);
  1038. cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
  1039. WMI_HOST_PDEV_ID_SOC);
  1040. wmi_mtrace(WMI_PDEV_SET_BASE_MACADDR_CMDID, NO_SESSION, 0);
  1041. err = wmi_unified_cmd_send(wmi_handle, buf,
  1042. sizeof(*cmd),
  1043. WMI_PDEV_SET_BASE_MACADDR_CMDID);
  1044. if (err) {
  1045. WMI_LOGE("Failed to send set_base_macaddr cmd");
  1046. wmi_buf_free(buf);
  1047. return QDF_STATUS_E_FAILURE;
  1048. }
  1049. return 0;
  1050. }
  1051. #ifdef WLAN_FEATURE_DISA
  1052. /**
  1053. * send_encrypt_decrypt_send_cmd() - send encrypt/decrypt cmd to fw
  1054. * @wmi_handle: wmi handle
  1055. * @params: encrypt/decrypt params
  1056. *
  1057. * Return: QDF_STATUS_SUCCESS for success or error code
  1058. */
  1059. static
  1060. QDF_STATUS send_encrypt_decrypt_send_cmd_tlv(wmi_unified_t wmi_handle,
  1061. struct disa_encrypt_decrypt_req_params *encrypt_decrypt_params)
  1062. {
  1063. wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param *cmd;
  1064. wmi_buf_t wmi_buf;
  1065. uint8_t *buf_ptr;
  1066. QDF_STATUS ret;
  1067. uint32_t len;
  1068. WMI_LOGD(FL("Send encrypt decrypt cmd"));
  1069. len = sizeof(*cmd) +
  1070. roundup(encrypt_decrypt_params->data_len, sizeof(uint32_t)) +
  1071. WMI_TLV_HDR_SIZE;
  1072. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  1073. if (!wmi_buf) {
  1074. return QDF_STATUS_E_NOMEM;
  1075. }
  1076. buf_ptr = wmi_buf_data(wmi_buf);
  1077. cmd = (wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param *)buf_ptr;
  1078. WMITLV_SET_HDR(&cmd->tlv_header,
  1079. WMITLV_TAG_STRUC_wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param,
  1080. WMITLV_GET_STRUCT_TLVLEN(
  1081. wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param));
  1082. cmd->vdev_id = encrypt_decrypt_params->vdev_id;
  1083. cmd->key_flag = encrypt_decrypt_params->key_flag;
  1084. cmd->key_idx = encrypt_decrypt_params->key_idx;
  1085. cmd->key_cipher = encrypt_decrypt_params->key_cipher;
  1086. cmd->key_len = encrypt_decrypt_params->key_len;
  1087. cmd->key_txmic_len = encrypt_decrypt_params->key_txmic_len;
  1088. cmd->key_rxmic_len = encrypt_decrypt_params->key_rxmic_len;
  1089. qdf_mem_copy(cmd->key_data, encrypt_decrypt_params->key_data,
  1090. encrypt_decrypt_params->key_len);
  1091. qdf_mem_copy(cmd->mac_hdr, encrypt_decrypt_params->mac_header,
  1092. MAX_MAC_HEADER_LEN);
  1093. cmd->data_len = encrypt_decrypt_params->data_len;
  1094. if (cmd->data_len) {
  1095. buf_ptr += sizeof(*cmd);
  1096. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE,
  1097. roundup(encrypt_decrypt_params->data_len,
  1098. sizeof(uint32_t)));
  1099. buf_ptr += WMI_TLV_HDR_SIZE;
  1100. qdf_mem_copy(buf_ptr, encrypt_decrypt_params->data,
  1101. encrypt_decrypt_params->data_len);
  1102. }
  1103. /* This conversion is to facilitate data to FW in little endian */
  1104. cmd->pn[5] = encrypt_decrypt_params->pn[0];
  1105. cmd->pn[4] = encrypt_decrypt_params->pn[1];
  1106. cmd->pn[3] = encrypt_decrypt_params->pn[2];
  1107. cmd->pn[2] = encrypt_decrypt_params->pn[3];
  1108. cmd->pn[1] = encrypt_decrypt_params->pn[4];
  1109. cmd->pn[0] = encrypt_decrypt_params->pn[5];
  1110. wmi_mtrace(WMI_VDEV_ENCRYPT_DECRYPT_DATA_REQ_CMDID, cmd->vdev_id, 0);
  1111. ret = wmi_unified_cmd_send(wmi_handle,
  1112. wmi_buf, len,
  1113. WMI_VDEV_ENCRYPT_DECRYPT_DATA_REQ_CMDID);
  1114. if (QDF_IS_STATUS_ERROR(ret)) {
  1115. WMI_LOGE("Failed to send ENCRYPT DECRYPT cmd: %d", ret);
  1116. wmi_buf_free(wmi_buf);
  1117. }
  1118. return ret;
  1119. }
  1120. /**
  1121. * extract_encrypt_decrypt_resp_event_tlv() - extract encrypt decrypt resp
  1122. * params from event
  1123. * @wmi_handle: wmi handle
  1124. * @evt_buf: pointer to event buffer
  1125. * @resp: Pointer to hold resp parameters
  1126. *
  1127. * Return: QDF_STATUS_SUCCESS for success or error code
  1128. */
  1129. static
  1130. QDF_STATUS extract_encrypt_decrypt_resp_event_tlv(wmi_unified_t wmi_handle,
  1131. void *evt_buf, struct disa_encrypt_decrypt_resp_params *resp)
  1132. {
  1133. WMI_VDEV_ENCRYPT_DECRYPT_DATA_RESP_EVENTID_param_tlvs *param_buf;
  1134. wmi_vdev_encrypt_decrypt_data_resp_event_fixed_param *data_event;
  1135. param_buf = evt_buf;
  1136. if (!param_buf) {
  1137. WMI_LOGE("encrypt decrypt resp evt_buf is NULL");
  1138. return QDF_STATUS_E_INVAL;
  1139. }
  1140. data_event = param_buf->fixed_param;
  1141. resp->vdev_id = data_event->vdev_id;
  1142. resp->status = data_event->status;
  1143. if ((data_event->data_length > param_buf->num_enc80211_frame) ||
  1144. (data_event->data_length > WMI_SVC_MSG_MAX_SIZE - WMI_TLV_HDR_SIZE -
  1145. sizeof(*data_event))) {
  1146. WMI_LOGE("FW msg data_len %d more than TLV hdr %d",
  1147. data_event->data_length,
  1148. param_buf->num_enc80211_frame);
  1149. return QDF_STATUS_E_INVAL;
  1150. }
  1151. resp->data_len = data_event->data_length;
  1152. if (resp->data_len)
  1153. resp->data = (uint8_t *)param_buf->enc80211_frame;
  1154. return QDF_STATUS_SUCCESS;
  1155. }
  1156. void wmi_disa_attach_tlv(struct wmi_unified *wmi_handle)
  1157. {
  1158. struct wmi_ops *ops = wmi_handle->ops;
  1159. ops->send_encrypt_decrypt_send_cmd =
  1160. send_encrypt_decrypt_send_cmd_tlv;
  1161. ops->extract_encrypt_decrypt_resp_event =
  1162. extract_encrypt_decrypt_resp_event_tlv;
  1163. }
  1164. #endif /* WLAN_FEATURE_DISA */
  1165. /**
  1166. * send_sar_limit_cmd_tlv() - send sar limit cmd to fw
  1167. * @wmi_handle: wmi handle
  1168. * @params: sar limit params
  1169. *
  1170. * Return: QDF_STATUS_SUCCESS for success or error code
  1171. */
  1172. static QDF_STATUS send_sar_limit_cmd_tlv(wmi_unified_t wmi_handle,
  1173. struct sar_limit_cmd_params *sar_limit_params)
  1174. {
  1175. wmi_buf_t buf;
  1176. QDF_STATUS qdf_status;
  1177. wmi_sar_limits_cmd_fixed_param *cmd;
  1178. int i;
  1179. uint8_t *buf_ptr;
  1180. wmi_sar_limit_cmd_row *wmi_sar_rows_list;
  1181. struct sar_limit_cmd_row *sar_rows_list;
  1182. uint32_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE;
  1183. len += sizeof(wmi_sar_limit_cmd_row) * sar_limit_params->num_limit_rows;
  1184. buf = wmi_buf_alloc(wmi_handle, len);
  1185. if (!buf) {
  1186. qdf_status = QDF_STATUS_E_NOMEM;
  1187. goto end;
  1188. }
  1189. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1190. cmd = (wmi_sar_limits_cmd_fixed_param *) buf_ptr;
  1191. WMITLV_SET_HDR(&cmd->tlv_header,
  1192. WMITLV_TAG_STRUC_wmi_sar_limits_cmd_fixed_param,
  1193. WMITLV_GET_STRUCT_TLVLEN
  1194. (wmi_sar_limits_cmd_fixed_param));
  1195. cmd->sar_enable = sar_limit_params->sar_enable;
  1196. cmd->commit_limits = sar_limit_params->commit_limits;
  1197. cmd->num_limit_rows = sar_limit_params->num_limit_rows;
  1198. WMI_LOGD("no of sar rows = %d, len = %d",
  1199. sar_limit_params->num_limit_rows, len);
  1200. buf_ptr += sizeof(*cmd);
  1201. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  1202. sizeof(wmi_sar_limit_cmd_row) *
  1203. sar_limit_params->num_limit_rows);
  1204. if (cmd->num_limit_rows == 0)
  1205. goto send_sar_limits;
  1206. wmi_sar_rows_list = (wmi_sar_limit_cmd_row *)
  1207. (buf_ptr + WMI_TLV_HDR_SIZE);
  1208. sar_rows_list = sar_limit_params->sar_limit_row_list;
  1209. for (i = 0; i < sar_limit_params->num_limit_rows; i++) {
  1210. WMITLV_SET_HDR(&wmi_sar_rows_list->tlv_header,
  1211. WMITLV_TAG_STRUC_wmi_sar_limit_cmd_row,
  1212. WMITLV_GET_STRUCT_TLVLEN(wmi_sar_limit_cmd_row));
  1213. wmi_sar_rows_list->band_id = sar_rows_list->band_id;
  1214. wmi_sar_rows_list->chain_id = sar_rows_list->chain_id;
  1215. wmi_sar_rows_list->mod_id = sar_rows_list->mod_id;
  1216. wmi_sar_rows_list->limit_value = sar_rows_list->limit_value;
  1217. wmi_sar_rows_list->validity_bitmap =
  1218. sar_rows_list->validity_bitmap;
  1219. WMI_LOGD("row %d, band_id = %d, chain_id = %d, mod_id = %d, limit_value = %d, validity_bitmap = %d",
  1220. i, wmi_sar_rows_list->band_id,
  1221. wmi_sar_rows_list->chain_id,
  1222. wmi_sar_rows_list->mod_id,
  1223. wmi_sar_rows_list->limit_value,
  1224. wmi_sar_rows_list->validity_bitmap);
  1225. sar_rows_list++;
  1226. wmi_sar_rows_list++;
  1227. }
  1228. send_sar_limits:
  1229. wmi_mtrace(WMI_SAR_LIMITS_CMDID, NO_SESSION, 0);
  1230. qdf_status = wmi_unified_cmd_send(wmi_handle, buf, len,
  1231. WMI_SAR_LIMITS_CMDID);
  1232. if (QDF_IS_STATUS_ERROR(qdf_status)) {
  1233. WMI_LOGE("Failed to send WMI_SAR_LIMITS_CMDID");
  1234. wmi_buf_free(buf);
  1235. }
  1236. end:
  1237. return qdf_status;
  1238. }
  1239. static QDF_STATUS get_sar_limit_cmd_tlv(wmi_unified_t wmi_handle)
  1240. {
  1241. wmi_sar_get_limits_cmd_fixed_param *cmd;
  1242. wmi_buf_t wmi_buf;
  1243. uint32_t len;
  1244. QDF_STATUS status;
  1245. WMI_LOGD(FL("Enter"));
  1246. len = sizeof(*cmd);
  1247. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  1248. if (!wmi_buf) {
  1249. return QDF_STATUS_E_NOMEM;
  1250. }
  1251. cmd = (wmi_sar_get_limits_cmd_fixed_param *)wmi_buf_data(wmi_buf);
  1252. WMITLV_SET_HDR(&cmd->tlv_header,
  1253. WMITLV_TAG_STRUC_wmi_sar_get_limits_cmd_fixed_param,
  1254. WMITLV_GET_STRUCT_TLVLEN
  1255. (wmi_sar_get_limits_cmd_fixed_param));
  1256. cmd->reserved = 0;
  1257. wmi_mtrace(WMI_SAR_GET_LIMITS_CMDID, NO_SESSION, 0);
  1258. status = wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  1259. WMI_SAR_GET_LIMITS_CMDID);
  1260. if (QDF_IS_STATUS_ERROR(status)) {
  1261. WMI_LOGE(FL("Failed to send get SAR limit cmd: %d"), status);
  1262. wmi_buf_free(wmi_buf);
  1263. }
  1264. WMI_LOGD(FL("Exit"));
  1265. return status;
  1266. }
  1267. /**
  1268. * wmi_sar2_result_string() - return string conversion of sar2 result
  1269. * @result: sar2 result value
  1270. *
  1271. * This utility function helps log string conversion of sar2 result.
  1272. *
  1273. * Return: string conversion of sar 2 result, if match found;
  1274. * "Unknown response" otherwise.
  1275. */
  1276. static const char *wmi_sar2_result_string(uint32_t result)
  1277. {
  1278. switch (result) {
  1279. CASE_RETURN_STRING(WMI_SAR2_SUCCESS);
  1280. CASE_RETURN_STRING(WMI_SAR2_INVALID_ANTENNA_INDEX);
  1281. CASE_RETURN_STRING(WMI_SAR2_INVALID_TABLE_INDEX);
  1282. CASE_RETURN_STRING(WMI_SAR2_STATE_ERROR);
  1283. CASE_RETURN_STRING(WMI_SAR2_BDF_NO_TABLE);
  1284. default:
  1285. return "Unknown response";
  1286. }
  1287. }
  1288. /**
  1289. * extract_sar2_result_event_tlv() - process sar response event from FW.
  1290. * @handle: wma handle
  1291. * @event: event buffer
  1292. * @len: buffer length
  1293. *
  1294. * Return: 0 for success or error code
  1295. */
  1296. static QDF_STATUS extract_sar2_result_event_tlv(void *handle,
  1297. uint8_t *event,
  1298. uint32_t len)
  1299. {
  1300. wmi_sar2_result_event_fixed_param *sar2_fixed_param;
  1301. WMI_SAR2_RESULT_EVENTID_param_tlvs *param_buf =
  1302. (WMI_SAR2_RESULT_EVENTID_param_tlvs *)event;
  1303. if (!param_buf) {
  1304. WMI_LOGI("Invalid sar2 result event buffer");
  1305. return QDF_STATUS_E_INVAL;
  1306. }
  1307. sar2_fixed_param = param_buf->fixed_param;
  1308. if (!sar2_fixed_param) {
  1309. WMI_LOGI("Invalid sar2 result event fixed param buffer");
  1310. return QDF_STATUS_E_INVAL;
  1311. }
  1312. WMI_LOGI("SAR2 result: %s",
  1313. wmi_sar2_result_string(sar2_fixed_param->result));
  1314. return QDF_STATUS_SUCCESS;
  1315. }
  1316. static QDF_STATUS extract_sar_limit_event_tlv(wmi_unified_t wmi_handle,
  1317. uint8_t *evt_buf,
  1318. struct sar_limit_event *event)
  1319. {
  1320. wmi_sar_get_limits_event_fixed_param *fixed_param;
  1321. WMI_SAR_GET_LIMITS_EVENTID_param_tlvs *param_buf;
  1322. wmi_sar_get_limit_event_row *row_in;
  1323. struct sar_limit_event_row *row_out;
  1324. uint32_t row;
  1325. if (!evt_buf) {
  1326. WMI_LOGE(FL("input event is NULL"));
  1327. return QDF_STATUS_E_INVAL;
  1328. }
  1329. if (!event) {
  1330. WMI_LOGE(FL("output event is NULL"));
  1331. return QDF_STATUS_E_INVAL;
  1332. }
  1333. param_buf = (WMI_SAR_GET_LIMITS_EVENTID_param_tlvs *)evt_buf;
  1334. fixed_param = param_buf->fixed_param;
  1335. if (!fixed_param) {
  1336. WMI_LOGE(FL("Invalid fixed param"));
  1337. return QDF_STATUS_E_INVAL;
  1338. }
  1339. event->sar_enable = fixed_param->sar_enable;
  1340. event->num_limit_rows = fixed_param->num_limit_rows;
  1341. if (event->num_limit_rows > MAX_SAR_LIMIT_ROWS_SUPPORTED) {
  1342. QDF_ASSERT(0);
  1343. WMI_LOGE(FL("Num rows %d exceeds max of %d"),
  1344. event->num_limit_rows,
  1345. MAX_SAR_LIMIT_ROWS_SUPPORTED);
  1346. event->num_limit_rows = MAX_SAR_LIMIT_ROWS_SUPPORTED;
  1347. }
  1348. row_in = param_buf->sar_get_limits;
  1349. row_out = &event->sar_limit_row[0];
  1350. for (row = 0; row < event->num_limit_rows; row++) {
  1351. row_out->band_id = row_in->band_id;
  1352. row_out->chain_id = row_in->chain_id;
  1353. row_out->mod_id = row_in->mod_id;
  1354. row_out->limit_value = row_in->limit_value;
  1355. row_out++;
  1356. row_in++;
  1357. }
  1358. return QDF_STATUS_SUCCESS;
  1359. }
  1360. /**
  1361. * send_set_del_pmkid_cache_cmd_tlv() - send wmi cmd of set del pmkid
  1362. * @wmi_handle: wmi handler
  1363. * @pmk_info: pointer to PMK cache entry
  1364. * @vdev_id: vdev id
  1365. *
  1366. * Return: 0 for success and non zero for failure
  1367. */
  1368. static QDF_STATUS send_set_del_pmkid_cache_cmd_tlv(wmi_unified_t wmi_handle,
  1369. struct wmi_unified_pmk_cache *pmk_info)
  1370. {
  1371. wmi_pdev_update_pmk_cache_cmd_fixed_param *cmd;
  1372. wmi_buf_t buf;
  1373. QDF_STATUS status;
  1374. uint8_t *buf_ptr;
  1375. wmi_pmk_cache *pmksa;
  1376. uint32_t len = sizeof(*cmd);
  1377. if (pmk_info->pmk_len)
  1378. len += WMI_TLV_HDR_SIZE + sizeof(*pmksa);
  1379. buf = wmi_buf_alloc(wmi_handle, len);
  1380. if (!buf) {
  1381. return QDF_STATUS_E_NOMEM;
  1382. }
  1383. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1384. cmd = (wmi_pdev_update_pmk_cache_cmd_fixed_param *) buf_ptr;
  1385. WMITLV_SET_HDR(&cmd->tlv_header,
  1386. WMITLV_TAG_STRUC_wmi_pdev_update_pmk_cache_cmd_fixed_param,
  1387. WMITLV_GET_STRUCT_TLVLEN(
  1388. wmi_pdev_update_pmk_cache_cmd_fixed_param));
  1389. cmd->vdev_id = pmk_info->session_id;
  1390. /* If pmk_info->pmk_len is 0, this is a flush request */
  1391. if (!pmk_info->pmk_len) {
  1392. cmd->op_flag = WMI_PMK_CACHE_OP_FLAG_FLUSH_ALL;
  1393. cmd->num_cache = 0;
  1394. goto send_cmd;
  1395. }
  1396. cmd->num_cache = 1;
  1397. buf_ptr += sizeof(*cmd);
  1398. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  1399. sizeof(*pmksa));
  1400. buf_ptr += WMI_TLV_HDR_SIZE;
  1401. pmksa = (wmi_pmk_cache *)buf_ptr;
  1402. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_STRUC_wmi_pmk_cache,
  1403. WMITLV_GET_STRUCT_TLVLEN
  1404. (wmi_pmk_cache));
  1405. pmksa->pmk_len = pmk_info->pmk_len;
  1406. qdf_mem_copy(pmksa->pmk, pmk_info->pmk, pmksa->pmk_len);
  1407. pmksa->pmkid_len = pmk_info->pmkid_len;
  1408. qdf_mem_copy(pmksa->pmkid, pmk_info->pmkid, pmksa->pmkid_len);
  1409. qdf_mem_copy(&(pmksa->bssid), &(pmk_info->bssid), sizeof(wmi_mac_addr));
  1410. pmksa->ssid.ssid_len = pmk_info->ssid.length;
  1411. qdf_mem_copy(&(pmksa->ssid.ssid), &(pmk_info->ssid.mac_ssid),
  1412. pmksa->ssid.ssid_len);
  1413. pmksa->cache_id = pmk_info->cache_id;
  1414. pmksa->cat_flag = pmk_info->cat_flag;
  1415. pmksa->action_flag = pmk_info->action_flag;
  1416. send_cmd:
  1417. wmi_mtrace(WMI_PDEV_UPDATE_PMK_CACHE_CMDID, cmd->vdev_id, 0);
  1418. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  1419. WMI_PDEV_UPDATE_PMK_CACHE_CMDID);
  1420. if (status != QDF_STATUS_SUCCESS) {
  1421. WMI_LOGE("%s: failed to send set del pmkid cache command %d",
  1422. __func__, status);
  1423. wmi_buf_free(buf);
  1424. }
  1425. return status;
  1426. }
  1427. /**
  1428. * send_del_ts_cmd_tlv() - send DELTS request to fw
  1429. * @wmi_handle: wmi handle
  1430. * @msg: delts params
  1431. *
  1432. * Return: CDF status
  1433. */
  1434. static QDF_STATUS send_del_ts_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id,
  1435. uint8_t ac)
  1436. {
  1437. wmi_vdev_wmm_delts_cmd_fixed_param *cmd;
  1438. wmi_buf_t buf;
  1439. int32_t len = sizeof(*cmd);
  1440. buf = wmi_buf_alloc(wmi_handle, len);
  1441. if (!buf) {
  1442. return QDF_STATUS_E_NOMEM;
  1443. }
  1444. cmd = (wmi_vdev_wmm_delts_cmd_fixed_param *) wmi_buf_data(buf);
  1445. WMITLV_SET_HDR(&cmd->tlv_header,
  1446. WMITLV_TAG_STRUC_wmi_vdev_wmm_delts_cmd_fixed_param,
  1447. WMITLV_GET_STRUCT_TLVLEN
  1448. (wmi_vdev_wmm_delts_cmd_fixed_param));
  1449. cmd->vdev_id = vdev_id;
  1450. cmd->ac = ac;
  1451. WMI_LOGD("Delts vdev:%d, ac:%d, %s:%d",
  1452. cmd->vdev_id, cmd->ac, __func__, __LINE__);
  1453. wmi_mtrace(WMI_VDEV_WMM_DELTS_CMDID, cmd->vdev_id, 0);
  1454. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1455. WMI_VDEV_WMM_DELTS_CMDID)) {
  1456. WMI_LOGP("%s: Failed to send vdev DELTS command", __func__);
  1457. wmi_buf_free(buf);
  1458. return QDF_STATUS_E_FAILURE;
  1459. }
  1460. return QDF_STATUS_SUCCESS;
  1461. }
  1462. /**
  1463. * send_aggr_qos_cmd_tlv() - send aggr qos request to fw
  1464. * @wmi_handle: handle to wmi
  1465. * @aggr_qos_rsp_msg - combined struct for all ADD_TS requests.
  1466. *
  1467. * A function to handle WMI_AGGR_QOS_REQ. This will send out
  1468. * ADD_TS requestes to firmware in loop for all the ACs with
  1469. * active flow.
  1470. *
  1471. * Return: CDF status
  1472. */
  1473. static QDF_STATUS send_aggr_qos_cmd_tlv(wmi_unified_t wmi_handle,
  1474. struct aggr_add_ts_param *aggr_qos_rsp_msg)
  1475. {
  1476. int i = 0;
  1477. wmi_vdev_wmm_addts_cmd_fixed_param *cmd;
  1478. wmi_buf_t buf;
  1479. int32_t len = sizeof(*cmd);
  1480. for (i = 0; i < WMI_QOS_NUM_AC_MAX; i++) {
  1481. /* if flow in this AC is active */
  1482. if (((1 << i) & aggr_qos_rsp_msg->tspecIdx)) {
  1483. /*
  1484. * as per implementation of wma_add_ts_req() we
  1485. * are not waiting any response from firmware so
  1486. * apart from sending ADDTS to firmware just send
  1487. * success to upper layers
  1488. */
  1489. aggr_qos_rsp_msg->status[i] = QDF_STATUS_SUCCESS;
  1490. buf = wmi_buf_alloc(wmi_handle, len);
  1491. if (!buf) {
  1492. return QDF_STATUS_E_NOMEM;
  1493. }
  1494. cmd = (wmi_vdev_wmm_addts_cmd_fixed_param *)
  1495. wmi_buf_data(buf);
  1496. WMITLV_SET_HDR(&cmd->tlv_header,
  1497. WMITLV_TAG_STRUC_wmi_vdev_wmm_addts_cmd_fixed_param,
  1498. WMITLV_GET_STRUCT_TLVLEN
  1499. (wmi_vdev_wmm_addts_cmd_fixed_param));
  1500. cmd->vdev_id = aggr_qos_rsp_msg->vdev_id;
  1501. cmd->ac =
  1502. WMI_TID_TO_AC(aggr_qos_rsp_msg->tspec[i].tsinfo.
  1503. traffic.userPrio);
  1504. cmd->medium_time_us =
  1505. aggr_qos_rsp_msg->tspec[i].mediumTime * 32;
  1506. cmd->downgrade_type = WMM_AC_DOWNGRADE_DEPRIO;
  1507. WMI_LOGD("%s:%d: Addts vdev:%d, ac:%d, mediumTime:%d downgrade_type:%d",
  1508. __func__, __LINE__, cmd->vdev_id, cmd->ac,
  1509. cmd->medium_time_us, cmd->downgrade_type);
  1510. wmi_mtrace(WMI_VDEV_WMM_ADDTS_CMDID, cmd->vdev_id, 0);
  1511. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1512. WMI_VDEV_WMM_ADDTS_CMDID)) {
  1513. WMI_LOGP("%s: Failed to send vdev ADDTS command",
  1514. __func__);
  1515. aggr_qos_rsp_msg->status[i] =
  1516. QDF_STATUS_E_FAILURE;
  1517. wmi_buf_free(buf);
  1518. return QDF_STATUS_E_FAILURE;
  1519. }
  1520. }
  1521. }
  1522. return QDF_STATUS_SUCCESS;
  1523. }
  1524. /**
  1525. * send_add_ts_cmd_tlv() - send ADDTS request to fw
  1526. * @wmi_handle: wmi handle
  1527. * @msg: ADDTS params
  1528. *
  1529. * Return: CDF status
  1530. */
  1531. static QDF_STATUS send_add_ts_cmd_tlv(wmi_unified_t wmi_handle,
  1532. struct add_ts_param *msg)
  1533. {
  1534. wmi_vdev_wmm_addts_cmd_fixed_param *cmd;
  1535. wmi_buf_t buf;
  1536. int32_t len = sizeof(*cmd);
  1537. msg->status = QDF_STATUS_SUCCESS;
  1538. buf = wmi_buf_alloc(wmi_handle, len);
  1539. if (!buf) {
  1540. return QDF_STATUS_E_NOMEM;
  1541. }
  1542. cmd = (wmi_vdev_wmm_addts_cmd_fixed_param *) wmi_buf_data(buf);
  1543. WMITLV_SET_HDR(&cmd->tlv_header,
  1544. WMITLV_TAG_STRUC_wmi_vdev_wmm_addts_cmd_fixed_param,
  1545. WMITLV_GET_STRUCT_TLVLEN
  1546. (wmi_vdev_wmm_addts_cmd_fixed_param));
  1547. cmd->vdev_id = msg->sme_session_id;
  1548. cmd->ac = msg->tspec.tsinfo.traffic.userPrio;
  1549. cmd->medium_time_us = msg->tspec.mediumTime * 32;
  1550. cmd->downgrade_type = WMM_AC_DOWNGRADE_DROP;
  1551. WMI_LOGD("Addts vdev:%d, ac:%d, mediumTime:%d, downgrade_type:%d %s:%d",
  1552. cmd->vdev_id, cmd->ac, cmd->medium_time_us,
  1553. cmd->downgrade_type, __func__, __LINE__);
  1554. wmi_mtrace(WMI_VDEV_WMM_ADDTS_CMDID, cmd->vdev_id, 0);
  1555. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1556. WMI_VDEV_WMM_ADDTS_CMDID)) {
  1557. WMI_LOGP("%s: Failed to send vdev ADDTS command", __func__);
  1558. msg->status = QDF_STATUS_E_FAILURE;
  1559. wmi_buf_free(buf);
  1560. return QDF_STATUS_E_FAILURE;
  1561. }
  1562. return QDF_STATUS_SUCCESS;
  1563. }
  1564. /**
  1565. * send_process_add_periodic_tx_ptrn_cmd_tlv - add periodic tx ptrn
  1566. * @wmi_handle: wmi handle
  1567. * @pAddPeriodicTxPtrnParams: tx ptrn params
  1568. *
  1569. * Retrun: CDF status
  1570. */
  1571. static QDF_STATUS send_process_add_periodic_tx_ptrn_cmd_tlv(wmi_unified_t wmi_handle,
  1572. struct periodic_tx_pattern *
  1573. pAddPeriodicTxPtrnParams,
  1574. uint8_t vdev_id)
  1575. {
  1576. WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *cmd;
  1577. wmi_buf_t wmi_buf;
  1578. uint32_t len;
  1579. uint8_t *buf_ptr;
  1580. uint32_t ptrn_len, ptrn_len_aligned;
  1581. int j;
  1582. ptrn_len = pAddPeriodicTxPtrnParams->ucPtrnSize;
  1583. ptrn_len_aligned = roundup(ptrn_len, sizeof(uint32_t));
  1584. len = sizeof(WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param) +
  1585. WMI_TLV_HDR_SIZE + ptrn_len_aligned;
  1586. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  1587. if (!wmi_buf) {
  1588. return QDF_STATUS_E_NOMEM;
  1589. }
  1590. buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf);
  1591. cmd = (WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *) buf_ptr;
  1592. WMITLV_SET_HDR(&cmd->tlv_header,
  1593. WMITLV_TAG_STRUC_WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param,
  1594. WMITLV_GET_STRUCT_TLVLEN
  1595. (WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param));
  1596. /* Pass the pattern id to delete for the corresponding vdev id */
  1597. cmd->vdev_id = vdev_id;
  1598. cmd->pattern_id = pAddPeriodicTxPtrnParams->ucPtrnId;
  1599. cmd->timeout = pAddPeriodicTxPtrnParams->usPtrnIntervalMs;
  1600. cmd->length = pAddPeriodicTxPtrnParams->ucPtrnSize;
  1601. /* Pattern info */
  1602. buf_ptr += sizeof(WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param);
  1603. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, ptrn_len_aligned);
  1604. buf_ptr += WMI_TLV_HDR_SIZE;
  1605. qdf_mem_copy(buf_ptr, pAddPeriodicTxPtrnParams->ucPattern, ptrn_len);
  1606. for (j = 0; j < pAddPeriodicTxPtrnParams->ucPtrnSize; j++)
  1607. WMI_LOGD("%s: Add Ptrn: %02x", __func__, buf_ptr[j] & 0xff);
  1608. WMI_LOGD("%s: Add ptrn id: %d vdev_id: %d",
  1609. __func__, cmd->pattern_id, cmd->vdev_id);
  1610. wmi_mtrace(WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMDID, cmd->vdev_id, 0);
  1611. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  1612. WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMDID)) {
  1613. WMI_LOGE("%s: failed to add pattern set state command",
  1614. __func__);
  1615. wmi_buf_free(wmi_buf);
  1616. return QDF_STATUS_E_FAILURE;
  1617. }
  1618. return QDF_STATUS_SUCCESS;
  1619. }
  1620. /**
  1621. * send_process_del_periodic_tx_ptrn_cmd_tlv - del periodic tx ptrn
  1622. * @wmi_handle: wmi handle
  1623. * @vdev_id: vdev id
  1624. * @pattern_id: pattern id
  1625. *
  1626. * Retrun: CDF status
  1627. */
  1628. static QDF_STATUS send_process_del_periodic_tx_ptrn_cmd_tlv(wmi_unified_t wmi_handle,
  1629. uint8_t vdev_id,
  1630. uint8_t pattern_id)
  1631. {
  1632. WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *cmd;
  1633. wmi_buf_t wmi_buf;
  1634. uint32_t len =
  1635. sizeof(WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param);
  1636. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  1637. if (!wmi_buf) {
  1638. return QDF_STATUS_E_NOMEM;
  1639. }
  1640. cmd = (WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *)
  1641. wmi_buf_data(wmi_buf);
  1642. WMITLV_SET_HDR(&cmd->tlv_header,
  1643. WMITLV_TAG_STRUC_WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param,
  1644. WMITLV_GET_STRUCT_TLVLEN
  1645. (WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param));
  1646. /* Pass the pattern id to delete for the corresponding vdev id */
  1647. cmd->vdev_id = vdev_id;
  1648. cmd->pattern_id = pattern_id;
  1649. WMI_LOGD("%s: Del ptrn id: %d vdev_id: %d",
  1650. __func__, cmd->pattern_id, cmd->vdev_id);
  1651. wmi_mtrace(WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMDID, cmd->vdev_id, 0);
  1652. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  1653. WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMDID)) {
  1654. WMI_LOGE("%s: failed to send del pattern command", __func__);
  1655. wmi_buf_free(wmi_buf);
  1656. return QDF_STATUS_E_FAILURE;
  1657. }
  1658. return QDF_STATUS_SUCCESS;
  1659. }
  1660. /**
  1661. * send_set_auto_shutdown_timer_cmd_tlv() - sets auto shutdown timer in firmware
  1662. * @wmi_handle: wmi handle
  1663. * @timer_val: auto shutdown timer value
  1664. *
  1665. * Return: CDF status
  1666. */
  1667. static QDF_STATUS send_set_auto_shutdown_timer_cmd_tlv(wmi_unified_t wmi_handle,
  1668. uint32_t timer_val)
  1669. {
  1670. QDF_STATUS status;
  1671. wmi_buf_t buf = NULL;
  1672. uint8_t *buf_ptr;
  1673. wmi_host_auto_shutdown_cfg_cmd_fixed_param *wmi_auto_sh_cmd;
  1674. int len = sizeof(wmi_host_auto_shutdown_cfg_cmd_fixed_param);
  1675. WMI_LOGD("%s: Set WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID:TIMER_VAL=%d",
  1676. __func__, timer_val);
  1677. buf = wmi_buf_alloc(wmi_handle, len);
  1678. if (!buf) {
  1679. return QDF_STATUS_E_NOMEM;
  1680. }
  1681. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1682. wmi_auto_sh_cmd =
  1683. (wmi_host_auto_shutdown_cfg_cmd_fixed_param *) buf_ptr;
  1684. wmi_auto_sh_cmd->timer_value = timer_val;
  1685. WMITLV_SET_HDR(&wmi_auto_sh_cmd->tlv_header,
  1686. WMITLV_TAG_STRUC_wmi_host_auto_shutdown_cfg_cmd_fixed_param,
  1687. WMITLV_GET_STRUCT_TLVLEN
  1688. (wmi_host_auto_shutdown_cfg_cmd_fixed_param));
  1689. wmi_mtrace(WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID, NO_SESSION, 0);
  1690. status = wmi_unified_cmd_send(wmi_handle, buf,
  1691. len, WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID);
  1692. if (QDF_IS_STATUS_ERROR(status)) {
  1693. WMI_LOGE("%s: WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID Err %d",
  1694. __func__, status);
  1695. wmi_buf_free(buf);
  1696. }
  1697. return status;
  1698. }
  1699. /**
  1700. * send_set_led_flashing_cmd_tlv() - set led flashing in fw
  1701. * @wmi_handle: wmi handle
  1702. * @flashing: flashing request
  1703. *
  1704. * Return: CDF status
  1705. */
  1706. static QDF_STATUS send_set_led_flashing_cmd_tlv(wmi_unified_t wmi_handle,
  1707. struct flashing_req_params *flashing)
  1708. {
  1709. wmi_set_led_flashing_cmd_fixed_param *cmd;
  1710. QDF_STATUS status;
  1711. wmi_buf_t buf;
  1712. uint8_t *buf_ptr;
  1713. int32_t len = sizeof(wmi_set_led_flashing_cmd_fixed_param);
  1714. buf = wmi_buf_alloc(wmi_handle, len);
  1715. if (!buf) {
  1716. return QDF_STATUS_E_NOMEM;
  1717. }
  1718. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1719. cmd = (wmi_set_led_flashing_cmd_fixed_param *) buf_ptr;
  1720. WMITLV_SET_HDR(&cmd->tlv_header,
  1721. WMITLV_TAG_STRUC_wmi_set_led_flashing_cmd_fixed_param,
  1722. WMITLV_GET_STRUCT_TLVLEN
  1723. (wmi_set_led_flashing_cmd_fixed_param));
  1724. cmd->pattern_id = flashing->pattern_id;
  1725. cmd->led_x0 = flashing->led_x0;
  1726. cmd->led_x1 = flashing->led_x1;
  1727. wmi_mtrace(WMI_PDEV_SET_LED_FLASHING_CMDID, NO_SESSION, 0);
  1728. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  1729. WMI_PDEV_SET_LED_FLASHING_CMDID);
  1730. if (QDF_IS_STATUS_ERROR(status)) {
  1731. WMI_LOGE("%s: wmi_unified_cmd_send WMI_PEER_SET_PARAM_CMD"
  1732. " returned Error %d", __func__, status);
  1733. wmi_buf_free(buf);
  1734. }
  1735. return status;
  1736. }
  1737. /**
  1738. * send_process_ch_avoid_update_cmd_tlv() - handles channel avoid update request
  1739. * @wmi_handle: wmi handle
  1740. * @ch_avoid_update_req: channel avoid update params
  1741. *
  1742. * Return: CDF status
  1743. */
  1744. static QDF_STATUS send_process_ch_avoid_update_cmd_tlv(wmi_unified_t wmi_handle)
  1745. {
  1746. QDF_STATUS status;
  1747. wmi_buf_t buf = NULL;
  1748. uint8_t *buf_ptr;
  1749. wmi_chan_avoid_update_cmd_param *ch_avoid_update_fp;
  1750. int len = sizeof(wmi_chan_avoid_update_cmd_param);
  1751. buf = wmi_buf_alloc(wmi_handle, len);
  1752. if (!buf) {
  1753. return QDF_STATUS_E_NOMEM;
  1754. }
  1755. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1756. ch_avoid_update_fp = (wmi_chan_avoid_update_cmd_param *) buf_ptr;
  1757. WMITLV_SET_HDR(&ch_avoid_update_fp->tlv_header,
  1758. WMITLV_TAG_STRUC_wmi_chan_avoid_update_cmd_param,
  1759. WMITLV_GET_STRUCT_TLVLEN
  1760. (wmi_chan_avoid_update_cmd_param));
  1761. wmi_mtrace(WMI_CHAN_AVOID_UPDATE_CMDID, NO_SESSION, 0);
  1762. status = wmi_unified_cmd_send(wmi_handle, buf,
  1763. len, WMI_CHAN_AVOID_UPDATE_CMDID);
  1764. if (QDF_IS_STATUS_ERROR(status)) {
  1765. WMI_LOGE("wmi_unified_cmd_send"
  1766. " WMITLV_TABLE_WMI_CHAN_AVOID_UPDATE"
  1767. " returned Error %d", status);
  1768. wmi_buf_free(buf);
  1769. }
  1770. return status;
  1771. }
  1772. /**
  1773. * send_pdev_set_pcl_cmd_tlv() - Send WMI_SOC_SET_PCL_CMDID to FW
  1774. * @wmi_handle: wmi handle
  1775. * @msg: PCL structure containing the PCL and the number of channels
  1776. *
  1777. * WMI_PDEV_SET_PCL_CMDID provides a Preferred Channel List (PCL) to the WLAN
  1778. * firmware. The DBS Manager is the consumer of this information in the WLAN
  1779. * firmware. The channel list will be used when a Virtual DEVice (VDEV) needs
  1780. * to migrate to a new channel without host driver involvement. An example of
  1781. * this behavior is Legacy Fast Roaming (LFR 3.0). Generally, the host will
  1782. * manage the channel selection without firmware involvement.
  1783. *
  1784. * WMI_PDEV_SET_PCL_CMDID will carry only the weight list and not the actual
  1785. * channel list. The weights corresponds to the channels sent in
  1786. * WMI_SCAN_CHAN_LIST_CMDID. The channels from PCL would be having a higher
  1787. * weightage compared to the non PCL channels.
  1788. *
  1789. * Return: Success if the cmd is sent successfully to the firmware
  1790. */
  1791. static QDF_STATUS send_pdev_set_pcl_cmd_tlv(wmi_unified_t wmi_handle,
  1792. struct wmi_pcl_chan_weights *msg)
  1793. {
  1794. wmi_pdev_set_pcl_cmd_fixed_param *cmd;
  1795. wmi_buf_t buf;
  1796. uint8_t *buf_ptr;
  1797. uint32_t *cmd_args, i, len;
  1798. uint32_t chan_len;
  1799. chan_len = msg->saved_num_chan;
  1800. len = sizeof(*cmd) +
  1801. WMI_TLV_HDR_SIZE + (chan_len * sizeof(uint32_t));
  1802. buf = wmi_buf_alloc(wmi_handle, len);
  1803. if (!buf) {
  1804. return QDF_STATUS_E_NOMEM;
  1805. }
  1806. cmd = (wmi_pdev_set_pcl_cmd_fixed_param *) wmi_buf_data(buf);
  1807. buf_ptr = (uint8_t *) cmd;
  1808. WMITLV_SET_HDR(&cmd->tlv_header,
  1809. WMITLV_TAG_STRUC_wmi_pdev_set_pcl_cmd_fixed_param,
  1810. WMITLV_GET_STRUCT_TLVLEN(wmi_pdev_set_pcl_cmd_fixed_param));
  1811. cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
  1812. WMI_HOST_PDEV_ID_SOC);
  1813. cmd->num_chan = chan_len;
  1814. WMI_LOGD("%s: Total chan (PCL) len:%d", __func__, cmd->num_chan);
  1815. buf_ptr += sizeof(wmi_pdev_set_pcl_cmd_fixed_param);
  1816. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  1817. (chan_len * sizeof(uint32_t)));
  1818. cmd_args = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE);
  1819. for (i = 0; i < chan_len ; i++) {
  1820. cmd_args[i] = msg->weighed_valid_list[i];
  1821. WMI_LOGD("%s: chan:%d weight:%d", __func__,
  1822. msg->saved_chan_list[i], cmd_args[i]);
  1823. }
  1824. wmi_mtrace(WMI_PDEV_SET_PCL_CMDID, NO_SESSION, 0);
  1825. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1826. WMI_PDEV_SET_PCL_CMDID)) {
  1827. WMI_LOGE("%s: Failed to send WMI_PDEV_SET_PCL_CMDID", __func__);
  1828. wmi_buf_free(buf);
  1829. return QDF_STATUS_E_FAILURE;
  1830. }
  1831. return QDF_STATUS_SUCCESS;
  1832. }
  1833. /**
  1834. * send_pdev_set_hw_mode_cmd_tlv() - Send WMI_PDEV_SET_HW_MODE_CMDID to FW
  1835. * @wmi_handle: wmi handle
  1836. * @msg: Structure containing the following parameters
  1837. *
  1838. * - hw_mode_index: The HW_Mode field is a enumerated type that is selected
  1839. * from the HW_Mode table, which is returned in the WMI_SERVICE_READY_EVENTID.
  1840. *
  1841. * Provides notification to the WLAN firmware that host driver is requesting a
  1842. * HardWare (HW) Mode change. This command is needed to support iHelium in the
  1843. * configurations that include the Dual Band Simultaneous (DBS) feature.
  1844. *
  1845. * Return: Success if the cmd is sent successfully to the firmware
  1846. */
  1847. static QDF_STATUS send_pdev_set_hw_mode_cmd_tlv(wmi_unified_t wmi_handle,
  1848. uint32_t hw_mode_index)
  1849. {
  1850. wmi_pdev_set_hw_mode_cmd_fixed_param *cmd;
  1851. wmi_buf_t buf;
  1852. uint32_t len;
  1853. len = sizeof(*cmd);
  1854. buf = wmi_buf_alloc(wmi_handle, len);
  1855. if (!buf) {
  1856. return QDF_STATUS_E_NOMEM;
  1857. }
  1858. cmd = (wmi_pdev_set_hw_mode_cmd_fixed_param *) wmi_buf_data(buf);
  1859. WMITLV_SET_HDR(&cmd->tlv_header,
  1860. WMITLV_TAG_STRUC_wmi_pdev_set_hw_mode_cmd_fixed_param,
  1861. WMITLV_GET_STRUCT_TLVLEN(wmi_pdev_set_hw_mode_cmd_fixed_param));
  1862. cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
  1863. WMI_HOST_PDEV_ID_SOC);
  1864. cmd->hw_mode_index = hw_mode_index;
  1865. WMI_LOGI("%s: HW mode index:%d", __func__, cmd->hw_mode_index);
  1866. wmi_mtrace(WMI_PDEV_SET_HW_MODE_CMDID, NO_SESSION, 0);
  1867. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1868. WMI_PDEV_SET_HW_MODE_CMDID)) {
  1869. WMI_LOGE("%s: Failed to send WMI_PDEV_SET_HW_MODE_CMDID",
  1870. __func__);
  1871. wmi_buf_free(buf);
  1872. return QDF_STATUS_E_FAILURE;
  1873. }
  1874. return QDF_STATUS_SUCCESS;
  1875. }
  1876. #ifdef WLAN_POLICY_MGR_ENABLE
  1877. /**
  1878. * send_pdev_set_dual_mac_config_cmd_tlv() - Set dual mac config to FW
  1879. * @wmi_handle: wmi handle
  1880. * @msg: Dual MAC config parameters
  1881. *
  1882. * Configures WLAN firmware with the dual MAC features
  1883. *
  1884. * Return: QDF_STATUS. 0 on success.
  1885. */
  1886. static
  1887. QDF_STATUS send_pdev_set_dual_mac_config_cmd_tlv(wmi_unified_t wmi_handle,
  1888. struct policy_mgr_dual_mac_config *msg)
  1889. {
  1890. wmi_pdev_set_mac_config_cmd_fixed_param *cmd;
  1891. wmi_buf_t buf;
  1892. uint32_t len;
  1893. len = sizeof(*cmd);
  1894. buf = wmi_buf_alloc(wmi_handle, len);
  1895. if (!buf) {
  1896. return QDF_STATUS_E_FAILURE;
  1897. }
  1898. cmd = (wmi_pdev_set_mac_config_cmd_fixed_param *) wmi_buf_data(buf);
  1899. WMITLV_SET_HDR(&cmd->tlv_header,
  1900. WMITLV_TAG_STRUC_wmi_pdev_set_mac_config_cmd_fixed_param,
  1901. WMITLV_GET_STRUCT_TLVLEN(
  1902. wmi_pdev_set_mac_config_cmd_fixed_param));
  1903. cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
  1904. WMI_HOST_PDEV_ID_SOC);
  1905. cmd->concurrent_scan_config_bits = msg->scan_config;
  1906. cmd->fw_mode_config_bits = msg->fw_mode_config;
  1907. WMI_LOGD("%s: scan_config:%x fw_mode_config:%x",
  1908. __func__, msg->scan_config, msg->fw_mode_config);
  1909. wmi_mtrace(WMI_PDEV_SET_MAC_CONFIG_CMDID, NO_SESSION, 0);
  1910. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1911. WMI_PDEV_SET_MAC_CONFIG_CMDID)) {
  1912. WMI_LOGE("%s: Failed to send WMI_PDEV_SET_MAC_CONFIG_CMDID",
  1913. __func__);
  1914. wmi_buf_free(buf);
  1915. }
  1916. return QDF_STATUS_SUCCESS;
  1917. }
  1918. void wmi_policy_mgr_attach_tlv(struct wmi_unified *wmi_handle)
  1919. {
  1920. struct wmi_ops *ops = wmi_handle->ops;
  1921. ops->send_pdev_set_dual_mac_config_cmd =
  1922. send_pdev_set_dual_mac_config_cmd_tlv;
  1923. }
  1924. #endif /* WLAN_POLICY_MGR_ENABLE */
  1925. /**
  1926. * send_adapt_dwelltime_params_cmd_tlv() - send wmi cmd of adaptive dwelltime
  1927. * configuration params
  1928. * @wma_handle: wma handler
  1929. * @dwelltime_params: pointer to dwelltime_params
  1930. *
  1931. * Return: QDF_STATUS_SUCCESS on success and QDF failure reason code for failure
  1932. */
  1933. static
  1934. QDF_STATUS send_adapt_dwelltime_params_cmd_tlv(wmi_unified_t wmi_handle,
  1935. struct wmi_adaptive_dwelltime_params *dwelltime_params)
  1936. {
  1937. wmi_scan_adaptive_dwell_config_fixed_param *dwell_param;
  1938. wmi_scan_adaptive_dwell_parameters_tlv *cmd;
  1939. wmi_buf_t buf;
  1940. uint8_t *buf_ptr;
  1941. int32_t err;
  1942. int len;
  1943. len = sizeof(wmi_scan_adaptive_dwell_config_fixed_param);
  1944. len += WMI_TLV_HDR_SIZE; /* TLV for ext_thresholds*/
  1945. len += sizeof(wmi_scan_adaptive_dwell_parameters_tlv);
  1946. buf = wmi_buf_alloc(wmi_handle, len);
  1947. if (!buf) {
  1948. return QDF_STATUS_E_NOMEM;
  1949. }
  1950. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  1951. dwell_param = (wmi_scan_adaptive_dwell_config_fixed_param *) buf_ptr;
  1952. WMITLV_SET_HDR(&dwell_param->tlv_header,
  1953. WMITLV_TAG_STRUC_wmi_scan_adaptive_dwell_config_fixed_param,
  1954. WMITLV_GET_STRUCT_TLVLEN
  1955. (wmi_scan_adaptive_dwell_config_fixed_param));
  1956. dwell_param->enable = dwelltime_params->is_enabled;
  1957. buf_ptr += sizeof(wmi_scan_adaptive_dwell_config_fixed_param);
  1958. WMITLV_SET_HDR(buf_ptr,
  1959. WMITLV_TAG_ARRAY_STRUC,
  1960. sizeof(wmi_scan_adaptive_dwell_parameters_tlv));
  1961. buf_ptr += WMI_TLV_HDR_SIZE;
  1962. cmd = (wmi_scan_adaptive_dwell_parameters_tlv *) buf_ptr;
  1963. WMITLV_SET_HDR(&cmd->tlv_header,
  1964. WMITLV_TAG_STRUC_wmi_scan_adaptive_dwell_parameters_tlv,
  1965. WMITLV_GET_STRUCT_TLVLEN(
  1966. wmi_scan_adaptive_dwell_parameters_tlv));
  1967. cmd->default_adaptive_dwell_mode = dwelltime_params->dwelltime_mode;
  1968. cmd->adapative_lpf_weight = dwelltime_params->lpf_weight;
  1969. cmd->passive_monitor_interval_ms = dwelltime_params->passive_mon_intval;
  1970. cmd->wifi_activity_threshold_pct = dwelltime_params->wifi_act_threshold;
  1971. wmi_mtrace(WMI_SCAN_ADAPTIVE_DWELL_CONFIG_CMDID, NO_SESSION, 0);
  1972. err = wmi_unified_cmd_send(wmi_handle, buf,
  1973. len, WMI_SCAN_ADAPTIVE_DWELL_CONFIG_CMDID);
  1974. if (err) {
  1975. WMI_LOGE("Failed to send adapt dwelltime cmd err=%d", err);
  1976. wmi_buf_free(buf);
  1977. return QDF_STATUS_E_FAILURE;
  1978. }
  1979. return QDF_STATUS_SUCCESS;
  1980. }
  1981. /**
  1982. * send_dbs_scan_sel_params_cmd_tlv() - send wmi cmd of DBS scan selection
  1983. * configuration params
  1984. * @wmi_handle: wmi handler
  1985. * @dbs_scan_params: pointer to wmi_dbs_scan_sel_params
  1986. *
  1987. * Return: QDF_STATUS_SUCCESS on success and QDF failure reason code for failure
  1988. */
  1989. static QDF_STATUS send_dbs_scan_sel_params_cmd_tlv(wmi_unified_t wmi_handle,
  1990. struct wmi_dbs_scan_sel_params *dbs_scan_params)
  1991. {
  1992. wmi_scan_dbs_duty_cycle_fixed_param *dbs_scan_param;
  1993. wmi_scan_dbs_duty_cycle_tlv_param *cmd;
  1994. wmi_buf_t buf;
  1995. uint8_t *buf_ptr;
  1996. QDF_STATUS err;
  1997. uint32_t i;
  1998. int len;
  1999. len = sizeof(*dbs_scan_param);
  2000. len += WMI_TLV_HDR_SIZE;
  2001. len += dbs_scan_params->num_clients * sizeof(*cmd);
  2002. buf = wmi_buf_alloc(wmi_handle, len);
  2003. if (!buf) {
  2004. return QDF_STATUS_E_NOMEM;
  2005. }
  2006. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  2007. dbs_scan_param = (wmi_scan_dbs_duty_cycle_fixed_param *) buf_ptr;
  2008. WMITLV_SET_HDR(&dbs_scan_param->tlv_header,
  2009. WMITLV_TAG_STRUC_wmi_scan_dbs_duty_cycle_fixed_param,
  2010. WMITLV_GET_STRUCT_TLVLEN
  2011. (wmi_scan_dbs_duty_cycle_fixed_param));
  2012. dbs_scan_param->num_clients = dbs_scan_params->num_clients;
  2013. dbs_scan_param->pdev_id = dbs_scan_params->pdev_id;
  2014. buf_ptr += sizeof(*dbs_scan_param);
  2015. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  2016. (sizeof(*cmd) * dbs_scan_params->num_clients));
  2017. buf_ptr = buf_ptr + (uint8_t) WMI_TLV_HDR_SIZE;
  2018. for (i = 0; i < dbs_scan_params->num_clients; i++) {
  2019. cmd = (wmi_scan_dbs_duty_cycle_tlv_param *) buf_ptr;
  2020. WMITLV_SET_HDR(&cmd->tlv_header,
  2021. WMITLV_TAG_STRUC_wmi_scan_dbs_duty_cycle_param_tlv,
  2022. WMITLV_GET_STRUCT_TLVLEN(
  2023. wmi_scan_dbs_duty_cycle_tlv_param));
  2024. cmd->module_id = dbs_scan_params->module_id[i];
  2025. cmd->num_dbs_scans = dbs_scan_params->num_dbs_scans[i];
  2026. cmd->num_non_dbs_scans = dbs_scan_params->num_non_dbs_scans[i];
  2027. buf_ptr = buf_ptr + (uint8_t) sizeof(*cmd);
  2028. }
  2029. wmi_mtrace(WMI_SET_SCAN_DBS_DUTY_CYCLE_CMDID, NO_SESSION, 0);
  2030. err = wmi_unified_cmd_send(wmi_handle, buf,
  2031. len, WMI_SET_SCAN_DBS_DUTY_CYCLE_CMDID);
  2032. if (QDF_IS_STATUS_ERROR(err)) {
  2033. WMI_LOGE("Failed to send dbs scan selection cmd err=%d", err);
  2034. wmi_buf_free(buf);
  2035. return QDF_STATUS_E_FAILURE;
  2036. }
  2037. return QDF_STATUS_SUCCESS;
  2038. }
  2039. /**
  2040. * send_set_arp_stats_req_cmd_tlv() - send wmi cmd to set arp stats request
  2041. * @wmi_handle: wmi handler
  2042. * @req_buf: set arp stats request buffer
  2043. *
  2044. * Return: 0 for success and non zero for failure
  2045. */
  2046. static QDF_STATUS send_set_arp_stats_req_cmd_tlv(wmi_unified_t wmi_handle,
  2047. struct set_arp_stats *req_buf)
  2048. {
  2049. wmi_buf_t buf = NULL;
  2050. QDF_STATUS status;
  2051. int len;
  2052. uint8_t *buf_ptr;
  2053. wmi_vdev_set_arp_stats_cmd_fixed_param *wmi_set_arp;
  2054. len = sizeof(wmi_vdev_set_arp_stats_cmd_fixed_param);
  2055. if (req_buf->pkt_type_bitmap) {
  2056. len += WMI_TLV_HDR_SIZE;
  2057. len += sizeof(wmi_vdev_set_connectivity_check_stats);
  2058. }
  2059. buf = wmi_buf_alloc(wmi_handle, len);
  2060. if (!buf) {
  2061. return QDF_STATUS_E_NOMEM;
  2062. }
  2063. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  2064. wmi_set_arp =
  2065. (wmi_vdev_set_arp_stats_cmd_fixed_param *) buf_ptr;
  2066. WMITLV_SET_HDR(&wmi_set_arp->tlv_header,
  2067. WMITLV_TAG_STRUC_wmi_vdev_set_arp_stats_cmd_fixed_param,
  2068. WMITLV_GET_STRUCT_TLVLEN
  2069. (wmi_vdev_set_arp_stats_cmd_fixed_param));
  2070. /* fill in per roam config values */
  2071. wmi_set_arp->vdev_id = req_buf->vdev_id;
  2072. wmi_set_arp->set_clr = req_buf->flag;
  2073. wmi_set_arp->pkt_type = req_buf->pkt_type;
  2074. wmi_set_arp->ipv4 = req_buf->ip_addr;
  2075. WMI_LOGD("NUD Stats: vdev_id %u set_clr %u pkt_type:%u ipv4 %u",
  2076. wmi_set_arp->vdev_id, wmi_set_arp->set_clr,
  2077. wmi_set_arp->pkt_type, wmi_set_arp->ipv4);
  2078. /*
  2079. * pkt_type_bitmap should be non-zero to ensure
  2080. * presence of additional stats.
  2081. */
  2082. if (req_buf->pkt_type_bitmap) {
  2083. wmi_vdev_set_connectivity_check_stats *wmi_set_connect_stats;
  2084. buf_ptr += sizeof(wmi_vdev_set_arp_stats_cmd_fixed_param);
  2085. WMITLV_SET_HDR(buf_ptr,
  2086. WMITLV_TAG_ARRAY_STRUC,
  2087. sizeof(wmi_vdev_set_connectivity_check_stats));
  2088. buf_ptr += WMI_TLV_HDR_SIZE;
  2089. wmi_set_connect_stats =
  2090. (wmi_vdev_set_connectivity_check_stats *)buf_ptr;
  2091. WMITLV_SET_HDR(&wmi_set_connect_stats->tlv_header,
  2092. WMITLV_TAG_STRUC_wmi_vdev_set_connectivity_check_stats,
  2093. WMITLV_GET_STRUCT_TLVLEN(
  2094. wmi_vdev_set_connectivity_check_stats));
  2095. wmi_set_connect_stats->pkt_type_bitmap =
  2096. req_buf->pkt_type_bitmap;
  2097. wmi_set_connect_stats->tcp_src_port = req_buf->tcp_src_port;
  2098. wmi_set_connect_stats->tcp_dst_port = req_buf->tcp_dst_port;
  2099. wmi_set_connect_stats->icmp_ipv4 = req_buf->icmp_ipv4;
  2100. WMI_LOGD("Connectivity Stats: pkt_type_bitmap %u tcp_src_port:%u tcp_dst_port %u icmp_ipv4 %u",
  2101. wmi_set_connect_stats->pkt_type_bitmap,
  2102. wmi_set_connect_stats->tcp_src_port,
  2103. wmi_set_connect_stats->tcp_dst_port,
  2104. wmi_set_connect_stats->icmp_ipv4);
  2105. }
  2106. /* Send per roam config parameters */
  2107. wmi_mtrace(WMI_VDEV_SET_ARP_STAT_CMDID, NO_SESSION, 0);
  2108. status = wmi_unified_cmd_send(wmi_handle, buf,
  2109. len, WMI_VDEV_SET_ARP_STAT_CMDID);
  2110. if (QDF_IS_STATUS_ERROR(status)) {
  2111. WMI_LOGE("WMI_SET_ARP_STATS_CMDID failed, Error %d",
  2112. status);
  2113. goto error;
  2114. }
  2115. WMI_LOGD(FL("set arp stats flag=%d, vdev=%d"),
  2116. req_buf->flag, req_buf->vdev_id);
  2117. return QDF_STATUS_SUCCESS;
  2118. error:
  2119. wmi_buf_free(buf);
  2120. return status;
  2121. }
  2122. /**
  2123. * send_get_arp_stats_req_cmd_tlv() - send wmi cmd to get arp stats request
  2124. * @wmi_handle: wmi handler
  2125. * @req_buf: get arp stats request buffer
  2126. *
  2127. * Return: 0 for success and non zero for failure
  2128. */
  2129. static QDF_STATUS send_get_arp_stats_req_cmd_tlv(wmi_unified_t wmi_handle,
  2130. struct get_arp_stats *req_buf)
  2131. {
  2132. wmi_buf_t buf = NULL;
  2133. QDF_STATUS status;
  2134. int len;
  2135. uint8_t *buf_ptr;
  2136. wmi_vdev_get_arp_stats_cmd_fixed_param *get_arp_stats;
  2137. len = sizeof(wmi_vdev_get_arp_stats_cmd_fixed_param);
  2138. buf = wmi_buf_alloc(wmi_handle, len);
  2139. if (!buf) {
  2140. return QDF_STATUS_E_NOMEM;
  2141. }
  2142. buf_ptr = (uint8_t *) wmi_buf_data(buf);
  2143. get_arp_stats =
  2144. (wmi_vdev_get_arp_stats_cmd_fixed_param *) buf_ptr;
  2145. WMITLV_SET_HDR(&get_arp_stats->tlv_header,
  2146. WMITLV_TAG_STRUC_wmi_vdev_get_arp_stats_cmd_fixed_param,
  2147. WMITLV_GET_STRUCT_TLVLEN
  2148. (wmi_vdev_get_arp_stats_cmd_fixed_param));
  2149. /* fill in arp stats req cmd values */
  2150. get_arp_stats->vdev_id = req_buf->vdev_id;
  2151. WMI_LOGI(FL("vdev=%d"), req_buf->vdev_id);
  2152. /* Send per roam config parameters */
  2153. wmi_mtrace(WMI_VDEV_GET_ARP_STAT_CMDID, NO_SESSION, 0);
  2154. status = wmi_unified_cmd_send(wmi_handle, buf,
  2155. len, WMI_VDEV_GET_ARP_STAT_CMDID);
  2156. if (QDF_IS_STATUS_ERROR(status)) {
  2157. WMI_LOGE("WMI_GET_ARP_STATS_CMDID failed, Error %d",
  2158. status);
  2159. goto error;
  2160. }
  2161. return QDF_STATUS_SUCCESS;
  2162. error:
  2163. wmi_buf_free(buf);
  2164. return status;
  2165. }
  2166. void wmi_sta_attach_tlv(wmi_unified_t wmi_handle)
  2167. {
  2168. struct wmi_ops *ops = wmi_handle->ops;
  2169. ops->send_set_sta_sa_query_param_cmd =
  2170. send_set_sta_sa_query_param_cmd_tlv;
  2171. ops->send_set_sta_keep_alive_cmd = send_set_sta_keep_alive_cmd_tlv;
  2172. ops->send_vdev_set_gtx_cfg_cmd = send_vdev_set_gtx_cfg_cmd_tlv;
  2173. ops->send_process_dhcp_ind_cmd = send_process_dhcp_ind_cmd_tlv;
  2174. ops->send_get_link_speed_cmd = send_get_link_speed_cmd_tlv;
  2175. ops->send_fw_profiling_cmd = send_fw_profiling_cmd_tlv;
  2176. ops->send_nat_keepalive_en_cmd = send_nat_keepalive_en_cmd_tlv;
  2177. ops->send_wlm_latency_level_cmd = send_wlm_latency_level_cmd_tlv;
  2178. ops->send_nan_req_cmd = send_nan_req_cmd_tlv;
  2179. ops->send_process_set_ie_info_cmd = send_process_set_ie_info_cmd_tlv;
  2180. ops->send_set_base_macaddr_indicate_cmd =
  2181. send_set_base_macaddr_indicate_cmd_tlv;
  2182. ops->send_sar_limit_cmd = send_sar_limit_cmd_tlv;
  2183. ops->get_sar_limit_cmd = get_sar_limit_cmd_tlv;
  2184. ops->extract_sar_limit_event = extract_sar_limit_event_tlv;
  2185. ops->extract_sar2_result_event = extract_sar2_result_event_tlv;
  2186. ops->send_set_del_pmkid_cache_cmd = send_set_del_pmkid_cache_cmd_tlv;
  2187. ops->send_del_ts_cmd = send_del_ts_cmd_tlv;
  2188. ops->send_aggr_qos_cmd = send_aggr_qos_cmd_tlv;
  2189. ops->send_add_ts_cmd = send_add_ts_cmd_tlv;
  2190. ops->send_process_add_periodic_tx_ptrn_cmd =
  2191. send_process_add_periodic_tx_ptrn_cmd_tlv;
  2192. ops->send_process_del_periodic_tx_ptrn_cmd =
  2193. send_process_del_periodic_tx_ptrn_cmd_tlv;
  2194. ops->send_set_auto_shutdown_timer_cmd =
  2195. send_set_auto_shutdown_timer_cmd_tlv;
  2196. ops->send_set_led_flashing_cmd = send_set_led_flashing_cmd_tlv;
  2197. ops->send_process_ch_avoid_update_cmd =
  2198. send_process_ch_avoid_update_cmd_tlv;
  2199. ops->send_pdev_set_pcl_cmd = send_pdev_set_pcl_cmd_tlv;
  2200. ops->send_pdev_set_hw_mode_cmd = send_pdev_set_hw_mode_cmd_tlv;
  2201. ops->send_adapt_dwelltime_params_cmd =
  2202. send_adapt_dwelltime_params_cmd_tlv;
  2203. ops->send_dbs_scan_sel_params_cmd =
  2204. send_dbs_scan_sel_params_cmd_tlv;
  2205. ops->send_set_arp_stats_req_cmd = send_set_arp_stats_req_cmd_tlv;
  2206. ops->send_get_arp_stats_req_cmd = send_get_arp_stats_req_cmd_tlv;
  2207. wmi_tdls_attach_tlv(wmi_handle);
  2208. wmi_disa_attach_tlv(wmi_handle);
  2209. wmi_policy_mgr_attach_tlv(wmi_handle);
  2210. }