wmi_unified_twt_tlv.c 73 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356
  1. /*
  2. * Copyright (c) 2018-2021 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for
  6. * any purpose with or without fee is hereby granted, provided that the
  7. * above copyright notice and this permission notice appear in all
  8. * copies.
  9. *
  10. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  11. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  12. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  13. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  14. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  15. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  16. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  17. * PERFORMANCE OF THIS SOFTWARE.
  18. */
  19. #include <osdep.h>
  20. #include "wmi.h"
  21. #include "wmi_unified_priv.h"
  22. #include "wmi_unified_twt_param.h"
  23. #include "wmi_unified_twt_api.h"
  24. #if defined(WLAN_SUPPORT_TWT) && defined(WLAN_TWT_CONV_SUPPORTED)
  25. static QDF_STATUS send_twt_enable_cmd_tlv(wmi_unified_t wmi_handle,
  26. struct twt_enable_param *params)
  27. {
  28. wmi_twt_enable_cmd_fixed_param *cmd;
  29. wmi_buf_t buf;
  30. QDF_STATUS status;
  31. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  32. if (!buf) {
  33. wmi_err("Failed to allocate memory");
  34. return QDF_STATUS_E_FAILURE;
  35. }
  36. cmd = (wmi_twt_enable_cmd_fixed_param *)wmi_buf_data(buf);
  37. WMITLV_SET_HDR(&cmd->tlv_header,
  38. WMITLV_TAG_STRUC_wmi_twt_enable_cmd_fixed_param,
  39. WMITLV_GET_STRUCT_TLVLEN
  40. (wmi_twt_enable_cmd_fixed_param));
  41. cmd->pdev_id =
  42. wmi_handle->ops->convert_pdev_id_host_to_target(
  43. wmi_handle,
  44. params->pdev_id);
  45. cmd->sta_cong_timer_ms = params->sta_cong_timer_ms;
  46. cmd->mbss_support = params->mbss_support;
  47. cmd->default_slot_size = params->default_slot_size;
  48. cmd->congestion_thresh_setup = params->congestion_thresh_setup;
  49. cmd->congestion_thresh_teardown = params->congestion_thresh_teardown;
  50. cmd->congestion_thresh_critical = params->congestion_thresh_critical;
  51. cmd->interference_thresh_teardown =
  52. params->interference_thresh_teardown;
  53. cmd->interference_thresh_setup = params->interference_thresh_setup;
  54. cmd->min_no_sta_setup = params->min_no_sta_setup;
  55. cmd->min_no_sta_teardown = params->min_no_sta_teardown;
  56. cmd->no_of_bcast_mcast_slots = params->no_of_bcast_mcast_slots;
  57. cmd->min_no_twt_slots = params->min_no_twt_slots;
  58. cmd->max_no_sta_twt = params->max_no_sta_twt;
  59. cmd->mode_check_interval = params->mode_check_interval;
  60. cmd->add_sta_slot_interval = params->add_sta_slot_interval;
  61. cmd->remove_sta_slot_interval = params->remove_sta_slot_interval;
  62. TWT_EN_DIS_FLAGS_SET_BTWT(cmd->flags, params->b_twt_enable);
  63. TWT_EN_DIS_FLAGS_SET_L_MBSSID(cmd->flags,
  64. params->b_twt_legacy_mbss_enable);
  65. TWT_EN_DIS_FLAGS_SET_AX_MBSSID(cmd->flags,
  66. params->b_twt_ax_mbss_enable);
  67. if (params->ext_conf_present) {
  68. TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
  69. TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
  70. TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
  71. }
  72. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  73. WMI_TWT_ENABLE_CMDID);
  74. if (QDF_IS_STATUS_ERROR(status)) {
  75. wmi_err("Failed to send WMI_TWT_ENABLE_CMDID");
  76. wmi_buf_free(buf);
  77. }
  78. return status;
  79. }
  80. static WMI_DISABLE_TWT_REASON_T
  81. wmi_convert_dis_reason_code(enum HOST_TWT_DISABLE_REASON reason)
  82. {
  83. switch (reason) {
  84. case HOST_TWT_DISABLE_REASON_NONE:
  85. return WMI_DISABLE_TWT_REASON_NONE;
  86. case HOST_TWT_DISABLE_REASON_CONCURRENCY_SCC:
  87. return WMI_DISABLE_TWT_REASON_CONCURRENCY_SCC;
  88. case HOST_TWT_DISABLE_REASON_CONCURRENCY_MCC:
  89. return WMI_DISABLE_TWT_REASON_CONCURRENCY_MCC;
  90. case HOST_TWT_DISABLE_REASON_CHANGE_CONGESTION_TIMEOUT:
  91. return WMI_DISABLE_TWT_REASON_CHANGE_CONGESTION_TIMEOUT;
  92. case HOST_TWT_DISABLE_REASON_P2P_GO_NOA:
  93. return WMI_DISABLE_TWT_REASON_P2P_GO_NOA;
  94. default:
  95. return WMI_DISABLE_TWT_REASON_NONE;
  96. }
  97. }
  98. static QDF_STATUS send_twt_disable_cmd_tlv(wmi_unified_t wmi_handle,
  99. struct twt_disable_param *params)
  100. {
  101. wmi_twt_disable_cmd_fixed_param *cmd;
  102. wmi_buf_t buf;
  103. QDF_STATUS status;
  104. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  105. if (!buf) {
  106. wmi_err("Failed to allocate memory");
  107. return QDF_STATUS_E_FAILURE;
  108. }
  109. cmd = (wmi_twt_disable_cmd_fixed_param *)wmi_buf_data(buf);
  110. WMITLV_SET_HDR(&cmd->tlv_header,
  111. WMITLV_TAG_STRUC_wmi_twt_disable_cmd_fixed_param,
  112. WMITLV_GET_STRUCT_TLVLEN
  113. (wmi_twt_disable_cmd_fixed_param));
  114. cmd->pdev_id =
  115. wmi_handle->ops->convert_pdev_id_host_to_target(
  116. wmi_handle,
  117. params->pdev_id);
  118. if (params->ext_conf_present) {
  119. TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
  120. TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
  121. TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
  122. }
  123. cmd->reason_code = wmi_convert_dis_reason_code(
  124. params->dis_reason_code);
  125. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  126. WMI_TWT_DISABLE_CMDID);
  127. if (QDF_IS_STATUS_ERROR(status)) {
  128. wmi_err("Failed to send WMI_TWT_DISABLE_CMDID");
  129. wmi_buf_free(buf);
  130. }
  131. return status;
  132. }
  133. #ifdef WLAN_SUPPORT_BCAST_TWT
  134. static void
  135. twt_add_dialog_set_bcast_twt_params(struct twt_add_dialog_param *params,
  136. wmi_twt_add_dialog_cmd_fixed_param *cmd)
  137. {
  138. TWT_FLAGS_SET_BTWT_ID0(cmd->flags, params->flag_b_twt_id0);
  139. cmd->b_twt_persistence = params->b_twt_persistence;
  140. cmd->b_twt_recommendation = params->b_twt_recommendation;
  141. }
  142. #else
  143. static void
  144. twt_add_dialog_set_bcast_twt_params(struct twt_add_dialog_param *params,
  145. wmi_twt_add_dialog_cmd_fixed_param *cmd)
  146. {
  147. }
  148. #endif
  149. static QDF_STATUS
  150. send_twt_add_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  151. struct twt_add_dialog_param *params)
  152. {
  153. wmi_twt_add_dialog_cmd_fixed_param *cmd;
  154. wmi_buf_t buf;
  155. QDF_STATUS status;
  156. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  157. if (!buf) {
  158. wmi_err("Failed to allocate memory");
  159. return QDF_STATUS_E_FAILURE;
  160. }
  161. cmd = (wmi_twt_add_dialog_cmd_fixed_param *)wmi_buf_data(buf);
  162. WMITLV_SET_HDR(&cmd->tlv_header,
  163. WMITLV_TAG_STRUC_wmi_twt_add_dialog_cmd_fixed_param,
  164. WMITLV_GET_STRUCT_TLVLEN
  165. (wmi_twt_add_dialog_cmd_fixed_param));
  166. cmd->vdev_id = params->vdev_id;
  167. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
  168. &cmd->peer_macaddr);
  169. cmd->dialog_id = params->dialog_id;
  170. cmd->wake_intvl_us = params->wake_intvl_us;
  171. cmd->wake_intvl_mantis = params->wake_intvl_mantis;
  172. cmd->wake_dura_us = params->wake_dura_us;
  173. cmd->sp_offset_us = params->sp_offset_us;
  174. cmd->min_wake_intvl_us = params->min_wake_intvl_us;
  175. cmd->max_wake_intvl_us = params->max_wake_intvl_us;
  176. cmd->min_wake_dura_us = params->min_wake_dura_us;
  177. cmd->max_wake_dura_us = params->max_wake_dura_us;
  178. cmd->sp_start_tsf_lo = (uint32_t)(params->wake_time_tsf & 0xFFFFFFFF);
  179. cmd->sp_start_tsf_hi = (uint32_t)(params->wake_time_tsf >> 32);
  180. cmd->announce_timeout_us = params->announce_timeout_us;
  181. TWT_FLAGS_SET_CMD(cmd->flags, params->twt_cmd);
  182. TWT_FLAGS_SET_BROADCAST(cmd->flags, params->flag_bcast);
  183. TWT_FLAGS_SET_TRIGGER(cmd->flags, params->flag_trigger);
  184. TWT_FLAGS_SET_FLOW_TYPE(cmd->flags, params->flag_flow_type);
  185. TWT_FLAGS_SET_PROTECTION(cmd->flags, params->flag_protection);
  186. twt_add_dialog_set_bcast_twt_params(params, cmd);
  187. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  188. WMI_TWT_ADD_DIALOG_CMDID);
  189. if (QDF_IS_STATUS_ERROR(status)) {
  190. wmi_err("Failed to send WMI_TWT_ADD_DIALOG_CMDID");
  191. wmi_buf_free(buf);
  192. }
  193. return status;
  194. }
  195. #ifdef WLAN_SUPPORT_BCAST_TWT
  196. static void
  197. twt_del_dialog_set_bcast_twt_params(struct twt_del_dialog_param *params,
  198. wmi_twt_del_dialog_cmd_fixed_param *cmd)
  199. {
  200. cmd->b_twt_persistence = params->b_twt_persistence;
  201. }
  202. #else
  203. static void
  204. twt_del_dialog_set_bcast_twt_params(struct twt_del_dialog_param *params,
  205. wmi_twt_del_dialog_cmd_fixed_param *cmd)
  206. {
  207. }
  208. #endif
  209. static QDF_STATUS
  210. send_twt_del_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  211. struct twt_del_dialog_param *params)
  212. {
  213. wmi_twt_del_dialog_cmd_fixed_param *cmd;
  214. wmi_buf_t buf;
  215. QDF_STATUS status;
  216. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  217. if (!buf) {
  218. wmi_err("Failed to allocate memory");
  219. return QDF_STATUS_E_FAILURE;
  220. }
  221. cmd = (wmi_twt_del_dialog_cmd_fixed_param *)wmi_buf_data(buf);
  222. WMITLV_SET_HDR(&cmd->tlv_header,
  223. WMITLV_TAG_STRUC_wmi_twt_del_dialog_cmd_fixed_param,
  224. WMITLV_GET_STRUCT_TLVLEN
  225. (wmi_twt_del_dialog_cmd_fixed_param));
  226. cmd->vdev_id = params->vdev_id;
  227. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
  228. &cmd->peer_macaddr);
  229. cmd->dialog_id = params->dialog_id;
  230. twt_del_dialog_set_bcast_twt_params(params, cmd);
  231. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  232. WMI_TWT_DEL_DIALOG_CMDID);
  233. if (QDF_IS_STATUS_ERROR(status)) {
  234. wmi_err("Failed to send WMI_TWT_DEL_DIALOG_CMDID");
  235. wmi_buf_free(buf);
  236. }
  237. return status;
  238. }
  239. static QDF_STATUS
  240. send_twt_pause_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  241. struct twt_pause_dialog_cmd_param *params)
  242. {
  243. wmi_twt_pause_dialog_cmd_fixed_param *cmd;
  244. wmi_buf_t buf;
  245. QDF_STATUS status;
  246. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  247. if (!buf) {
  248. wmi_err("Failed to allocate memory");
  249. return QDF_STATUS_E_FAILURE;
  250. }
  251. cmd = (wmi_twt_pause_dialog_cmd_fixed_param *)wmi_buf_data(buf);
  252. WMITLV_SET_HDR(&cmd->tlv_header,
  253. WMITLV_TAG_STRUC_wmi_twt_pause_dialog_cmd_fixed_param,
  254. WMITLV_GET_STRUCT_TLVLEN
  255. (wmi_twt_pause_dialog_cmd_fixed_param));
  256. cmd->vdev_id = params->vdev_id;
  257. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
  258. &cmd->peer_macaddr);
  259. cmd->dialog_id = params->dialog_id;
  260. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  261. WMI_TWT_PAUSE_DIALOG_CMDID);
  262. if (QDF_IS_STATUS_ERROR(status)) {
  263. wmi_err("Failed to send WMI_TWT_PAUSE_DIALOG_CMDID");
  264. wmi_buf_free(buf);
  265. }
  266. return status;
  267. }
  268. static QDF_STATUS
  269. send_twt_nudge_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  270. struct twt_nudge_dialog_cmd_param *params)
  271. {
  272. wmi_twt_nudge_dialog_cmd_fixed_param *cmd;
  273. wmi_buf_t buf;
  274. QDF_STATUS status;
  275. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  276. if (!buf)
  277. return QDF_STATUS_E_FAILURE;
  278. cmd = (wmi_twt_nudge_dialog_cmd_fixed_param *)wmi_buf_data(buf);
  279. WMITLV_SET_HDR(&cmd->tlv_header,
  280. WMITLV_TAG_STRUC_wmi_twt_nudge_dialog_cmd_fixed_param,
  281. WMITLV_GET_STRUCT_TLVLEN
  282. (wmi_twt_nudge_dialog_cmd_fixed_param));
  283. cmd->vdev_id = params->vdev_id;
  284. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
  285. &cmd->peer_macaddr);
  286. cmd->dialog_id = params->dialog_id;
  287. cmd->suspend_duration_ms = params->suspend_duration / 1000;
  288. cmd->next_twt_size = params->next_twt_size;
  289. cmd->sp_start_offset = params->sp_start_offset;
  290. wmi_debug("vdev_id: %d dialog_id: %d duration(in ms): %u next_twt_size: %d "
  291. "peer_macaddr: " QDF_MAC_ADDR_FMT " sp_start_offset: %d",
  292. cmd->vdev_id, cmd->dialog_id, cmd->suspend_duration_ms,
  293. cmd->next_twt_size,
  294. QDF_MAC_ADDR_REF(params->peer_macaddr.bytes),
  295. cmd->sp_start_offset);
  296. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  297. WMI_TWT_NUDGE_DIALOG_CMDID);
  298. if (QDF_IS_STATUS_ERROR(status))
  299. wmi_buf_free(buf);
  300. return status;
  301. }
  302. static QDF_STATUS send_twt_resume_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  303. struct twt_resume_dialog_cmd_param *params)
  304. {
  305. wmi_twt_resume_dialog_cmd_fixed_param *cmd;
  306. wmi_buf_t buf;
  307. QDF_STATUS status;
  308. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  309. if (!buf) {
  310. wmi_err("Failed to allocate memory");
  311. return QDF_STATUS_E_FAILURE;
  312. }
  313. cmd = (wmi_twt_resume_dialog_cmd_fixed_param *)wmi_buf_data(buf);
  314. WMITLV_SET_HDR(&cmd->tlv_header,
  315. WMITLV_TAG_STRUC_wmi_twt_resume_dialog_cmd_fixed_param,
  316. WMITLV_GET_STRUCT_TLVLEN
  317. (wmi_twt_resume_dialog_cmd_fixed_param));
  318. cmd->vdev_id = params->vdev_id;
  319. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
  320. &cmd->peer_macaddr);
  321. cmd->dialog_id = params->dialog_id;
  322. cmd->sp_offset_us = params->sp_offset_us;
  323. cmd->next_twt_size = params->next_twt_size;
  324. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  325. WMI_TWT_RESUME_DIALOG_CMDID);
  326. if (QDF_IS_STATUS_ERROR(status)) {
  327. wmi_err("Failed to send WMI_TWT_RESUME_DIALOG_CMDID");
  328. wmi_buf_free(buf);
  329. }
  330. return status;
  331. }
  332. #ifdef WLAN_SUPPORT_BCAST_TWT
  333. static QDF_STATUS
  334. send_twt_btwt_invite_sta_cmd_tlv(wmi_unified_t wmi_handle,
  335. struct twt_btwt_invite_sta_cmd_param *params)
  336. {
  337. wmi_twt_btwt_invite_sta_cmd_fixed_param *cmd;
  338. wmi_buf_t buf;
  339. QDF_STATUS status;
  340. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  341. if (!buf) {
  342. wmi_err("Failed to allocate memory");
  343. return QDF_STATUS_E_FAILURE;
  344. }
  345. cmd = (wmi_twt_btwt_invite_sta_cmd_fixed_param *)wmi_buf_data(buf);
  346. WMITLV_SET_HDR(&cmd->tlv_header,
  347. WMITLV_TAG_STRUC_wmi_twt_btwt_invite_sta_cmd_fixed_param,
  348. WMITLV_GET_STRUCT_TLVLEN
  349. (wmi_twt_btwt_invite_sta_cmd_fixed_param));
  350. cmd->vdev_id = params->vdev_id;
  351. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
  352. &cmd->peer_macaddr);
  353. cmd->dialog_id = params->dialog_id;
  354. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  355. WMI_TWT_BTWT_INVITE_STA_CMDID);
  356. if (QDF_IS_STATUS_ERROR(status)) {
  357. wmi_buf_free(buf);
  358. wmi_err("Failed to send WMI_TWT_BTWT_INVITE_STA_CMDID");
  359. }
  360. return status;
  361. }
  362. static QDF_STATUS
  363. send_twt_btwt_remove_sta_cmd_tlv(wmi_unified_t wmi_handle,
  364. struct twt_btwt_remove_sta_cmd_param
  365. *params)
  366. {
  367. wmi_twt_btwt_remove_sta_cmd_fixed_param *cmd;
  368. wmi_buf_t buf;
  369. QDF_STATUS status;
  370. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  371. if (!buf) {
  372. wmi_err("Failed to allocate memory");
  373. return QDF_STATUS_E_FAILURE;
  374. }
  375. cmd = (wmi_twt_btwt_remove_sta_cmd_fixed_param *)wmi_buf_data(buf);
  376. WMITLV_SET_HDR(&cmd->tlv_header,
  377. WMITLV_TAG_STRUC_wmi_twt_btwt_remove_sta_cmd_fixed_param,
  378. WMITLV_GET_STRUCT_TLVLEN
  379. (wmi_twt_btwt_remove_sta_cmd_fixed_param));
  380. cmd->vdev_id = params->vdev_id;
  381. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
  382. &cmd->peer_macaddr);
  383. cmd->dialog_id = params->dialog_id;
  384. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  385. WMI_TWT_BTWT_REMOVE_STA_CMDID);
  386. if (QDF_IS_STATUS_ERROR(status)) {
  387. wmi_buf_free(buf);
  388. wmi_err("Failed to send WMI_TWT_BTWT_REMOVE_STA_CMDID");
  389. }
  390. return status;
  391. }
  392. #endif
  393. static enum HOST_TWT_ENABLE_STATUS
  394. wmi_twt_enable_status_to_host_twt_status(WMI_ENABLE_TWT_STATUS_T status)
  395. {
  396. switch (status) {
  397. case WMI_ENABLE_TWT_STATUS_OK:
  398. return HOST_TWT_ENABLE_STATUS_OK;
  399. case WMI_ENABLE_TWT_STATUS_ALREADY_ENABLED:
  400. return HOST_TWT_ENABLE_STATUS_ALREADY_ENABLED;
  401. case WMI_ENABLE_TWT_STATUS_NOT_READY:
  402. return HOST_TWT_ENABLE_STATUS_NOT_READY;
  403. case WMI_ENABLE_TWT_INVALID_PARAM:
  404. return HOST_TWT_ENABLE_INVALID_PARAM;
  405. default:
  406. return HOST_TWT_ENABLE_STATUS_UNKNOWN_ERROR;
  407. }
  408. }
  409. static QDF_STATUS extract_twt_enable_comp_event_tlv(wmi_unified_t wmi_handle,
  410. uint8_t *evt_buf,
  411. struct twt_enable_complete_event_param *params)
  412. {
  413. WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
  414. wmi_twt_enable_complete_event_fixed_param *ev;
  415. param_buf = (WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  416. if (!param_buf) {
  417. wmi_err("evt_buf is NULL");
  418. return QDF_STATUS_E_INVAL;
  419. }
  420. ev = param_buf->fixed_param;
  421. params->pdev_id =
  422. wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
  423. ev->pdev_id);
  424. params->status = wmi_twt_enable_status_to_host_twt_status(ev->status);
  425. return QDF_STATUS_SUCCESS;
  426. }
  427. static enum HOST_TWT_DISABLE_STATUS
  428. wmi_twt_disable_status_to_host_twt_status(WMI_DISABLE_TWT_STATUS_T status)
  429. {
  430. switch (status) {
  431. case WMI_DISABLE_TWT_STATUS_OK:
  432. return HOST_TWT_DISABLE_STATUS_OK;
  433. case WMI_DISABLE_TWT_STATUS_ROAM_IN_PROGRESS:
  434. return HOST_TWT_DISABLE_STATUS_ROAM_IN_PROGRESS;
  435. case WMI_DISABLE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  436. return HOST_TWT_DISABLE_STATUS_CHAN_SW_IN_PROGRESS;
  437. case WMI_DISABLE_TWT_STATUS_SCAN_IN_PROGRESS:
  438. return HOST_TWT_DISABLE_STATUS_SCAN_IN_PROGRESS;
  439. default:
  440. return HOST_TWT_DISABLE_STATUS_UNKNOWN_ERROR;
  441. }
  442. }
  443. static QDF_STATUS extract_twt_disable_comp_event_tlv(wmi_unified_t wmi_handle,
  444. uint8_t *evt_buf,
  445. struct twt_disable_complete_event_param *params)
  446. {
  447. WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
  448. wmi_twt_disable_complete_event_fixed_param *ev;
  449. param_buf = (WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  450. if (!param_buf) {
  451. wmi_err("evt_buf is NULL");
  452. return QDF_STATUS_E_INVAL;
  453. }
  454. ev = param_buf->fixed_param;
  455. params->pdev_id =
  456. wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
  457. ev->pdev_id);
  458. params->status = wmi_twt_disable_status_to_host_twt_status(ev->status);
  459. return QDF_STATUS_SUCCESS;
  460. }
  461. static enum HOST_TWT_ADD_STATUS
  462. wmi_get_converted_twt_add_dialog_status(WMI_ADD_TWT_STATUS_T tgt_status)
  463. {
  464. switch (tgt_status) {
  465. case WMI_ADD_TWT_STATUS_OK:
  466. return HOST_TWT_ADD_STATUS_OK;
  467. case WMI_ADD_TWT_STATUS_TWT_NOT_ENABLED:
  468. return HOST_TWT_ADD_STATUS_TWT_NOT_ENABLED;
  469. case WMI_ADD_TWT_STATUS_USED_DIALOG_ID:
  470. return HOST_TWT_ADD_STATUS_USED_DIALOG_ID;
  471. case WMI_ADD_TWT_STATUS_INVALID_PARAM:
  472. return HOST_TWT_ADD_STATUS_INVALID_PARAM;
  473. case WMI_ADD_TWT_STATUS_NOT_READY:
  474. return HOST_TWT_ADD_STATUS_NOT_READY;
  475. case WMI_ADD_TWT_STATUS_NO_RESOURCE:
  476. return HOST_TWT_ADD_STATUS_NO_RESOURCE;
  477. case WMI_ADD_TWT_STATUS_NO_ACK:
  478. return HOST_TWT_ADD_STATUS_NO_ACK;
  479. case WMI_ADD_TWT_STATUS_NO_RESPONSE:
  480. return HOST_TWT_ADD_STATUS_NO_RESPONSE;
  481. case WMI_ADD_TWT_STATUS_DENIED:
  482. return HOST_TWT_ADD_STATUS_DENIED;
  483. case WMI_ADD_TWT_STATUS_AP_PARAMS_NOT_IN_RANGE:
  484. return HOST_TWT_ADD_STATUS_AP_PARAMS_NOT_IN_RANGE;
  485. case WMI_ADD_TWT_STATUS_AP_IE_VALIDATION_FAILED:
  486. return HOST_TWT_ADD_STATUS_AP_IE_VALIDATION_FAILED;
  487. case WMI_ADD_TWT_STATUS_ROAM_IN_PROGRESS:
  488. return HOST_TWT_ADD_STATUS_ROAM_IN_PROGRESS;
  489. case WMI_ADD_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  490. return HOST_TWT_ADD_STATUS_CHAN_SW_IN_PROGRESS;
  491. case WMI_ADD_TWT_STATUS_SCAN_IN_PROGRESS:
  492. return HOST_TWT_ADD_STATUS_SCAN_IN_PROGRESS;
  493. default:
  494. return HOST_TWT_ADD_STATUS_UNKNOWN_ERROR;
  495. }
  496. }
  497. /**
  498. * extract_twt_add_dialog_comp_event_tlv - Extacts twt add dialog complete wmi
  499. * event from firmware
  500. * @wmi_hande: WMI handle
  501. * @evt_buf: Pointer to wmi event buf of twt add dialog complete event
  502. * @params: Pointer to store the extracted parameters
  503. *
  504. * Return: QDF_STATUS_SUCCESS on success or QDF STATUS error values on failure
  505. */
  506. static QDF_STATUS extract_twt_add_dialog_comp_event_tlv(
  507. wmi_unified_t wmi_handle,
  508. uint8_t *evt_buf,
  509. struct twt_add_dialog_complete_event_param *params)
  510. {
  511. WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  512. wmi_twt_add_dialog_complete_event_fixed_param *ev;
  513. param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  514. if (!param_buf) {
  515. wmi_err("evt_buf is NULL");
  516. return QDF_STATUS_E_INVAL;
  517. }
  518. ev = param_buf->fixed_param;
  519. params->vdev_id = ev->vdev_id;
  520. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
  521. params->peer_macaddr.bytes);
  522. params->status = wmi_get_converted_twt_add_dialog_status(ev->status);
  523. params->dialog_id = ev->dialog_id;
  524. params->num_additional_twt_params = param_buf->num_twt_params;
  525. return QDF_STATUS_SUCCESS;
  526. }
  527. /**
  528. * extract_twt_add_dialog_comp_additional_parameters() - Extracts additional twt
  529. * twt parameters, as part of add dialog completion event
  530. * @wmi_hdl: wmi handle
  531. * @evt_buf: Pointer event buffer
  532. * @evt_buf_len: length of the add dialog event buffer
  533. * @idx: index of num_twt_params
  534. * @additional_params: twt additional parameters to extract
  535. *
  536. * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_INVAL for failure
  537. */
  538. static QDF_STATUS extract_twt_add_dialog_comp_additional_parameters
  539. (
  540. wmi_unified_t wmi_handle, uint8_t *evt_buf,
  541. uint32_t evt_buf_len, uint32_t idx,
  542. struct twt_add_dialog_additional_params *additional_params
  543. )
  544. {
  545. WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  546. wmi_twt_add_dialog_complete_event_fixed_param *ev;
  547. uint32_t flags = 0;
  548. uint32_t expected_len;
  549. param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  550. if (!param_buf) {
  551. wmi_err("evt_buf is NULL");
  552. return QDF_STATUS_E_INVAL;
  553. }
  554. ev = param_buf->fixed_param;
  555. if (idx >= param_buf->num_twt_params) {
  556. wmi_err("Invalid idx %d while num_twt_params = %d",
  557. idx, param_buf->num_twt_params);
  558. return QDF_STATUS_E_INVAL;
  559. }
  560. if (!param_buf->twt_params) {
  561. wmi_err("Unable to extract additional twt parameters");
  562. return QDF_STATUS_E_INVAL;
  563. }
  564. expected_len = (sizeof(wmi_twt_add_dialog_complete_event_fixed_param) +
  565. WMI_TLV_HDR_SIZE + (param_buf->num_twt_params *
  566. sizeof(wmi_twt_add_dialog_additional_params)));
  567. if (evt_buf_len != expected_len) {
  568. wmi_err("Got invalid len data from FW %d expected %d",
  569. evt_buf_len, expected_len);
  570. return QDF_STATUS_E_INVAL;
  571. }
  572. flags = param_buf->twt_params[idx].flags;
  573. additional_params->twt_cmd = TWT_FLAGS_GET_CMD(flags);
  574. additional_params->bcast = TWT_FLAGS_GET_BROADCAST(flags);
  575. additional_params->trig_en = TWT_FLAGS_GET_TRIGGER(flags);
  576. additional_params->announce = TWT_FLAGS_GET_FLOW_TYPE(flags);
  577. additional_params->protection = TWT_FLAGS_GET_PROTECTION(flags);
  578. additional_params->b_twt_id0 = TWT_FLAGS_GET_BTWT_ID0(flags);
  579. additional_params->info_frame_disabled =
  580. TWT_FLAGS_GET_TWT_INFO_FRAME_DISABLED(flags);
  581. additional_params->wake_dur_us = param_buf->twt_params[idx].wake_dur_us;
  582. additional_params->wake_intvl_us =
  583. param_buf->twt_params[idx].wake_intvl_us;
  584. additional_params->sp_offset_us =
  585. param_buf->twt_params[idx].sp_offset_us;
  586. additional_params->sp_tsf_us_lo =
  587. param_buf->twt_params[idx].sp_tsf_us_lo;
  588. additional_params->sp_tsf_us_hi =
  589. param_buf->twt_params[idx].sp_tsf_us_hi;
  590. additional_params->pm_responder_bit_valid =
  591. TWT_FLAGS_GET_PM_RESPONDER_MODE_VALID(flags);
  592. additional_params->pm_responder_bit =
  593. TWT_FLAGS_GET_PM_RESPONDER_MODE(flags);
  594. return QDF_STATUS_SUCCESS;
  595. }
  596. static enum HOST_TWT_DEL_STATUS
  597. wmi_get_converted_twt_del_dialog_status(WMI_DEL_TWT_STATUS_T tgt_status)
  598. {
  599. switch (tgt_status) {
  600. case WMI_DEL_TWT_STATUS_OK:
  601. return HOST_TWT_DEL_STATUS_OK;
  602. case WMI_DEL_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  603. return HOST_TWT_DEL_STATUS_DIALOG_ID_NOT_EXIST;
  604. case WMI_DEL_TWT_STATUS_INVALID_PARAM:
  605. return HOST_TWT_DEL_STATUS_INVALID_PARAM;
  606. case WMI_DEL_TWT_STATUS_DIALOG_ID_BUSY:
  607. return HOST_TWT_DEL_STATUS_DIALOG_ID_BUSY;
  608. case WMI_DEL_TWT_STATUS_NO_RESOURCE:
  609. return HOST_TWT_DEL_STATUS_NO_RESOURCE;
  610. case WMI_DEL_TWT_STATUS_NO_ACK:
  611. return HOST_TWT_DEL_STATUS_NO_ACK;
  612. case WMI_DEL_TWT_STATUS_PEER_INIT_TEARDOWN:
  613. return HOST_TWT_DEL_STATUS_PEER_INIT_TEARDOWN;
  614. case WMI_DEL_TWT_STATUS_ROAMING:
  615. return HOST_TWT_DEL_STATUS_ROAMING;
  616. case WMI_DEL_TWT_STATUS_CONCURRENCY:
  617. return HOST_TWT_DEL_STATUS_CONCURRENCY;
  618. case WMI_DEL_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  619. return HOST_TWT_DEL_STATUS_CHAN_SW_IN_PROGRESS;
  620. case WMI_DEL_TWT_STATUS_SCAN_IN_PROGRESS:
  621. return HOST_TWT_DEL_STATUS_SCAN_IN_PROGRESS;
  622. default:
  623. return HOST_TWT_DEL_STATUS_UNKNOWN_ERROR;
  624. }
  625. }
  626. static QDF_STATUS extract_twt_del_dialog_comp_event_tlv(
  627. wmi_unified_t wmi_handle,
  628. uint8_t *evt_buf,
  629. struct twt_del_dialog_complete_event_param *params)
  630. {
  631. WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  632. wmi_twt_del_dialog_complete_event_fixed_param *ev;
  633. param_buf = (WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  634. if (!param_buf) {
  635. wmi_err("evt_buf is NULL");
  636. return QDF_STATUS_E_INVAL;
  637. }
  638. ev = param_buf->fixed_param;
  639. params->vdev_id = ev->vdev_id;
  640. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
  641. params->peer_macaddr.bytes);
  642. params->dialog_id = ev->dialog_id;
  643. params->status = wmi_get_converted_twt_del_dialog_status(ev->status);
  644. return QDF_STATUS_SUCCESS;
  645. }
  646. static enum HOST_TWT_PAUSE_STATUS
  647. wmi_twt_pause_status_to_host_twt_status(WMI_PAUSE_TWT_STATUS_T status)
  648. {
  649. switch (status) {
  650. case WMI_PAUSE_TWT_STATUS_OK:
  651. return HOST_TWT_PAUSE_STATUS_OK;
  652. case WMI_PAUSE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  653. return HOST_TWT_PAUSE_STATUS_DIALOG_ID_NOT_EXIST;
  654. case WMI_PAUSE_TWT_STATUS_INVALID_PARAM:
  655. return HOST_TWT_PAUSE_STATUS_INVALID_PARAM;
  656. case WMI_PAUSE_TWT_STATUS_DIALOG_ID_BUSY:
  657. return HOST_TWT_PAUSE_STATUS_DIALOG_ID_BUSY;
  658. case WMI_PAUSE_TWT_STATUS_NO_RESOURCE:
  659. return HOST_TWT_PAUSE_STATUS_NO_RESOURCE;
  660. case WMI_PAUSE_TWT_STATUS_NO_ACK:
  661. return HOST_TWT_PAUSE_STATUS_NO_ACK;
  662. case WMI_PAUSE_TWT_STATUS_ALREADY_PAUSED:
  663. return HOST_TWT_PAUSE_STATUS_ALREADY_PAUSED;
  664. case WMI_PAUSE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  665. return HOST_TWT_PAUSE_STATUS_CHAN_SW_IN_PROGRESS;
  666. case WMI_PAUSE_TWT_STATUS_ROAM_IN_PROGRESS:
  667. return HOST_TWT_PAUSE_STATUS_ROAM_IN_PROGRESS;
  668. case WMI_PAUSE_TWT_STATUS_SCAN_IN_PROGRESS:
  669. return HOST_TWT_PAUSE_STATUS_SCAN_IN_PROGRESS;
  670. default:
  671. return HOST_TWT_PAUSE_STATUS_UNKNOWN_ERROR;
  672. }
  673. }
  674. static QDF_STATUS extract_twt_pause_dialog_comp_event_tlv(
  675. wmi_unified_t wmi_handle,
  676. uint8_t *evt_buf,
  677. struct twt_pause_dialog_complete_event_param *params)
  678. {
  679. WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  680. wmi_twt_pause_dialog_complete_event_fixed_param *ev;
  681. param_buf = (WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  682. if (!param_buf) {
  683. wmi_err("evt_buf is NULL");
  684. return QDF_STATUS_E_INVAL;
  685. }
  686. ev = param_buf->fixed_param;
  687. params->vdev_id = ev->vdev_id;
  688. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
  689. params->peer_macaddr.bytes);
  690. params->status = wmi_twt_pause_status_to_host_twt_status(ev->status);
  691. params->dialog_id = ev->dialog_id;
  692. return QDF_STATUS_SUCCESS;
  693. }
  694. static enum HOST_TWT_NUDGE_STATUS
  695. wmi_twt_nudge_status_to_host_twt_status(WMI_TWT_NUDGE_STATUS_T status)
  696. {
  697. switch (status) {
  698. case WMI_NUDGE_TWT_STATUS_OK:
  699. return HOST_TWT_NUDGE_STATUS_OK;
  700. case WMI_NUDGE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  701. return HOST_TWT_NUDGE_STATUS_DIALOG_ID_NOT_EXIST;
  702. case WMI_NUDGE_TWT_STATUS_INVALID_PARAM:
  703. return HOST_TWT_NUDGE_STATUS_INVALID_PARAM;
  704. case WMI_NUDGE_TWT_STATUS_DIALOG_ID_BUSY:
  705. return HOST_TWT_NUDGE_STATUS_DIALOG_ID_BUSY;
  706. case WMI_NUDGE_TWT_STATUS_NO_RESOURCE:
  707. return HOST_TWT_NUDGE_STATUS_NO_RESOURCE;
  708. case WMI_NUDGE_TWT_STATUS_NO_ACK:
  709. return HOST_TWT_NUDGE_STATUS_NO_ACK;
  710. case WMI_NUDGE_TWT_STATUS_ALREADY_PAUSED:
  711. return HOST_TWT_NUDGE_STATUS_ALREADY_PAUSED;
  712. case WMI_NUDGE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  713. return HOST_TWT_NUDGE_STATUS_CHAN_SW_IN_PROGRESS;
  714. case WMI_NUDGE_TWT_STATUS_ROAM_IN_PROGRESS:
  715. return HOST_TWT_NUDGE_STATUS_ROAM_IN_PROGRESS;
  716. case WMI_NUDGE_TWT_STATUS_SCAN_IN_PROGRESS:
  717. return HOST_TWT_NUDGE_STATUS_SCAN_IN_PROGRESS;
  718. default:
  719. return HOST_TWT_NUDGE_STATUS_UNKNOWN_ERROR;
  720. }
  721. }
  722. static QDF_STATUS extract_twt_nudge_dialog_comp_event_tlv(
  723. wmi_unified_t wmi_handle,
  724. uint8_t *evt_buf,
  725. struct twt_nudge_dialog_complete_event_param *params)
  726. {
  727. WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  728. wmi_twt_nudge_dialog_complete_event_fixed_param *ev;
  729. param_buf = (WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  730. if (!param_buf) {
  731. wmi_err("evt_buf is NULL");
  732. return QDF_STATUS_E_INVAL;
  733. }
  734. ev = param_buf->fixed_param;
  735. params->vdev_id = ev->vdev_id;
  736. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
  737. params->peer_macaddr.bytes);
  738. params->status = wmi_twt_nudge_status_to_host_twt_status(ev->status);
  739. params->dialog_id = ev->dialog_id;
  740. params->next_twt_tsf_us_lo = ev->sp_tsf_us_lo;
  741. params->next_twt_tsf_us_hi = ev->sp_tsf_us_hi;
  742. wmi_debug("vdev_id: %d dialog_id: %d tsf hi : %x tsf lo: %x",
  743. params->vdev_id, params->dialog_id,
  744. params->next_twt_tsf_us_hi, params->next_twt_tsf_us_lo);
  745. return QDF_STATUS_SUCCESS;
  746. }
  747. static enum HOST_TWT_RESUME_STATUS
  748. wmi_get_converted_twt_resume_dialog_status(WMI_RESUME_TWT_STATUS_T tgt_status)
  749. {
  750. switch (tgt_status) {
  751. case WMI_RESUME_TWT_STATUS_OK:
  752. return HOST_TWT_RESUME_STATUS_OK;
  753. case WMI_RESUME_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  754. return HOST_TWT_RESUME_STATUS_DIALOG_ID_NOT_EXIST;
  755. case WMI_RESUME_TWT_STATUS_INVALID_PARAM:
  756. return HOST_TWT_RESUME_STATUS_INVALID_PARAM;
  757. case WMI_RESUME_TWT_STATUS_DIALOG_ID_BUSY:
  758. return HOST_TWT_RESUME_STATUS_DIALOG_ID_BUSY;
  759. case WMI_RESUME_TWT_STATUS_NOT_PAUSED:
  760. return HOST_TWT_RESUME_STATUS_NOT_PAUSED;
  761. case WMI_RESUME_TWT_STATUS_NO_RESOURCE:
  762. return HOST_TWT_RESUME_STATUS_NO_RESOURCE;
  763. case WMI_RESUME_TWT_STATUS_NO_ACK:
  764. return HOST_TWT_RESUME_STATUS_NO_ACK;
  765. case WMI_RESUME_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  766. return HOST_TWT_RESUME_STATUS_CHAN_SW_IN_PROGRESS;
  767. case WMI_RESUME_TWT_STATUS_ROAM_IN_PROGRESS:
  768. return HOST_TWT_RESUME_STATUS_ROAM_IN_PROGRESS;
  769. case WMI_RESUME_TWT_STATUS_SCAN_IN_PROGRESS:
  770. return HOST_TWT_RESUME_STATUS_SCAN_IN_PROGRESS;
  771. default:
  772. return HOST_TWT_RESUME_STATUS_UNKNOWN_ERROR;
  773. }
  774. }
  775. static QDF_STATUS extract_twt_resume_dialog_comp_event_tlv(
  776. wmi_unified_t wmi_handle,
  777. uint8_t *evt_buf,
  778. struct twt_resume_dialog_complete_event_param *params)
  779. {
  780. WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  781. wmi_twt_resume_dialog_complete_event_fixed_param *ev;
  782. param_buf =
  783. (WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  784. if (!param_buf) {
  785. wmi_err("evt_buf is NULL");
  786. return QDF_STATUS_E_INVAL;
  787. }
  788. ev = param_buf->fixed_param;
  789. params->vdev_id = ev->vdev_id;
  790. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
  791. params->peer_macaddr.bytes);
  792. params->status = wmi_get_converted_twt_resume_dialog_status(ev->status);
  793. params->dialog_id = ev->dialog_id;
  794. return QDF_STATUS_SUCCESS;
  795. }
  796. static enum HOST_TWT_NOTIFY_STATUS
  797. wmi_get_converted_twt_notify_status(WMI_TWT_NOTIFICATION_ID_T tgt_status)
  798. {
  799. switch (tgt_status) {
  800. case WMI_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_SET:
  801. return HOST_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_SET;
  802. case WMI_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_CLEAR:
  803. return HOST_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_CLEAR;
  804. default:
  805. return HOST_TWT_NOTIFY_EVENT_READY;
  806. }
  807. }
  808. static QDF_STATUS extract_twt_notify_event_tlv(
  809. wmi_unified_t wmi_handle,
  810. uint8_t *evt_buf,
  811. struct twt_notify_event_param *params)
  812. {
  813. WMI_TWT_NOTIFY_EVENTID_param_tlvs *param_buf;
  814. wmi_twt_notify_event_fixed_param *ev;
  815. param_buf =
  816. (WMI_TWT_NOTIFY_EVENTID_param_tlvs *)evt_buf;
  817. if (!param_buf) {
  818. wmi_err("evt_buf is NULL");
  819. return QDF_STATUS_E_INVAL;
  820. }
  821. ev = param_buf->fixed_param;
  822. if (ev->event_id > WMI_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_CLEAR) {
  823. wmi_debug("Incorrect TWT notify event vdev_id: %d, status: %d",
  824. ev->vdev_id, ev->event_id);
  825. return QDF_STATUS_E_INVAL;
  826. }
  827. params->vdev_id = ev->vdev_id;
  828. params->status = wmi_get_converted_twt_notify_status(ev->event_id);
  829. wmi_debug("Extract notify event vdev_id: %d, status: %d",
  830. params->vdev_id, params->status);
  831. return QDF_STATUS_SUCCESS;
  832. }
  833. #ifdef WLAN_SUPPORT_BCAST_TWT
  834. static QDF_STATUS
  835. extract_twt_btwt_invite_sta_comp_event_tlv(
  836. wmi_unified_t wmi_handle,
  837. uint8_t *evt_buf,
  838. struct
  839. twt_btwt_invite_sta_complete_event_param
  840. *params)
  841. {
  842. WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
  843. wmi_twt_btwt_invite_sta_complete_event_fixed_param *ev;
  844. param_buf =
  845. (WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  846. if (!param_buf) {
  847. wmi_err("evt_buf is NULL");
  848. return QDF_STATUS_E_INVAL;
  849. }
  850. ev = param_buf->fixed_param;
  851. params->vdev_id = ev->vdev_id;
  852. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
  853. params->peer_macaddr.bytes);
  854. params->status = ev->status;
  855. params->dialog_id = ev->dialog_id;
  856. return QDF_STATUS_SUCCESS;
  857. }
  858. static QDF_STATUS
  859. extract_twt_btwt_remove_sta_comp_event_tlv(
  860. wmi_unified_t wmi_handle,
  861. uint8_t *evt_buf,
  862. struct
  863. twt_btwt_remove_sta_complete_event_param
  864. *params)
  865. {
  866. WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
  867. wmi_twt_btwt_remove_sta_complete_event_fixed_param *ev;
  868. param_buf =
  869. (WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  870. if (!param_buf) {
  871. wmi_err("evt_buf is NULL");
  872. return QDF_STATUS_E_INVAL;
  873. }
  874. ev = param_buf->fixed_param;
  875. params->vdev_id = ev->vdev_id;
  876. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
  877. params->peer_macaddr.bytes);
  878. params->status = ev->status;
  879. params->dialog_id = ev->dialog_id;
  880. return QDF_STATUS_SUCCESS;
  881. }
  882. #endif
  883. #ifdef WLAN_SUPPORT_BCAST_TWT
  884. static void
  885. wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
  886. {
  887. ops->send_twt_btwt_invite_sta_cmd = send_twt_btwt_invite_sta_cmd_tlv;
  888. ops->send_twt_btwt_remove_sta_cmd = send_twt_btwt_remove_sta_cmd_tlv;
  889. ops->extract_twt_btwt_invite_sta_comp_event =
  890. extract_twt_btwt_invite_sta_comp_event_tlv;
  891. ops->extract_twt_btwt_remove_sta_comp_event =
  892. extract_twt_btwt_remove_sta_comp_event_tlv;
  893. }
  894. #else
  895. static void
  896. wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
  897. {
  898. }
  899. #endif
  900. static QDF_STATUS
  901. extract_twt_session_stats_event_tlv(wmi_unified_t wmi_handle,
  902. uint8_t *evt_buf,
  903. struct twt_session_stats_event_param
  904. *params)
  905. {
  906. WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
  907. wmi_pdev_twt_session_stats_event_fixed_param *ev;
  908. param_buf =
  909. (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
  910. if (!param_buf) {
  911. wmi_err("evt_buf is NULL");
  912. return QDF_STATUS_E_INVAL;
  913. }
  914. ev = param_buf->fixed_param;
  915. params->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
  916. wmi_handle,
  917. ev->pdev_id);
  918. params->num_sessions = param_buf->num_twt_sessions;
  919. wmi_debug("pdev_id=%d, num of TWT sessions=%d",
  920. params->pdev_id, params->num_sessions);
  921. return QDF_STATUS_SUCCESS;
  922. }
  923. static QDF_STATUS
  924. extract_twt_session_stats_event_data(wmi_unified_t wmi_handle,
  925. uint8_t *evt_buf,
  926. struct twt_session_stats_event_param
  927. *params,
  928. struct twt_session_stats_info
  929. *session,
  930. uint32_t idx)
  931. {
  932. WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
  933. wmi_twt_session_stats_info *twt_session;
  934. uint32_t flags;
  935. wmi_mac_addr *m1;
  936. uint8_t *m2;
  937. param_buf =
  938. (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
  939. if (!param_buf) {
  940. wmi_err("evt_buf is NULL");
  941. return QDF_STATUS_E_INVAL;
  942. }
  943. if (idx >= param_buf->num_twt_sessions) {
  944. wmi_err("wrong idx, idx=%d, num_sessions=%d",
  945. idx, param_buf->num_twt_sessions);
  946. return QDF_STATUS_E_INVAL;
  947. }
  948. twt_session = &param_buf->twt_sessions[idx];
  949. session->vdev_id = twt_session->vdev_id;
  950. m1 = &twt_session->peer_mac;
  951. m2 = session->peer_mac.bytes;
  952. WMI_MAC_ADDR_TO_CHAR_ARRAY(m1, m2);
  953. session->event_type = twt_session->event_type;
  954. flags = twt_session->flow_id_flags;
  955. session->flow_id = WMI_TWT_SESSION_FLAG_FLOW_ID_GET(flags);
  956. session->bcast = WMI_TWT_SESSION_FLAG_BCAST_TWT_GET(flags);
  957. session->trig = WMI_TWT_SESSION_FLAG_TRIGGER_TWT_GET(flags);
  958. session->announ = WMI_TWT_SESSION_FLAG_ANNOUN_TWT_GET(flags);
  959. session->protection = WMI_TWT_SESSION_FLAG_TWT_PROTECTION_GET(flags);
  960. session->info_frame_disabled =
  961. WMI_TWT_SESSION_FLAG_TWT_INFO_FRAME_DISABLED_GET(flags);
  962. session->pm_responder_bit =
  963. WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_GET(flags);
  964. session->pm_responder_bit_valid =
  965. WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_VALID_GET(flags);
  966. session->dialog_id = twt_session->dialog_id;
  967. session->wake_dura_us = twt_session->wake_dura_us;
  968. session->wake_intvl_us = twt_session->wake_intvl_us;
  969. session->sp_offset_us = twt_session->sp_offset_us;
  970. session->sp_tsf_us_lo = twt_session->sp_tsf_us_lo;
  971. session->sp_tsf_us_hi = twt_session->sp_tsf_us_hi;
  972. wmi_debug("type=%d id=%d bcast=%d trig=%d announ=%d diagid=%d wake_dur=%ul wake_int=%ul offset=%ul",
  973. session->event_type, session->flow_id,
  974. session->bcast, session->trig,
  975. session->announ, session->dialog_id, session->wake_dura_us,
  976. session->wake_intvl_us, session->sp_offset_us);
  977. wmi_debug("resp_pm_valid=%d resp_pm=%d",
  978. session->pm_responder_bit_valid, session->pm_responder_bit);
  979. return QDF_STATUS_SUCCESS;
  980. }
  981. static QDF_STATUS extract_twt_cap_service_ready_ext2_tlv(
  982. wmi_unified_t wmi_handle, uint8_t *event,
  983. struct wmi_twt_cap_bitmap_params *var)
  984. {
  985. WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *param_buf;
  986. wmi_twt_caps_params *twt_caps;
  987. param_buf = (WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *)event;
  988. if (!param_buf)
  989. return QDF_STATUS_E_INVAL;
  990. twt_caps = param_buf->twt_caps;
  991. if (!twt_caps)
  992. return QDF_STATUS_E_INVAL;
  993. var->twt_ack_support_cap = WMI_GET_BITS(twt_caps->twt_capability_bitmap,
  994. 0, 1);
  995. return QDF_STATUS_SUCCESS;
  996. }
  997. static enum WMI_HOST_TWT_CMD_FOR_ACK_EVENT
  998. wmi_get_converted_twt_command_for_ack_event(WMI_CMD_ID tgt_cmd)
  999. {
  1000. switch (tgt_cmd) {
  1001. case WMI_TWT_ADD_DIALOG_CMDID:
  1002. return WMI_HOST_TWT_ADD_DIALOG_CMDID;
  1003. case WMI_TWT_DEL_DIALOG_CMDID:
  1004. return WMI_HOST_TWT_DEL_DIALOG_CMDID;
  1005. case WMI_TWT_PAUSE_DIALOG_CMDID:
  1006. return WMI_HOST_TWT_PAUSE_DIALOG_CMDID;
  1007. case WMI_TWT_RESUME_DIALOG_CMDID:
  1008. return WMI_HOST_TWT_RESUME_DIALOG_CMDID;
  1009. case WMI_TWT_NUDGE_DIALOG_CMDID:
  1010. return WMI_HOST_TWT_NUDGE_DIALOG_CMDID;
  1011. default:
  1012. return WMI_HOST_TWT_UNKNOWN_CMDID;
  1013. }
  1014. }
  1015. static QDF_STATUS
  1016. extract_twt_ack_comp_event_tlv(wmi_unified_t wmi_handle,
  1017. uint8_t *evt_buf,
  1018. struct twt_ack_complete_event_param *var)
  1019. {
  1020. WMI_TWT_ACK_EVENTID_param_tlvs *param_buf;
  1021. wmi_twt_ack_event_fixed_param *ack_event;
  1022. param_buf = (WMI_TWT_ACK_EVENTID_param_tlvs *)evt_buf;
  1023. if (!param_buf) {
  1024. wmi_err("evt_buf is NULL");
  1025. return QDF_STATUS_E_INVAL;
  1026. }
  1027. ack_event = param_buf->fixed_param;
  1028. var->vdev_id = ack_event->vdev_id;
  1029. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ack_event->peer_macaddr,
  1030. var->peer_macaddr.bytes);
  1031. var->dialog_id = ack_event->dialog_id;
  1032. var->twt_cmd_ack = wmi_get_converted_twt_command_for_ack_event(
  1033. ack_event->twt_cmd);
  1034. switch (ack_event->twt_cmd) {
  1035. case WMI_TWT_ADD_DIALOG_CMDID:
  1036. var->status = wmi_get_converted_twt_add_dialog_status(
  1037. ack_event->status);
  1038. break;
  1039. case WMI_TWT_DEL_DIALOG_CMDID:
  1040. var->status = wmi_get_converted_twt_del_dialog_status(
  1041. ack_event->status);
  1042. break;
  1043. case WMI_TWT_PAUSE_DIALOG_CMDID:
  1044. var->status = wmi_twt_pause_status_to_host_twt_status(
  1045. ack_event->status);
  1046. break;
  1047. case WMI_TWT_RESUME_DIALOG_CMDID:
  1048. var->status = wmi_get_converted_twt_resume_dialog_status(
  1049. ack_event->status);
  1050. break;
  1051. case WMI_TWT_NUDGE_DIALOG_CMDID:
  1052. var->status = wmi_twt_nudge_status_to_host_twt_status(
  1053. ack_event->status);
  1054. break;
  1055. default:
  1056. break;
  1057. }
  1058. return QDF_STATUS_SUCCESS;
  1059. }
  1060. #elif WLAN_SUPPORT_TWT
  1061. static QDF_STATUS send_twt_enable_cmd_tlv(wmi_unified_t wmi_handle,
  1062. struct wmi_twt_enable_param *params)
  1063. {
  1064. wmi_twt_enable_cmd_fixed_param *cmd;
  1065. wmi_buf_t buf;
  1066. QDF_STATUS status;
  1067. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1068. if (!buf) {
  1069. wmi_err("Failed to allocate memory");
  1070. return QDF_STATUS_E_FAILURE;
  1071. }
  1072. cmd = (wmi_twt_enable_cmd_fixed_param *) wmi_buf_data(buf);
  1073. WMITLV_SET_HDR(&cmd->tlv_header,
  1074. WMITLV_TAG_STRUC_wmi_twt_enable_cmd_fixed_param,
  1075. WMITLV_GET_STRUCT_TLVLEN
  1076. (wmi_twt_enable_cmd_fixed_param));
  1077. cmd->pdev_id =
  1078. wmi_handle->ops->convert_pdev_id_host_to_target(
  1079. wmi_handle,
  1080. params->pdev_id);
  1081. cmd->sta_cong_timer_ms = params->sta_cong_timer_ms;
  1082. cmd->mbss_support = params->mbss_support;
  1083. cmd->default_slot_size = params->default_slot_size;
  1084. cmd->congestion_thresh_setup = params->congestion_thresh_setup;
  1085. cmd->congestion_thresh_teardown = params->congestion_thresh_teardown;
  1086. cmd->congestion_thresh_critical = params->congestion_thresh_critical;
  1087. cmd->interference_thresh_teardown =
  1088. params->interference_thresh_teardown;
  1089. cmd->interference_thresh_setup = params->interference_thresh_setup;
  1090. cmd->min_no_sta_setup = params->min_no_sta_setup;
  1091. cmd->min_no_sta_teardown = params->min_no_sta_teardown;
  1092. cmd->no_of_bcast_mcast_slots = params->no_of_bcast_mcast_slots;
  1093. cmd->min_no_twt_slots = params->min_no_twt_slots;
  1094. cmd->max_no_sta_twt = params->max_no_sta_twt;
  1095. cmd->mode_check_interval = params->mode_check_interval;
  1096. cmd->add_sta_slot_interval = params->add_sta_slot_interval;
  1097. cmd->remove_sta_slot_interval = params->remove_sta_slot_interval;
  1098. TWT_EN_DIS_FLAGS_SET_BTWT(cmd->flags, params->b_twt_enable);
  1099. TWT_EN_DIS_FLAGS_SET_L_MBSSID(cmd->flags,
  1100. params->b_twt_legacy_mbss_enable);
  1101. TWT_EN_DIS_FLAGS_SET_AX_MBSSID(cmd->flags,
  1102. params->b_twt_ax_mbss_enable);
  1103. if (params->ext_conf_present) {
  1104. TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
  1105. TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
  1106. TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
  1107. }
  1108. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1109. WMI_TWT_ENABLE_CMDID);
  1110. if (QDF_IS_STATUS_ERROR(status)) {
  1111. wmi_err("Failed to send WMI_TWT_ENABLE_CMDID");
  1112. wmi_buf_free(buf);
  1113. }
  1114. return status;
  1115. }
  1116. static QDF_STATUS send_twt_disable_cmd_tlv(wmi_unified_t wmi_handle,
  1117. struct wmi_twt_disable_param *params)
  1118. {
  1119. wmi_twt_disable_cmd_fixed_param *cmd;
  1120. wmi_buf_t buf;
  1121. QDF_STATUS status;
  1122. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1123. if (!buf) {
  1124. wmi_err("Failed to allocate memory");
  1125. return QDF_STATUS_E_FAILURE;
  1126. }
  1127. cmd = (wmi_twt_disable_cmd_fixed_param *) wmi_buf_data(buf);
  1128. WMITLV_SET_HDR(&cmd->tlv_header,
  1129. WMITLV_TAG_STRUC_wmi_twt_disable_cmd_fixed_param,
  1130. WMITLV_GET_STRUCT_TLVLEN
  1131. (wmi_twt_disable_cmd_fixed_param));
  1132. cmd->pdev_id =
  1133. wmi_handle->ops->convert_pdev_id_host_to_target(
  1134. wmi_handle,
  1135. params->pdev_id);
  1136. if (params->ext_conf_present) {
  1137. TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
  1138. TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
  1139. TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
  1140. }
  1141. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1142. WMI_TWT_DISABLE_CMDID);
  1143. if (QDF_IS_STATUS_ERROR(status)) {
  1144. wmi_err("Failed to send WMI_TWT_DISABLE_CMDID");
  1145. wmi_buf_free(buf);
  1146. }
  1147. return status;
  1148. }
  1149. #ifdef WLAN_SUPPORT_BCAST_TWT
  1150. static void
  1151. twt_add_dialog_set_bcast_twt_params(struct wmi_twt_add_dialog_param *params,
  1152. wmi_twt_add_dialog_cmd_fixed_param *cmd)
  1153. {
  1154. TWT_FLAGS_SET_BTWT_ID0(cmd->flags, params->flag_b_twt_id0);
  1155. cmd->b_twt_persistence = params->b_twt_persistence;
  1156. cmd->b_twt_recommendation = params->b_twt_recommendation;
  1157. }
  1158. #else
  1159. static void
  1160. twt_add_dialog_set_bcast_twt_params(struct wmi_twt_add_dialog_param *params,
  1161. wmi_twt_add_dialog_cmd_fixed_param *cmd)
  1162. {
  1163. }
  1164. #endif
  1165. static QDF_STATUS
  1166. send_twt_add_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  1167. struct wmi_twt_add_dialog_param *params)
  1168. {
  1169. wmi_twt_add_dialog_cmd_fixed_param *cmd;
  1170. wmi_buf_t buf;
  1171. QDF_STATUS status;
  1172. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1173. if (!buf) {
  1174. wmi_err("Failed to allocate memory");
  1175. return QDF_STATUS_E_FAILURE;
  1176. }
  1177. cmd = (wmi_twt_add_dialog_cmd_fixed_param *) wmi_buf_data(buf);
  1178. WMITLV_SET_HDR(&cmd->tlv_header,
  1179. WMITLV_TAG_STRUC_wmi_twt_add_dialog_cmd_fixed_param,
  1180. WMITLV_GET_STRUCT_TLVLEN
  1181. (wmi_twt_add_dialog_cmd_fixed_param));
  1182. cmd->vdev_id = params->vdev_id;
  1183. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
  1184. cmd->dialog_id = params->dialog_id;
  1185. cmd->wake_intvl_us = params->wake_intvl_us;
  1186. cmd->wake_intvl_mantis = params->wake_intvl_mantis;
  1187. cmd->wake_dura_us = params->wake_dura_us;
  1188. cmd->sp_offset_us = params->sp_offset_us;
  1189. cmd->min_wake_intvl_us = params->min_wake_intvl_us;
  1190. cmd->max_wake_intvl_us = params->max_wake_intvl_us;
  1191. cmd->min_wake_dura_us = params->min_wake_dura_us;
  1192. cmd->max_wake_dura_us = params->max_wake_dura_us;
  1193. cmd->sp_start_tsf_lo = (uint32_t)(params->wake_time_tsf & 0xFFFFFFFF);
  1194. cmd->sp_start_tsf_hi = (uint32_t)(params->wake_time_tsf >> 32);
  1195. cmd->announce_timeout_us = params->announce_timeout_us;
  1196. TWT_FLAGS_SET_CMD(cmd->flags, params->twt_cmd);
  1197. TWT_FLAGS_SET_BROADCAST(cmd->flags, params->flag_bcast);
  1198. TWT_FLAGS_SET_TRIGGER(cmd->flags, params->flag_trigger);
  1199. TWT_FLAGS_SET_FLOW_TYPE(cmd->flags, params->flag_flow_type);
  1200. TWT_FLAGS_SET_PROTECTION(cmd->flags, params->flag_protection);
  1201. twt_add_dialog_set_bcast_twt_params(params, cmd);
  1202. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1203. WMI_TWT_ADD_DIALOG_CMDID);
  1204. if (QDF_IS_STATUS_ERROR(status)) {
  1205. wmi_err("Failed to send WMI_TWT_ADD_DIALOG_CMDID");
  1206. wmi_buf_free(buf);
  1207. }
  1208. return status;
  1209. }
  1210. #ifdef WLAN_SUPPORT_BCAST_TWT
  1211. static void
  1212. twt_del_dialog_set_bcast_twt_params(struct wmi_twt_del_dialog_param *params,
  1213. wmi_twt_del_dialog_cmd_fixed_param *cmd)
  1214. {
  1215. cmd->b_twt_persistence = params->b_twt_persistence;
  1216. }
  1217. #else
  1218. static void
  1219. twt_del_dialog_set_bcast_twt_params(struct wmi_twt_del_dialog_param *params,
  1220. wmi_twt_del_dialog_cmd_fixed_param *cmd)
  1221. {
  1222. }
  1223. #endif
  1224. static QDF_STATUS
  1225. send_twt_del_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  1226. struct wmi_twt_del_dialog_param *params)
  1227. {
  1228. wmi_twt_del_dialog_cmd_fixed_param *cmd;
  1229. wmi_buf_t buf;
  1230. QDF_STATUS status;
  1231. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1232. if (!buf) {
  1233. wmi_err("Failed to allocate memory");
  1234. return QDF_STATUS_E_FAILURE;
  1235. }
  1236. cmd = (wmi_twt_del_dialog_cmd_fixed_param *) wmi_buf_data(buf);
  1237. WMITLV_SET_HDR(&cmd->tlv_header,
  1238. WMITLV_TAG_STRUC_wmi_twt_del_dialog_cmd_fixed_param,
  1239. WMITLV_GET_STRUCT_TLVLEN
  1240. (wmi_twt_del_dialog_cmd_fixed_param));
  1241. cmd->vdev_id = params->vdev_id;
  1242. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
  1243. cmd->dialog_id = params->dialog_id;
  1244. twt_del_dialog_set_bcast_twt_params(params, cmd);
  1245. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1246. WMI_TWT_DEL_DIALOG_CMDID);
  1247. if (QDF_IS_STATUS_ERROR(status)) {
  1248. wmi_err("Failed to send WMI_TWT_DEL_DIALOG_CMDID");
  1249. wmi_buf_free(buf);
  1250. }
  1251. return status;
  1252. }
  1253. static QDF_STATUS
  1254. send_twt_pause_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  1255. struct wmi_twt_pause_dialog_cmd_param *params)
  1256. {
  1257. wmi_twt_pause_dialog_cmd_fixed_param *cmd;
  1258. wmi_buf_t buf;
  1259. QDF_STATUS status;
  1260. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1261. if (!buf) {
  1262. wmi_err("Failed to allocate memory");
  1263. return QDF_STATUS_E_FAILURE;
  1264. }
  1265. cmd = (wmi_twt_pause_dialog_cmd_fixed_param *) wmi_buf_data(buf);
  1266. WMITLV_SET_HDR(&cmd->tlv_header,
  1267. WMITLV_TAG_STRUC_wmi_twt_pause_dialog_cmd_fixed_param,
  1268. WMITLV_GET_STRUCT_TLVLEN
  1269. (wmi_twt_pause_dialog_cmd_fixed_param));
  1270. cmd->vdev_id = params->vdev_id;
  1271. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
  1272. cmd->dialog_id = params->dialog_id;
  1273. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1274. WMI_TWT_PAUSE_DIALOG_CMDID);
  1275. if (QDF_IS_STATUS_ERROR(status)) {
  1276. wmi_err("Failed to send WMI_TWT_PAUSE_DIALOG_CMDID");
  1277. wmi_buf_free(buf);
  1278. }
  1279. return status;
  1280. }
  1281. static QDF_STATUS
  1282. send_twt_nudge_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  1283. struct wmi_twt_nudge_dialog_cmd_param *params)
  1284. {
  1285. wmi_twt_nudge_dialog_cmd_fixed_param *cmd;
  1286. wmi_buf_t buf;
  1287. QDF_STATUS status;
  1288. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1289. if (!buf)
  1290. return QDF_STATUS_E_FAILURE;
  1291. cmd = (wmi_twt_nudge_dialog_cmd_fixed_param *) wmi_buf_data(buf);
  1292. WMITLV_SET_HDR(&cmd->tlv_header,
  1293. WMITLV_TAG_STRUC_wmi_twt_nudge_dialog_cmd_fixed_param,
  1294. WMITLV_GET_STRUCT_TLVLEN
  1295. (wmi_twt_nudge_dialog_cmd_fixed_param));
  1296. cmd->vdev_id = params->vdev_id;
  1297. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
  1298. cmd->dialog_id = params->dialog_id;
  1299. cmd->suspend_duration_ms = params->suspend_duration / 1000;
  1300. cmd->next_twt_size = params->next_twt_size;
  1301. wmi_debug("vdev_id: %d dialog_id: %d duration(in ms): %u next_twt_size: %d "
  1302. "peer_macaddr: "QDF_MAC_ADDR_FMT, cmd->vdev_id,
  1303. cmd->dialog_id, cmd->suspend_duration_ms, cmd->next_twt_size,
  1304. QDF_MAC_ADDR_REF(params->peer_macaddr));
  1305. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1306. WMI_TWT_NUDGE_DIALOG_CMDID);
  1307. if (QDF_IS_STATUS_ERROR(status))
  1308. wmi_buf_free(buf);
  1309. return status;
  1310. }
  1311. static QDF_STATUS send_twt_resume_dialog_cmd_tlv(wmi_unified_t wmi_handle,
  1312. struct wmi_twt_resume_dialog_cmd_param *params)
  1313. {
  1314. wmi_twt_resume_dialog_cmd_fixed_param *cmd;
  1315. wmi_buf_t buf;
  1316. QDF_STATUS status;
  1317. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1318. if (!buf) {
  1319. wmi_err("Failed to allocate memory");
  1320. return QDF_STATUS_E_FAILURE;
  1321. }
  1322. cmd = (wmi_twt_resume_dialog_cmd_fixed_param *) wmi_buf_data(buf);
  1323. WMITLV_SET_HDR(&cmd->tlv_header,
  1324. WMITLV_TAG_STRUC_wmi_twt_resume_dialog_cmd_fixed_param,
  1325. WMITLV_GET_STRUCT_TLVLEN
  1326. (wmi_twt_resume_dialog_cmd_fixed_param));
  1327. cmd->vdev_id = params->vdev_id;
  1328. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
  1329. cmd->dialog_id = params->dialog_id;
  1330. cmd->sp_offset_us = params->sp_offset_us;
  1331. cmd->next_twt_size = params->next_twt_size;
  1332. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1333. WMI_TWT_RESUME_DIALOG_CMDID);
  1334. if (QDF_IS_STATUS_ERROR(status)) {
  1335. wmi_err("Failed to send WMI_TWT_RESUME_DIALOG_CMDID");
  1336. wmi_buf_free(buf);
  1337. }
  1338. return status;
  1339. }
  1340. #ifdef WLAN_SUPPORT_BCAST_TWT
  1341. static QDF_STATUS
  1342. send_twt_btwt_invite_sta_cmd_tlv(wmi_unified_t wmi_handle,
  1343. struct wmi_twt_btwt_invite_sta_cmd_param
  1344. *params)
  1345. {
  1346. wmi_twt_btwt_invite_sta_cmd_fixed_param *cmd;
  1347. wmi_buf_t buf;
  1348. QDF_STATUS status;
  1349. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1350. if (!buf) {
  1351. wmi_err("Failed to allocate memory");
  1352. return QDF_STATUS_E_FAILURE;
  1353. }
  1354. cmd = (wmi_twt_btwt_invite_sta_cmd_fixed_param *)wmi_buf_data(buf);
  1355. WMITLV_SET_HDR(&cmd->tlv_header,
  1356. WMITLV_TAG_STRUC_wmi_twt_btwt_invite_sta_cmd_fixed_param,
  1357. WMITLV_GET_STRUCT_TLVLEN
  1358. (wmi_twt_btwt_invite_sta_cmd_fixed_param));
  1359. cmd->vdev_id = params->vdev_id;
  1360. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
  1361. cmd->dialog_id = params->dialog_id;
  1362. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1363. WMI_TWT_BTWT_INVITE_STA_CMDID);
  1364. if (QDF_IS_STATUS_ERROR(status)) {
  1365. wmi_buf_free(buf);
  1366. }
  1367. return status;
  1368. }
  1369. static QDF_STATUS
  1370. send_twt_btwt_remove_sta_cmd_tlv(wmi_unified_t wmi_handle,
  1371. struct wmi_twt_btwt_remove_sta_cmd_param
  1372. *params)
  1373. {
  1374. wmi_twt_btwt_remove_sta_cmd_fixed_param *cmd;
  1375. wmi_buf_t buf;
  1376. QDF_STATUS status;
  1377. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1378. if (!buf) {
  1379. wmi_err("Failed to allocate memory");
  1380. return QDF_STATUS_E_FAILURE;
  1381. }
  1382. cmd = (wmi_twt_btwt_remove_sta_cmd_fixed_param *)wmi_buf_data(buf);
  1383. WMITLV_SET_HDR(&cmd->tlv_header,
  1384. WMITLV_TAG_STRUC_wmi_twt_btwt_remove_sta_cmd_fixed_param,
  1385. WMITLV_GET_STRUCT_TLVLEN
  1386. (wmi_twt_btwt_remove_sta_cmd_fixed_param));
  1387. cmd->vdev_id = params->vdev_id;
  1388. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
  1389. cmd->dialog_id = params->dialog_id;
  1390. status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1391. WMI_TWT_BTWT_REMOVE_STA_CMDID);
  1392. if (QDF_IS_STATUS_ERROR(status)) {
  1393. wmi_buf_free(buf);
  1394. }
  1395. return status;
  1396. }
  1397. #endif
  1398. static QDF_STATUS extract_twt_enable_comp_event_tlv(wmi_unified_t wmi_handle,
  1399. uint8_t *evt_buf,
  1400. struct wmi_twt_enable_complete_event_param *params)
  1401. {
  1402. WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
  1403. wmi_twt_enable_complete_event_fixed_param *ev;
  1404. param_buf = (WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1405. if (!param_buf) {
  1406. wmi_err("evt_buf is NULL");
  1407. return QDF_STATUS_E_INVAL;
  1408. }
  1409. ev = param_buf->fixed_param;
  1410. params->pdev_id =
  1411. wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
  1412. ev->pdev_id);
  1413. params->status = ev->status;
  1414. return QDF_STATUS_SUCCESS;
  1415. }
  1416. static QDF_STATUS extract_twt_disable_comp_event_tlv(wmi_unified_t wmi_handle,
  1417. uint8_t *evt_buf,
  1418. struct wmi_twt_disable_complete_event *params)
  1419. {
  1420. WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
  1421. wmi_twt_disable_complete_event_fixed_param *ev;
  1422. param_buf = (WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1423. if (!param_buf) {
  1424. wmi_err("evt_buf is NULL");
  1425. return QDF_STATUS_E_INVAL;
  1426. }
  1427. ev = param_buf->fixed_param;
  1428. #if 0
  1429. params->pdev_id =
  1430. wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
  1431. ev->pdev_id);
  1432. params->status = ev->status;
  1433. #endif
  1434. return QDF_STATUS_SUCCESS;
  1435. }
  1436. static enum WMI_HOST_ADD_TWT_STATUS
  1437. wmi_get_converted_twt_add_dialog_status(WMI_ADD_TWT_STATUS_T tgt_status)
  1438. {
  1439. switch (tgt_status) {
  1440. case WMI_ADD_TWT_STATUS_OK:
  1441. return WMI_HOST_ADD_TWT_STATUS_OK;
  1442. case WMI_ADD_TWT_STATUS_TWT_NOT_ENABLED:
  1443. return WMI_HOST_ADD_TWT_STATUS_TWT_NOT_ENABLED;
  1444. case WMI_ADD_TWT_STATUS_USED_DIALOG_ID:
  1445. return WMI_HOST_ADD_TWT_STATUS_USED_DIALOG_ID;
  1446. case WMI_ADD_TWT_STATUS_INVALID_PARAM:
  1447. return WMI_HOST_ADD_TWT_STATUS_INVALID_PARAM;
  1448. case WMI_ADD_TWT_STATUS_NOT_READY:
  1449. return WMI_HOST_ADD_TWT_STATUS_NOT_READY;
  1450. case WMI_ADD_TWT_STATUS_NO_RESOURCE:
  1451. return WMI_HOST_ADD_TWT_STATUS_NO_RESOURCE;
  1452. case WMI_ADD_TWT_STATUS_NO_ACK:
  1453. return WMI_HOST_ADD_TWT_STATUS_NO_ACK;
  1454. case WMI_ADD_TWT_STATUS_NO_RESPONSE:
  1455. return WMI_HOST_ADD_TWT_STATUS_NO_RESPONSE;
  1456. case WMI_ADD_TWT_STATUS_DENIED:
  1457. return WMI_HOST_ADD_TWT_STATUS_DENIED;
  1458. case WMI_ADD_TWT_STATUS_AP_PARAMS_NOT_IN_RANGE:
  1459. return WMI_HOST_ADD_TWT_STATUS_AP_PARAMS_NOT_IN_RANGE;
  1460. case WMI_ADD_TWT_STATUS_AP_IE_VALIDATION_FAILED:
  1461. return WMI_HOST_ADD_TWT_STATUS_AP_IE_VALIDATION_FAILED;
  1462. case WMI_ADD_TWT_STATUS_ROAM_IN_PROGRESS:
  1463. return WMI_HOST_ADD_TWT_STATUS_ROAM_IN_PROGRESS;
  1464. case WMI_ADD_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  1465. return WMI_HOST_ADD_TWT_STATUS_CHAN_SW_IN_PROGRESS;
  1466. case WMI_ADD_TWT_STATUS_SCAN_IN_PROGRESS:
  1467. return WMI_HOST_ADD_TWT_STATUS_SCAN_IN_PROGRESS;
  1468. default:
  1469. return WMI_HOST_ADD_TWT_STATUS_UNKNOWN_ERROR;
  1470. }
  1471. }
  1472. /**
  1473. * extract_twt_add_dialog_comp_event_tlv - Extacts twt add dialog complete wmi
  1474. * event from firmware
  1475. * @wmi_hande: WMI handle
  1476. * @evt_buf: Pointer to wmi event buf of twt add dialog complete event
  1477. * @params: Pointer to store the extracted parameters
  1478. *
  1479. * Return: QDF_STATUS_SUCCESS on success or QDF STATUS error values on failure
  1480. */
  1481. static QDF_STATUS extract_twt_add_dialog_comp_event_tlv(
  1482. wmi_unified_t wmi_handle,
  1483. uint8_t *evt_buf,
  1484. struct wmi_twt_add_dialog_complete_event_param *params)
  1485. {
  1486. WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  1487. wmi_twt_add_dialog_complete_event_fixed_param *ev;
  1488. param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1489. if (!param_buf) {
  1490. wmi_err("evt_buf is NULL");
  1491. return QDF_STATUS_E_INVAL;
  1492. }
  1493. ev = param_buf->fixed_param;
  1494. params->vdev_id = ev->vdev_id;
  1495. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
  1496. params->status = wmi_get_converted_twt_add_dialog_status(ev->status);
  1497. params->dialog_id = ev->dialog_id;
  1498. params->num_additional_twt_params = param_buf->num_twt_params;
  1499. return QDF_STATUS_SUCCESS;
  1500. }
  1501. /**
  1502. * extract_twt_add_dialog_comp_additional_parameters() - Extracts additional twt
  1503. * twt parameters, as part of add dialog completion event
  1504. * @wmi_hdl: wmi handle
  1505. * @evt_buf: Pointer event buffer
  1506. * @evt_buf_len: length of the add dialog event buffer
  1507. * @idx: index of num_twt_params
  1508. * @additional_params: twt additional parameters to extract
  1509. *
  1510. * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_INVAL for failure
  1511. */
  1512. static QDF_STATUS extract_twt_add_dialog_comp_additional_parameters
  1513. (
  1514. wmi_unified_t wmi_handle, uint8_t *evt_buf,
  1515. uint32_t evt_buf_len, uint32_t idx,
  1516. struct wmi_twt_add_dialog_additional_params *additional_params
  1517. )
  1518. {
  1519. WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  1520. wmi_twt_add_dialog_complete_event_fixed_param *ev;
  1521. uint32_t flags = 0;
  1522. uint32_t expected_len;
  1523. param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1524. if (!param_buf) {
  1525. wmi_err("evt_buf is NULL");
  1526. return QDF_STATUS_E_INVAL;
  1527. }
  1528. ev = param_buf->fixed_param;
  1529. if (idx >= param_buf->num_twt_params) {
  1530. wmi_err("Invalid idx %d while num_twt_params = %d",
  1531. idx, param_buf->num_twt_params);
  1532. return QDF_STATUS_E_INVAL;
  1533. }
  1534. if (!param_buf->twt_params) {
  1535. wmi_err("Unable to extract additional twt parameters");
  1536. return QDF_STATUS_E_INVAL;
  1537. }
  1538. expected_len = (sizeof(wmi_twt_add_dialog_complete_event_fixed_param) +
  1539. WMI_TLV_HDR_SIZE + (param_buf->num_twt_params *
  1540. sizeof(wmi_twt_add_dialog_additional_params)));
  1541. if (evt_buf_len != expected_len) {
  1542. wmi_err("Got invalid len data from FW %d expected %d",
  1543. evt_buf_len, expected_len);
  1544. return QDF_STATUS_E_INVAL;
  1545. }
  1546. flags = param_buf->twt_params[idx].flags;
  1547. additional_params->twt_cmd = TWT_FLAGS_GET_CMD(flags);
  1548. additional_params->bcast = TWT_FLAGS_GET_BROADCAST(flags);
  1549. additional_params->trig_en = TWT_FLAGS_GET_TRIGGER(flags);
  1550. additional_params->announce = TWT_FLAGS_GET_FLOW_TYPE(flags);
  1551. additional_params->protection = TWT_FLAGS_GET_PROTECTION(flags);
  1552. additional_params->b_twt_id0 = TWT_FLAGS_GET_BTWT_ID0(flags);
  1553. additional_params->info_frame_disabled =
  1554. TWT_FLAGS_GET_TWT_INFO_FRAME_DISABLED(flags);
  1555. additional_params->wake_dur_us = param_buf->twt_params[idx].wake_dur_us;
  1556. additional_params->wake_intvl_us =
  1557. param_buf->twt_params[idx].wake_intvl_us;
  1558. additional_params->sp_offset_us =
  1559. param_buf->twt_params[idx].sp_offset_us;
  1560. additional_params->sp_tsf_us_lo =
  1561. param_buf->twt_params[idx].sp_tsf_us_lo;
  1562. additional_params->sp_tsf_us_hi =
  1563. param_buf->twt_params[idx].sp_tsf_us_hi;
  1564. additional_params->pm_responder_bit_valid =
  1565. TWT_FLAGS_GET_PM_RESPONDER_MODE_VALID(flags);
  1566. additional_params->pm_responder_bit =
  1567. TWT_FLAGS_GET_PM_RESPONDER_MODE(flags);
  1568. return QDF_STATUS_SUCCESS;
  1569. }
  1570. static enum WMI_HOST_DEL_TWT_STATUS
  1571. wmi_get_converted_twt_del_dialog_status(WMI_DEL_TWT_STATUS_T tgt_status)
  1572. {
  1573. switch (tgt_status) {
  1574. case WMI_DEL_TWT_STATUS_OK:
  1575. return WMI_HOST_DEL_TWT_STATUS_OK;
  1576. case WMI_DEL_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  1577. return WMI_HOST_DEL_TWT_STATUS_DIALOG_ID_NOT_EXIST;
  1578. case WMI_DEL_TWT_STATUS_INVALID_PARAM:
  1579. return WMI_HOST_DEL_TWT_STATUS_INVALID_PARAM;
  1580. case WMI_DEL_TWT_STATUS_DIALOG_ID_BUSY:
  1581. return WMI_HOST_DEL_TWT_STATUS_DIALOG_ID_BUSY;
  1582. case WMI_DEL_TWT_STATUS_NO_RESOURCE:
  1583. return WMI_HOST_DEL_TWT_STATUS_NO_RESOURCE;
  1584. case WMI_DEL_TWT_STATUS_NO_ACK:
  1585. return WMI_HOST_DEL_TWT_STATUS_NO_ACK;
  1586. case WMI_DEL_TWT_STATUS_UNKNOWN_ERROR:
  1587. return WMI_HOST_DEL_TWT_STATUS_UNKNOWN_ERROR;
  1588. case WMI_DEL_TWT_STATUS_PEER_INIT_TEARDOWN:
  1589. return WMI_HOST_DEL_TWT_STATUS_PEER_INIT_TEARDOWN;
  1590. case WMI_DEL_TWT_STATUS_ROAMING:
  1591. return WMI_HOST_DEL_TWT_STATUS_ROAMING;
  1592. case WMI_DEL_TWT_STATUS_CONCURRENCY:
  1593. return WMI_HOST_DEL_TWT_STATUS_CONCURRENCY;
  1594. case WMI_DEL_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  1595. return WMI_HOST_DEL_TWT_STATUS_CHAN_SW_IN_PROGRESS;
  1596. case WMI_DEL_TWT_STATUS_SCAN_IN_PROGRESS:
  1597. return WMI_HOST_DEL_TWT_STATUS_SCAN_IN_PROGRESS;
  1598. default:
  1599. return WMI_HOST_DEL_TWT_STATUS_UNKNOWN_ERROR;
  1600. }
  1601. return WMI_HOST_DEL_TWT_STATUS_UNKNOWN_ERROR;
  1602. }
  1603. static QDF_STATUS extract_twt_del_dialog_comp_event_tlv(
  1604. wmi_unified_t wmi_handle,
  1605. uint8_t *evt_buf,
  1606. struct wmi_twt_del_dialog_complete_event_param *params)
  1607. {
  1608. WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  1609. wmi_twt_del_dialog_complete_event_fixed_param *ev;
  1610. param_buf = (WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1611. if (!param_buf) {
  1612. wmi_err("evt_buf is NULL");
  1613. return QDF_STATUS_E_INVAL;
  1614. }
  1615. ev = param_buf->fixed_param;
  1616. params->vdev_id = ev->vdev_id;
  1617. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
  1618. params->dialog_id = ev->dialog_id;
  1619. params->status = wmi_get_converted_twt_del_dialog_status(ev->status);
  1620. return QDF_STATUS_SUCCESS;
  1621. }
  1622. static enum WMI_HOST_PAUSE_TWT_STATUS
  1623. wmi_twt_pause_status_to_host_twt_status(WMI_PAUSE_TWT_STATUS_T status)
  1624. {
  1625. switch (status) {
  1626. case WMI_PAUSE_TWT_STATUS_OK:
  1627. return WMI_HOST_PAUSE_TWT_STATUS_OK;
  1628. case WMI_PAUSE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  1629. return WMI_HOST_PAUSE_TWT_STATUS_DIALOG_ID_NOT_EXIST;
  1630. case WMI_PAUSE_TWT_STATUS_INVALID_PARAM:
  1631. return WMI_HOST_PAUSE_TWT_STATUS_INVALID_PARAM;
  1632. case WMI_PAUSE_TWT_STATUS_DIALOG_ID_BUSY:
  1633. return WMI_HOST_PAUSE_TWT_STATUS_DIALOG_ID_BUSY;
  1634. case WMI_PAUSE_TWT_STATUS_NO_RESOURCE:
  1635. return WMI_HOST_PAUSE_TWT_STATUS_NO_RESOURCE;
  1636. case WMI_PAUSE_TWT_STATUS_NO_ACK:
  1637. return WMI_HOST_PAUSE_TWT_STATUS_NO_ACK;
  1638. case WMI_PAUSE_TWT_STATUS_UNKNOWN_ERROR:
  1639. return WMI_HOST_PAUSE_TWT_STATUS_UNKNOWN_ERROR;
  1640. case WMI_PAUSE_TWT_STATUS_ALREADY_PAUSED:
  1641. return WMI_HOST_PAUSE_TWT_STATUS_ALREADY_PAUSED;
  1642. case WMI_PAUSE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  1643. return WMI_HOST_PAUSE_TWT_STATUS_CHAN_SW_IN_PROGRESS;
  1644. case WMI_PAUSE_TWT_STATUS_ROAM_IN_PROGRESS:
  1645. return WMI_HOST_PAUSE_TWT_STATUS_ROAM_IN_PROGRESS;
  1646. case WMI_PAUSE_TWT_STATUS_SCAN_IN_PROGRESS:
  1647. return WMI_HOST_PAUSE_TWT_STATUS_SCAN_IN_PROGRESS;
  1648. default:
  1649. return WMI_HOST_PAUSE_TWT_STATUS_UNKNOWN_ERROR;
  1650. }
  1651. }
  1652. static QDF_STATUS extract_twt_pause_dialog_comp_event_tlv(
  1653. wmi_unified_t wmi_handle,
  1654. uint8_t *evt_buf,
  1655. struct wmi_twt_pause_dialog_complete_event_param *params)
  1656. {
  1657. WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  1658. wmi_twt_pause_dialog_complete_event_fixed_param *ev;
  1659. param_buf = (WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1660. if (!param_buf) {
  1661. wmi_err("evt_buf is NULL");
  1662. return QDF_STATUS_E_INVAL;
  1663. }
  1664. ev = param_buf->fixed_param;
  1665. params->vdev_id = ev->vdev_id;
  1666. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
  1667. params->status = wmi_twt_pause_status_to_host_twt_status(ev->status);
  1668. params->dialog_id = ev->dialog_id;
  1669. return QDF_STATUS_SUCCESS;
  1670. }
  1671. static enum WMI_HOST_NUDGE_TWT_STATUS
  1672. wmi_twt_nudge_status_to_host_twt_status(WMI_TWT_NUDGE_STATUS_T status)
  1673. {
  1674. switch (status) {
  1675. case WMI_NUDGE_TWT_STATUS_OK:
  1676. return WMI_HOST_NUDGE_TWT_STATUS_OK;
  1677. case WMI_NUDGE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  1678. return WMI_HOST_NUDGE_TWT_STATUS_DIALOG_ID_NOT_EXIST;
  1679. case WMI_NUDGE_TWT_STATUS_INVALID_PARAM:
  1680. return WMI_HOST_NUDGE_TWT_STATUS_INVALID_PARAM;
  1681. case WMI_NUDGE_TWT_STATUS_DIALOG_ID_BUSY:
  1682. return WMI_HOST_NUDGE_TWT_STATUS_DIALOG_ID_BUSY;
  1683. case WMI_NUDGE_TWT_STATUS_NO_RESOURCE:
  1684. return WMI_HOST_NUDGE_TWT_STATUS_NO_RESOURCE;
  1685. case WMI_NUDGE_TWT_STATUS_NO_ACK:
  1686. return WMI_HOST_NUDGE_TWT_STATUS_NO_ACK;
  1687. case WMI_NUDGE_TWT_STATUS_UNKNOWN_ERROR:
  1688. return WMI_HOST_NUDGE_TWT_STATUS_UNKNOWN_ERROR;
  1689. case WMI_NUDGE_TWT_STATUS_ALREADY_PAUSED:
  1690. return WMI_HOST_NUDGE_TWT_STATUS_ALREADY_PAUSED;
  1691. case WMI_NUDGE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  1692. return WMI_HOST_NUDGE_TWT_STATUS_CHAN_SW_IN_PROGRESS;
  1693. case WMI_NUDGE_TWT_STATUS_ROAM_IN_PROGRESS:
  1694. return WMI_HOST_NUDGE_TWT_STATUS_ROAM_IN_PROGRESS;
  1695. case WMI_NUDGE_TWT_STATUS_SCAN_IN_PROGRESS:
  1696. return WMI_HOST_NUDGE_TWT_STATUS_SCAN_IN_PROGRESS;
  1697. default:
  1698. return WMI_HOST_NUDGE_TWT_STATUS_UNKNOWN_ERROR;
  1699. }
  1700. }
  1701. static QDF_STATUS extract_twt_nudge_dialog_comp_event_tlv(
  1702. wmi_unified_t wmi_handle,
  1703. uint8_t *evt_buf,
  1704. struct wmi_twt_nudge_dialog_complete_event_param *params)
  1705. {
  1706. WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  1707. wmi_twt_nudge_dialog_complete_event_fixed_param *ev;
  1708. param_buf = (WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1709. if (!param_buf) {
  1710. wmi_err("evt_buf is NULL");
  1711. return QDF_STATUS_E_INVAL;
  1712. }
  1713. ev = param_buf->fixed_param;
  1714. params->vdev_id = ev->vdev_id;
  1715. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
  1716. params->status = wmi_twt_nudge_status_to_host_twt_status(ev->status);
  1717. params->dialog_id = ev->dialog_id;
  1718. params->next_twt_tsf_us_lo = ev->sp_tsf_us_lo;
  1719. params->next_twt_tsf_us_hi = ev->sp_tsf_us_hi;
  1720. wmi_debug("vdev_id: %d dialog_id: %d tsf hi : %x tsf lo: %x",
  1721. params->vdev_id, params->dialog_id,
  1722. params->next_twt_tsf_us_hi, params->next_twt_tsf_us_lo);
  1723. return QDF_STATUS_SUCCESS;
  1724. }
  1725. static enum WMI_HOST_RESUME_TWT_STATUS
  1726. wmi_get_converted_twt_resume_dialog_status(WMI_RESUME_TWT_STATUS_T tgt_status)
  1727. {
  1728. switch (tgt_status) {
  1729. case WMI_RESUME_TWT_STATUS_OK:
  1730. return WMI_HOST_RESUME_TWT_STATUS_OK;
  1731. case WMI_RESUME_TWT_STATUS_DIALOG_ID_NOT_EXIST:
  1732. return WMI_HOST_RESUME_TWT_STATUS_DIALOG_ID_NOT_EXIST;
  1733. case WMI_RESUME_TWT_STATUS_INVALID_PARAM:
  1734. return WMI_HOST_RESUME_TWT_STATUS_INVALID_PARAM;
  1735. case WMI_RESUME_TWT_STATUS_DIALOG_ID_BUSY:
  1736. return WMI_HOST_RESUME_TWT_STATUS_DIALOG_ID_BUSY;
  1737. case WMI_RESUME_TWT_STATUS_NOT_PAUSED:
  1738. return WMI_HOST_RESUME_TWT_STATUS_NOT_PAUSED;
  1739. case WMI_RESUME_TWT_STATUS_NO_RESOURCE:
  1740. return WMI_HOST_RESUME_TWT_STATUS_NO_RESOURCE;
  1741. case WMI_RESUME_TWT_STATUS_NO_ACK:
  1742. return WMI_HOST_RESUME_TWT_STATUS_NO_ACK;
  1743. case WMI_RESUME_TWT_STATUS_CHAN_SW_IN_PROGRESS:
  1744. return WMI_HOST_RESUME_TWT_STATUS_CHAN_SW_IN_PROGRESS;
  1745. case WMI_RESUME_TWT_STATUS_ROAM_IN_PROGRESS:
  1746. return WMI_HOST_RESUME_TWT_STATUS_ROAM_IN_PROGRESS;
  1747. case WMI_RESUME_TWT_STATUS_SCAN_IN_PROGRESS:
  1748. return WMI_HOST_RESUME_TWT_STATUS_SCAN_IN_PROGRESS;
  1749. default:
  1750. return WMI_HOST_RESUME_TWT_STATUS_UNKNOWN_ERROR;
  1751. }
  1752. }
  1753. static QDF_STATUS extract_twt_resume_dialog_comp_event_tlv(
  1754. wmi_unified_t wmi_handle,
  1755. uint8_t *evt_buf,
  1756. struct wmi_twt_resume_dialog_complete_event_param *params)
  1757. {
  1758. WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
  1759. wmi_twt_resume_dialog_complete_event_fixed_param *ev;
  1760. param_buf =
  1761. (WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1762. if (!param_buf) {
  1763. wmi_err("evt_buf is NULL");
  1764. return QDF_STATUS_E_INVAL;
  1765. }
  1766. ev = param_buf->fixed_param;
  1767. params->vdev_id = ev->vdev_id;
  1768. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
  1769. params->status = wmi_get_converted_twt_resume_dialog_status(ev->status);
  1770. params->dialog_id = ev->dialog_id;
  1771. return QDF_STATUS_SUCCESS;
  1772. }
  1773. static QDF_STATUS extract_twt_notify_event_tlv(
  1774. wmi_unified_t wmi_handle,
  1775. uint8_t *evt_buf,
  1776. struct wmi_twt_notify_event_param *params)
  1777. {
  1778. WMI_TWT_NOTIFY_EVENTID_param_tlvs *param_buf;
  1779. wmi_twt_notify_event_fixed_param *ev;
  1780. param_buf =
  1781. (WMI_TWT_NOTIFY_EVENTID_param_tlvs *)evt_buf;
  1782. if (!param_buf) {
  1783. wmi_err("evt_buf is NULL");
  1784. return QDF_STATUS_E_INVAL;
  1785. }
  1786. ev = param_buf->fixed_param;
  1787. params->vdev_id = ev->vdev_id;
  1788. return QDF_STATUS_SUCCESS;
  1789. }
  1790. #ifdef WLAN_SUPPORT_BCAST_TWT
  1791. static QDF_STATUS
  1792. extract_twt_btwt_invite_sta_comp_event_tlv(
  1793. wmi_unified_t wmi_handle,
  1794. uint8_t *evt_buf,
  1795. struct
  1796. wmi_twt_btwt_invite_sta_complete_event_param
  1797. *params)
  1798. {
  1799. WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
  1800. wmi_twt_btwt_invite_sta_complete_event_fixed_param *ev;
  1801. param_buf =
  1802. (WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1803. if (!param_buf) {
  1804. wmi_err("evt_buf is NULL");
  1805. return QDF_STATUS_E_INVAL;
  1806. }
  1807. ev = param_buf->fixed_param;
  1808. params->vdev_id = ev->vdev_id;
  1809. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
  1810. params->status = ev->status;
  1811. params->dialog_id = ev->dialog_id;
  1812. return QDF_STATUS_SUCCESS;
  1813. }
  1814. static QDF_STATUS
  1815. extract_twt_btwt_remove_sta_comp_event_tlv(
  1816. wmi_unified_t wmi_handle,
  1817. uint8_t *evt_buf,
  1818. struct
  1819. wmi_twt_btwt_remove_sta_complete_event_param
  1820. *params)
  1821. {
  1822. WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
  1823. wmi_twt_btwt_remove_sta_complete_event_fixed_param *ev;
  1824. param_buf =
  1825. (WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
  1826. if (!param_buf) {
  1827. wmi_err("evt_buf is NULL");
  1828. return QDF_STATUS_E_INVAL;
  1829. }
  1830. ev = param_buf->fixed_param;
  1831. params->vdev_id = ev->vdev_id;
  1832. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
  1833. params->status = ev->status;
  1834. params->dialog_id = ev->dialog_id;
  1835. return QDF_STATUS_SUCCESS;
  1836. }
  1837. #endif
  1838. #ifdef WLAN_SUPPORT_BCAST_TWT
  1839. static void
  1840. wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
  1841. {
  1842. ops->send_twt_btwt_invite_sta_cmd = send_twt_btwt_invite_sta_cmd_tlv;
  1843. ops->send_twt_btwt_remove_sta_cmd = send_twt_btwt_remove_sta_cmd_tlv;
  1844. ops->extract_twt_btwt_invite_sta_comp_event =
  1845. extract_twt_btwt_invite_sta_comp_event_tlv;
  1846. ops->extract_twt_btwt_remove_sta_comp_event =
  1847. extract_twt_btwt_remove_sta_comp_event_tlv;
  1848. }
  1849. #else
  1850. static void
  1851. wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
  1852. {
  1853. }
  1854. #endif
  1855. static QDF_STATUS
  1856. extract_twt_session_stats_event_tlv(wmi_unified_t wmi_handle,
  1857. uint8_t *evt_buf,
  1858. struct wmi_twt_session_stats_event_param
  1859. *params)
  1860. {
  1861. WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
  1862. wmi_pdev_twt_session_stats_event_fixed_param *ev;
  1863. param_buf =
  1864. (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
  1865. if (!param_buf) {
  1866. wmi_err("evt_buf is NULL");
  1867. return QDF_STATUS_E_INVAL;
  1868. }
  1869. ev = param_buf->fixed_param;
  1870. params->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
  1871. wmi_handle,
  1872. ev->pdev_id);
  1873. params->num_sessions = param_buf->num_twt_sessions;
  1874. wmi_debug("pdev_id=%d, num of TWT sessions=%d",
  1875. params->pdev_id, params->num_sessions);
  1876. return QDF_STATUS_SUCCESS;
  1877. }
  1878. static QDF_STATUS
  1879. extract_twt_session_stats_event_data(wmi_unified_t wmi_handle,
  1880. uint8_t *evt_buf,
  1881. struct wmi_twt_session_stats_event_param
  1882. *params,
  1883. struct wmi_host_twt_session_stats_info
  1884. *session,
  1885. uint32_t idx)
  1886. {
  1887. WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
  1888. wmi_twt_session_stats_info *twt_session;
  1889. uint32_t flags;
  1890. wmi_mac_addr *m1;
  1891. uint8_t *m2;
  1892. param_buf =
  1893. (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
  1894. if (!param_buf) {
  1895. wmi_err("evt_buf is NULL");
  1896. return QDF_STATUS_E_INVAL;
  1897. }
  1898. if (idx >= param_buf->num_twt_sessions) {
  1899. wmi_err("wrong idx, idx=%d, num_sessions=%d",
  1900. idx, param_buf->num_twt_sessions);
  1901. return QDF_STATUS_E_INVAL;
  1902. }
  1903. twt_session = &param_buf->twt_sessions[idx];
  1904. session->vdev_id = twt_session->vdev_id;
  1905. m1 = &twt_session->peer_mac;
  1906. m2 = session->peer_mac;
  1907. WMI_MAC_ADDR_TO_CHAR_ARRAY(m1, m2);
  1908. session->event_type = twt_session->event_type;
  1909. flags = twt_session->flow_id_flags;
  1910. session->flow_id = WMI_TWT_SESSION_FLAG_FLOW_ID_GET(flags);
  1911. session->bcast = WMI_TWT_SESSION_FLAG_BCAST_TWT_GET(flags);
  1912. session->trig = WMI_TWT_SESSION_FLAG_TRIGGER_TWT_GET(flags);
  1913. session->announ = WMI_TWT_SESSION_FLAG_ANNOUN_TWT_GET(flags);
  1914. session->protection = WMI_TWT_SESSION_FLAG_TWT_PROTECTION_GET(flags);
  1915. session->info_frame_disabled =
  1916. WMI_TWT_SESSION_FLAG_TWT_INFO_FRAME_DISABLED_GET(flags);
  1917. session->pm_responder_bit =
  1918. WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_GET(flags);
  1919. session->pm_responder_bit_valid =
  1920. WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_VALID_GET(flags);
  1921. session->dialog_id = twt_session->dialog_id;
  1922. session->wake_dura_us = twt_session->wake_dura_us;
  1923. session->wake_intvl_us = twt_session->wake_intvl_us;
  1924. session->sp_offset_us = twt_session->sp_offset_us;
  1925. session->sp_tsf_us_lo = twt_session->sp_tsf_us_lo;
  1926. session->sp_tsf_us_hi = twt_session->sp_tsf_us_hi;
  1927. wmi_debug("type=%d id=%d bcast=%d trig=%d announ=%d diagid=%d wake_dur=%ul wake_int=%ul offset=%ul",
  1928. session->event_type, session->flow_id,
  1929. session->bcast, session->trig,
  1930. session->announ, session->dialog_id, session->wake_dura_us,
  1931. session->wake_intvl_us, session->sp_offset_us);
  1932. wmi_debug("resp_pm_valid=%d resp_pm=%d",
  1933. session->pm_responder_bit_valid, session->pm_responder_bit);
  1934. return QDF_STATUS_SUCCESS;
  1935. }
  1936. static QDF_STATUS extract_twt_cap_service_ready_ext2_tlv(
  1937. wmi_unified_t wmi_handle, uint8_t *event,
  1938. struct wmi_twt_cap_bitmap_params *var)
  1939. {
  1940. WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *param_buf;
  1941. wmi_twt_caps_params *twt_caps;
  1942. param_buf = (WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *)event;
  1943. if (!param_buf)
  1944. return QDF_STATUS_E_INVAL;
  1945. twt_caps = param_buf->twt_caps;
  1946. if (!twt_caps)
  1947. return QDF_STATUS_E_INVAL;
  1948. var->twt_ack_support_cap = WMI_GET_BITS(twt_caps->twt_capability_bitmap,
  1949. 0, 1);
  1950. return QDF_STATUS_SUCCESS;
  1951. }
  1952. static enum WMI_HOST_TWT_CMD_FOR_ACK_EVENT
  1953. wmi_get_converted_twt_command_for_ack_event(WMI_CMD_ID tgt_cmd)
  1954. {
  1955. switch (tgt_cmd) {
  1956. case WMI_TWT_ADD_DIALOG_CMDID:
  1957. return WMI_HOST_TWT_ADD_DIALOG_CMDID;
  1958. case WMI_TWT_DEL_DIALOG_CMDID:
  1959. return WMI_HOST_TWT_DEL_DIALOG_CMDID;
  1960. case WMI_TWT_PAUSE_DIALOG_CMDID:
  1961. return WMI_HOST_TWT_PAUSE_DIALOG_CMDID;
  1962. case WMI_TWT_RESUME_DIALOG_CMDID:
  1963. return WMI_HOST_TWT_RESUME_DIALOG_CMDID;
  1964. case WMI_TWT_NUDGE_DIALOG_CMDID:
  1965. return WMI_HOST_TWT_NUDGE_DIALOG_CMDID;
  1966. default:
  1967. return WMI_HOST_TWT_UNKNOWN_CMDID;
  1968. }
  1969. }
  1970. static QDF_STATUS
  1971. extract_twt_ack_comp_event_tlv(wmi_unified_t wmi_handle,
  1972. uint8_t *evt_buf,
  1973. struct wmi_twt_ack_complete_event_param *var)
  1974. {
  1975. WMI_TWT_ACK_EVENTID_param_tlvs *param_buf;
  1976. wmi_twt_ack_event_fixed_param *ack_event;
  1977. param_buf = (WMI_TWT_ACK_EVENTID_param_tlvs *)evt_buf;
  1978. if (!param_buf) {
  1979. wmi_err("evt_buf is NULL");
  1980. return QDF_STATUS_E_INVAL;
  1981. }
  1982. ack_event = param_buf->fixed_param;
  1983. var->vdev_id = ack_event->vdev_id;
  1984. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ack_event->peer_macaddr,
  1985. var->peer_macaddr.bytes);
  1986. var->dialog_id = ack_event->dialog_id;
  1987. var->twt_cmd_ack = wmi_get_converted_twt_command_for_ack_event(
  1988. ack_event->twt_cmd);
  1989. switch (ack_event->twt_cmd) {
  1990. case WMI_TWT_ADD_DIALOG_CMDID:
  1991. var->status = wmi_get_converted_twt_add_dialog_status(
  1992. ack_event->status);
  1993. break;
  1994. case WMI_TWT_DEL_DIALOG_CMDID:
  1995. var->status = wmi_get_converted_twt_del_dialog_status(
  1996. ack_event->status);
  1997. break;
  1998. case WMI_TWT_PAUSE_DIALOG_CMDID:
  1999. var->status = wmi_twt_pause_status_to_host_twt_status(
  2000. ack_event->status);
  2001. break;
  2002. case WMI_TWT_RESUME_DIALOG_CMDID:
  2003. var->status = wmi_get_converted_twt_resume_dialog_status(
  2004. ack_event->status);
  2005. break;
  2006. case WMI_TWT_NUDGE_DIALOG_CMDID:
  2007. var->status = wmi_twt_nudge_status_to_host_twt_status(
  2008. ack_event->status);
  2009. break;
  2010. default:
  2011. break;
  2012. }
  2013. return QDF_STATUS_SUCCESS;
  2014. }
  2015. #endif
  2016. void wmi_twt_attach_tlv(wmi_unified_t wmi_handle)
  2017. {
  2018. struct wmi_ops *ops = wmi_handle->ops;
  2019. ops->send_twt_enable_cmd = send_twt_enable_cmd_tlv;
  2020. ops->send_twt_disable_cmd = send_twt_disable_cmd_tlv;
  2021. ops->send_twt_add_dialog_cmd = send_twt_add_dialog_cmd_tlv;
  2022. ops->send_twt_del_dialog_cmd = send_twt_del_dialog_cmd_tlv;
  2023. ops->send_twt_pause_dialog_cmd = send_twt_pause_dialog_cmd_tlv;
  2024. ops->send_twt_nudge_dialog_cmd = send_twt_nudge_dialog_cmd_tlv;
  2025. ops->send_twt_resume_dialog_cmd = send_twt_resume_dialog_cmd_tlv;
  2026. ops->extract_twt_enable_comp_event = extract_twt_enable_comp_event_tlv;
  2027. ops->extract_twt_disable_comp_event =
  2028. extract_twt_disable_comp_event_tlv;
  2029. ops->extract_twt_add_dialog_comp_event =
  2030. extract_twt_add_dialog_comp_event_tlv;
  2031. ops->extract_twt_add_dialog_comp_additional_params =
  2032. extract_twt_add_dialog_comp_additional_parameters;
  2033. ops->extract_twt_del_dialog_comp_event =
  2034. extract_twt_del_dialog_comp_event_tlv;
  2035. ops->extract_twt_pause_dialog_comp_event =
  2036. extract_twt_pause_dialog_comp_event_tlv;
  2037. ops->extract_twt_nudge_dialog_comp_event =
  2038. extract_twt_nudge_dialog_comp_event_tlv;
  2039. ops->extract_twt_resume_dialog_comp_event =
  2040. extract_twt_resume_dialog_comp_event_tlv;
  2041. ops->extract_twt_session_stats_event =
  2042. extract_twt_session_stats_event_tlv;
  2043. ops->extract_twt_session_stats_data =
  2044. extract_twt_session_stats_event_data;
  2045. ops->extract_twt_notify_event =
  2046. extract_twt_notify_event_tlv;
  2047. ops->extract_twt_cap_service_ready_ext2 =
  2048. extract_twt_cap_service_ready_ext2_tlv,
  2049. ops->extract_twt_ack_comp_event = extract_twt_ack_comp_event_tlv;
  2050. wmi_twt_attach_bcast_twt_tlv(ops);
  2051. }