123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376 |
- /*
- * Copyright (c) 2018-2021 The Linux Foundation. All rights reserved.
- * Copyright (c) 2021-2023 Qualcomm Innovation Center, Inc. All rights reserved.
- *
- * Permission to use, copy, modify, and/or distribute this software for
- * any purpose with or without fee is hereby granted, provided that the
- * above copyright notice and this permission notice appear in all
- * copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
- * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
- * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
- * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
- * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
- * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
- * PERFORMANCE OF THIS SOFTWARE.
- */
- #include <osdep.h>
- #include "wmi.h"
- #include "wmi_unified_priv.h"
- #include "wmi_unified_twt_param.h"
- #include "wmi_unified_twt_api.h"
- #if defined(WLAN_SUPPORT_TWT) && defined(WLAN_TWT_CONV_SUPPORTED)
- static QDF_STATUS send_twt_enable_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_enable_param *params)
- {
- wmi_twt_enable_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_enable_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_enable_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_enable_cmd_fixed_param));
- cmd->pdev_id =
- wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- params->pdev_id);
- cmd->sta_cong_timer_ms = params->sta_cong_timer_ms;
- cmd->mbss_support = params->mbss_support;
- cmd->default_slot_size = params->default_slot_size;
- cmd->congestion_thresh_setup = params->congestion_thresh_setup;
- cmd->congestion_thresh_teardown = params->congestion_thresh_teardown;
- cmd->congestion_thresh_critical = params->congestion_thresh_critical;
- cmd->interference_thresh_teardown =
- params->interference_thresh_teardown;
- cmd->interference_thresh_setup = params->interference_thresh_setup;
- cmd->min_no_sta_setup = params->min_no_sta_setup;
- cmd->min_no_sta_teardown = params->min_no_sta_teardown;
- cmd->no_of_bcast_mcast_slots = params->no_of_bcast_mcast_slots;
- cmd->min_no_twt_slots = params->min_no_twt_slots;
- cmd->max_no_sta_twt = params->max_no_sta_twt;
- cmd->mode_check_interval = params->mode_check_interval;
- cmd->add_sta_slot_interval = params->add_sta_slot_interval;
- cmd->remove_sta_slot_interval = params->remove_sta_slot_interval;
- TWT_EN_DIS_FLAGS_SET_BTWT(cmd->flags, params->b_twt_enable);
- TWT_EN_DIS_FLAGS_SET_B_R_TWT(cmd->flags, params->r_twt_enable);
- TWT_EN_DIS_FLAGS_SET_L_MBSSID(cmd->flags,
- params->b_twt_legacy_mbss_enable);
- TWT_EN_DIS_FLAGS_SET_AX_MBSSID(cmd->flags,
- params->b_twt_ax_mbss_enable);
- if (params->ext_conf_present) {
- TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
- TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
- TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
- }
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_ENABLE_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_ENABLE_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- static WMI_DISABLE_TWT_REASON_T
- wmi_convert_dis_reason_code(enum HOST_TWT_DISABLE_REASON reason)
- {
- switch (reason) {
- case HOST_TWT_DISABLE_REASON_NONE:
- return WMI_DISABLE_TWT_REASON_NONE;
- case HOST_TWT_DISABLE_REASON_CONCURRENCY_SCC:
- return WMI_DISABLE_TWT_REASON_CONCURRENCY_SCC;
- case HOST_TWT_DISABLE_REASON_CONCURRENCY_MCC:
- return WMI_DISABLE_TWT_REASON_CONCURRENCY_MCC;
- case HOST_TWT_DISABLE_REASON_CHANGE_CONGESTION_TIMEOUT:
- return WMI_DISABLE_TWT_REASON_CHANGE_CONGESTION_TIMEOUT;
- case HOST_TWT_DISABLE_REASON_P2P_GO_NOA:
- return WMI_DISABLE_TWT_REASON_P2P_GO_NOA;
- default:
- return WMI_DISABLE_TWT_REASON_NONE;
- }
- }
- static QDF_STATUS send_twt_disable_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_disable_param *params)
- {
- wmi_twt_disable_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_disable_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_disable_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_disable_cmd_fixed_param));
- cmd->pdev_id =
- wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- params->pdev_id);
- if (params->ext_conf_present) {
- TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
- TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
- TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
- }
- cmd->reason_code = wmi_convert_dis_reason_code(
- params->dis_reason_code);
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_DISABLE_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_DISABLE_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static void
- twt_add_dialog_set_bcast_twt_params(struct twt_add_dialog_param *params,
- wmi_twt_add_dialog_cmd_fixed_param *cmd)
- {
- TWT_FLAGS_SET_BTWT_ID0(cmd->flags, params->flag_b_twt_id0);
- cmd->b_twt_persistence = params->b_twt_persistence;
- cmd->b_twt_recommendation = params->b_twt_recommendation;
- }
- #else
- static void
- twt_add_dialog_set_bcast_twt_params(struct twt_add_dialog_param *params,
- wmi_twt_add_dialog_cmd_fixed_param *cmd)
- {
- }
- #endif
- static QDF_STATUS
- send_twt_add_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_add_dialog_param *params)
- {
- wmi_twt_add_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_add_dialog_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_add_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_add_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
- &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->wake_intvl_us = params->wake_intvl_us;
- cmd->wake_intvl_mantis = params->wake_intvl_mantis;
- cmd->wake_dura_us = params->wake_dura_us;
- cmd->sp_offset_us = params->sp_offset_us;
- cmd->min_wake_intvl_us = params->min_wake_intvl_us;
- cmd->max_wake_intvl_us = params->max_wake_intvl_us;
- cmd->min_wake_dura_us = params->min_wake_dura_us;
- cmd->max_wake_dura_us = params->max_wake_dura_us;
- cmd->sp_start_tsf_lo = (uint32_t)(params->wake_time_tsf & 0xFFFFFFFF);
- cmd->sp_start_tsf_hi = (uint32_t)(params->wake_time_tsf >> 32);
- cmd->announce_timeout_us = params->announce_timeout_us;
- cmd->link_id_bitmap = params->link_id_bitmap;
- cmd->r_twt_dl_tid_bitmap = params->r_twt_dl_tid_bitmap;
- cmd->r_twt_ul_tid_bitmap = params->r_twt_ul_tid_bitmap;
- TWT_FLAGS_SET_CMD(cmd->flags, params->twt_cmd);
- TWT_FLAGS_SET_BROADCAST(cmd->flags, params->flag_bcast);
- TWT_FLAGS_SET_TRIGGER(cmd->flags, params->flag_trigger);
- TWT_FLAGS_SET_FLOW_TYPE(cmd->flags, params->flag_flow_type);
- TWT_FLAGS_SET_PROTECTION(cmd->flags, params->flag_protection);
- twt_add_dialog_set_bcast_twt_params(params, cmd);
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_ADD_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_ADD_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static void
- twt_del_dialog_set_bcast_twt_params(struct twt_del_dialog_param *params,
- wmi_twt_del_dialog_cmd_fixed_param *cmd)
- {
- cmd->b_twt_persistence = params->b_twt_persistence;
- }
- #else
- static void
- twt_del_dialog_set_bcast_twt_params(struct twt_del_dialog_param *params,
- wmi_twt_del_dialog_cmd_fixed_param *cmd)
- {
- }
- #endif
- static QDF_STATUS
- send_twt_del_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_del_dialog_param *params)
- {
- wmi_twt_del_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_del_dialog_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_del_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_del_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
- &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- twt_del_dialog_set_bcast_twt_params(params, cmd);
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_DEL_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_DEL_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- static QDF_STATUS
- send_twt_pause_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_pause_dialog_cmd_param *params)
- {
- wmi_twt_pause_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_pause_dialog_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_pause_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_pause_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
- &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_PAUSE_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_PAUSE_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- static QDF_STATUS
- send_twt_nudge_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_nudge_dialog_cmd_param *params)
- {
- wmi_twt_nudge_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf)
- return QDF_STATUS_E_FAILURE;
- cmd = (wmi_twt_nudge_dialog_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_nudge_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_nudge_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
- &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->suspend_duration_ms = params->suspend_duration / 1000;
- cmd->next_twt_size = params->next_twt_size;
- cmd->sp_start_offset = params->sp_start_offset;
- wmi_debug("vdev_id: %d dialog_id: %d duration(in ms): %u next_twt_size: %d "
- "peer_macaddr: " QDF_MAC_ADDR_FMT " sp_start_offset: %d",
- cmd->vdev_id, cmd->dialog_id, cmd->suspend_duration_ms,
- cmd->next_twt_size,
- QDF_MAC_ADDR_REF(params->peer_macaddr.bytes),
- cmd->sp_start_offset);
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_NUDGE_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status))
- wmi_buf_free(buf);
- return status;
- }
- static QDF_STATUS send_twt_resume_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_resume_dialog_cmd_param *params)
- {
- wmi_twt_resume_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_resume_dialog_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_resume_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_resume_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
- &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->sp_offset_us = params->sp_offset_us;
- cmd->next_twt_size = params->next_twt_size;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_RESUME_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_RESUME_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static QDF_STATUS
- send_twt_btwt_invite_sta_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_btwt_invite_sta_cmd_param *params)
- {
- wmi_twt_btwt_invite_sta_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_btwt_invite_sta_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_btwt_invite_sta_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_btwt_invite_sta_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
- &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->r_twt_dl_tid_bitmap = params->r_twt_dl_tid_bitmap;
- cmd->r_twt_ul_tid_bitmap = params->r_twt_ul_tid_bitmap;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_BTWT_INVITE_STA_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_buf_free(buf);
- wmi_err("Failed to send WMI_TWT_BTWT_INVITE_STA_CMDID");
- }
- return status;
- }
- static QDF_STATUS
- send_twt_btwt_remove_sta_cmd_tlv(wmi_unified_t wmi_handle,
- struct twt_btwt_remove_sta_cmd_param
- *params)
- {
- wmi_twt_btwt_remove_sta_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_btwt_remove_sta_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_btwt_remove_sta_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_btwt_remove_sta_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr.bytes,
- &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->r_twt_dl_tid_bitmap = params->r_twt_dl_tid_bitmap;
- cmd->r_twt_ul_tid_bitmap = params->r_twt_ul_tid_bitmap;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_BTWT_REMOVE_STA_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_buf_free(buf);
- wmi_err("Failed to send WMI_TWT_BTWT_REMOVE_STA_CMDID");
- }
- return status;
- }
- #endif
- static enum HOST_TWT_ENABLE_STATUS
- wmi_twt_enable_status_to_host_twt_status(WMI_ENABLE_TWT_STATUS_T status)
- {
- switch (status) {
- case WMI_ENABLE_TWT_STATUS_OK:
- return HOST_TWT_ENABLE_STATUS_OK;
- case WMI_ENABLE_TWT_STATUS_ALREADY_ENABLED:
- return HOST_TWT_ENABLE_STATUS_ALREADY_ENABLED;
- case WMI_ENABLE_TWT_STATUS_NOT_READY:
- return HOST_TWT_ENABLE_STATUS_NOT_READY;
- case WMI_ENABLE_TWT_INVALID_PARAM:
- return HOST_TWT_ENABLE_INVALID_PARAM;
- default:
- return HOST_TWT_ENABLE_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_enable_comp_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_enable_complete_event_param *params)
- {
- WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_enable_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->pdev_id =
- wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
- ev->pdev_id);
- params->status = wmi_twt_enable_status_to_host_twt_status(ev->status);
- return QDF_STATUS_SUCCESS;
- }
- static enum HOST_TWT_DISABLE_STATUS
- wmi_twt_disable_status_to_host_twt_status(WMI_DISABLE_TWT_STATUS_T status)
- {
- switch (status) {
- case WMI_DISABLE_TWT_STATUS_OK:
- return HOST_TWT_DISABLE_STATUS_OK;
- case WMI_DISABLE_TWT_STATUS_ROAM_IN_PROGRESS:
- return HOST_TWT_DISABLE_STATUS_ROAM_IN_PROGRESS;
- case WMI_DISABLE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return HOST_TWT_DISABLE_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_DISABLE_TWT_STATUS_SCAN_IN_PROGRESS:
- return HOST_TWT_DISABLE_STATUS_SCAN_IN_PROGRESS;
- default:
- return HOST_TWT_DISABLE_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_disable_comp_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_disable_complete_event_param *params)
- {
- WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_disable_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->pdev_id =
- wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
- ev->pdev_id);
- params->status = wmi_twt_disable_status_to_host_twt_status(ev->status);
- return QDF_STATUS_SUCCESS;
- }
- static enum HOST_TWT_ADD_STATUS
- wmi_get_converted_twt_add_dialog_status(WMI_ADD_TWT_STATUS_T tgt_status)
- {
- switch (tgt_status) {
- case WMI_ADD_TWT_STATUS_OK:
- return HOST_TWT_ADD_STATUS_OK;
- case WMI_ADD_TWT_STATUS_TWT_NOT_ENABLED:
- return HOST_TWT_ADD_STATUS_TWT_NOT_ENABLED;
- case WMI_ADD_TWT_STATUS_USED_DIALOG_ID:
- return HOST_TWT_ADD_STATUS_USED_DIALOG_ID;
- case WMI_ADD_TWT_STATUS_INVALID_PARAM:
- return HOST_TWT_ADD_STATUS_INVALID_PARAM;
- case WMI_ADD_TWT_STATUS_NOT_READY:
- return HOST_TWT_ADD_STATUS_NOT_READY;
- case WMI_ADD_TWT_STATUS_NO_RESOURCE:
- return HOST_TWT_ADD_STATUS_NO_RESOURCE;
- case WMI_ADD_TWT_STATUS_NO_ACK:
- return HOST_TWT_ADD_STATUS_NO_ACK;
- case WMI_ADD_TWT_STATUS_NO_RESPONSE:
- return HOST_TWT_ADD_STATUS_NO_RESPONSE;
- case WMI_ADD_TWT_STATUS_DENIED:
- return HOST_TWT_ADD_STATUS_DENIED;
- case WMI_ADD_TWT_STATUS_AP_PARAMS_NOT_IN_RANGE:
- return HOST_TWT_ADD_STATUS_AP_PARAMS_NOT_IN_RANGE;
- case WMI_ADD_TWT_STATUS_AP_IE_VALIDATION_FAILED:
- return HOST_TWT_ADD_STATUS_AP_IE_VALIDATION_FAILED;
- case WMI_ADD_TWT_STATUS_ROAM_IN_PROGRESS:
- return HOST_TWT_ADD_STATUS_ROAM_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return HOST_TWT_ADD_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_SCAN_IN_PROGRESS:
- return HOST_TWT_ADD_STATUS_SCAN_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_LINK_SWITCH_IN_PROGRESS:
- return HOST_TWT_ADD_STATUS_LINK_SWITCH_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_UNSUPPORTED_MODE_MLMR:
- return HOST_TWT_ADD_STATUS_UNSUPPORTED_MODE_MLMR;
- default:
- return HOST_TWT_ADD_STATUS_UNKNOWN_ERROR;
- }
- }
- /**
- * extract_twt_add_dialog_comp_event_tlv - Extacts twt add dialog complete wmi
- * event from firmware
- * @wmi_handle: WMI handle
- * @evt_buf: Pointer to wmi event buf of twt add dialog complete event
- * @params: Pointer to store the extracted parameters
- *
- * Return: QDF_STATUS_SUCCESS on success or QDF STATUS error values on failure
- */
- static QDF_STATUS extract_twt_add_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_add_dialog_complete_event_param *params)
- {
- WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_add_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- params->peer_macaddr.bytes);
- params->status = wmi_get_converted_twt_add_dialog_status(ev->status);
- params->dialog_id = ev->dialog_id;
- params->num_additional_twt_params = param_buf->num_twt_params;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_twt_add_dialog_comp_additional_parameters() - Extracts additional twt
- * twt parameters, as part of add dialog completion event
- * @wmi_handle: wmi handle
- * @evt_buf: Pointer event buffer
- * @evt_buf_len: length of the add dialog event buffer
- * @idx: index of num_twt_params
- * @additional_params: twt additional parameters to extract
- *
- * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_INVAL for failure
- */
- static QDF_STATUS extract_twt_add_dialog_comp_additional_parameters
- (
- wmi_unified_t wmi_handle, uint8_t *evt_buf,
- uint32_t evt_buf_len, uint32_t idx,
- struct twt_add_dialog_additional_params *additional_params
- )
- {
- WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_add_dialog_complete_event_fixed_param *ev;
- uint32_t flags = 0;
- uint32_t expected_len;
- param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- if (idx >= param_buf->num_twt_params) {
- wmi_err("Invalid idx %d while num_twt_params = %d",
- idx, param_buf->num_twt_params);
- return QDF_STATUS_E_INVAL;
- }
- if (!param_buf->twt_params) {
- wmi_err("Unable to extract additional twt parameters");
- return QDF_STATUS_E_INVAL;
- }
- expected_len = (sizeof(wmi_twt_add_dialog_complete_event_fixed_param) +
- WMI_TLV_HDR_SIZE + (param_buf->num_twt_params *
- sizeof(wmi_twt_add_dialog_additional_params)));
- if (evt_buf_len != expected_len) {
- wmi_err("Got invalid len data from FW %d expected %d",
- evt_buf_len, expected_len);
- return QDF_STATUS_E_INVAL;
- }
- flags = param_buf->twt_params[idx].flags;
- additional_params->twt_cmd = TWT_FLAGS_GET_CMD(flags);
- additional_params->bcast = TWT_FLAGS_GET_BROADCAST(flags);
- additional_params->trig_en = TWT_FLAGS_GET_TRIGGER(flags);
- additional_params->announce = TWT_FLAGS_GET_FLOW_TYPE(flags);
- additional_params->protection = TWT_FLAGS_GET_PROTECTION(flags);
- additional_params->b_twt_id0 = TWT_FLAGS_GET_BTWT_ID0(flags);
- additional_params->info_frame_disabled =
- TWT_FLAGS_GET_TWT_INFO_FRAME_DISABLED(flags);
- additional_params->wake_dur_us = param_buf->twt_params[idx].wake_dur_us;
- additional_params->wake_intvl_us =
- param_buf->twt_params[idx].wake_intvl_us;
- additional_params->sp_offset_us =
- param_buf->twt_params[idx].sp_offset_us;
- additional_params->sp_tsf_us_lo =
- param_buf->twt_params[idx].sp_tsf_us_lo;
- additional_params->sp_tsf_us_hi =
- param_buf->twt_params[idx].sp_tsf_us_hi;
- additional_params->pm_responder_bit_valid =
- TWT_FLAGS_GET_PM_RESPONDER_MODE_VALID(flags);
- additional_params->pm_responder_bit =
- TWT_FLAGS_GET_PM_RESPONDER_MODE(flags);
- return QDF_STATUS_SUCCESS;
- }
- static enum HOST_TWT_DEL_STATUS
- wmi_get_converted_twt_del_dialog_status(WMI_DEL_TWT_STATUS_T tgt_status)
- {
- switch (tgt_status) {
- case WMI_DEL_TWT_STATUS_OK:
- return HOST_TWT_DEL_STATUS_OK;
- case WMI_DEL_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return HOST_TWT_DEL_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_DEL_TWT_STATUS_INVALID_PARAM:
- return HOST_TWT_DEL_STATUS_INVALID_PARAM;
- case WMI_DEL_TWT_STATUS_DIALOG_ID_BUSY:
- return HOST_TWT_DEL_STATUS_DIALOG_ID_BUSY;
- case WMI_DEL_TWT_STATUS_NO_RESOURCE:
- return HOST_TWT_DEL_STATUS_NO_RESOURCE;
- case WMI_DEL_TWT_STATUS_NO_ACK:
- return HOST_TWT_DEL_STATUS_NO_ACK;
- case WMI_DEL_TWT_STATUS_PEER_INIT_TEARDOWN:
- return HOST_TWT_DEL_STATUS_PEER_INIT_TEARDOWN;
- case WMI_DEL_TWT_STATUS_ROAMING:
- return HOST_TWT_DEL_STATUS_ROAMING;
- case WMI_DEL_TWT_STATUS_CONCURRENCY:
- return HOST_TWT_DEL_STATUS_CONCURRENCY;
- case WMI_DEL_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return HOST_TWT_DEL_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_DEL_TWT_STATUS_SCAN_IN_PROGRESS:
- return HOST_TWT_DEL_STATUS_SCAN_IN_PROGRESS;
- default:
- return HOST_TWT_DEL_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_del_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_del_dialog_complete_event_param *params)
- {
- WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_del_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- params->peer_macaddr.bytes);
- params->dialog_id = ev->dialog_id;
- params->status = wmi_get_converted_twt_del_dialog_status(ev->status);
- return QDF_STATUS_SUCCESS;
- }
- static enum HOST_TWT_PAUSE_STATUS
- wmi_twt_pause_status_to_host_twt_status(WMI_PAUSE_TWT_STATUS_T status)
- {
- switch (status) {
- case WMI_PAUSE_TWT_STATUS_OK:
- return HOST_TWT_PAUSE_STATUS_OK;
- case WMI_PAUSE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return HOST_TWT_PAUSE_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_PAUSE_TWT_STATUS_INVALID_PARAM:
- return HOST_TWT_PAUSE_STATUS_INVALID_PARAM;
- case WMI_PAUSE_TWT_STATUS_DIALOG_ID_BUSY:
- return HOST_TWT_PAUSE_STATUS_DIALOG_ID_BUSY;
- case WMI_PAUSE_TWT_STATUS_NO_RESOURCE:
- return HOST_TWT_PAUSE_STATUS_NO_RESOURCE;
- case WMI_PAUSE_TWT_STATUS_NO_ACK:
- return HOST_TWT_PAUSE_STATUS_NO_ACK;
- case WMI_PAUSE_TWT_STATUS_ALREADY_PAUSED:
- return HOST_TWT_PAUSE_STATUS_ALREADY_PAUSED;
- case WMI_PAUSE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return HOST_TWT_PAUSE_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_PAUSE_TWT_STATUS_ROAM_IN_PROGRESS:
- return HOST_TWT_PAUSE_STATUS_ROAM_IN_PROGRESS;
- case WMI_PAUSE_TWT_STATUS_SCAN_IN_PROGRESS:
- return HOST_TWT_PAUSE_STATUS_SCAN_IN_PROGRESS;
- default:
- return HOST_TWT_PAUSE_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_pause_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_pause_dialog_complete_event_param *params)
- {
- WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_pause_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- params->peer_macaddr.bytes);
- params->status = wmi_twt_pause_status_to_host_twt_status(ev->status);
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- static enum HOST_TWT_NUDGE_STATUS
- wmi_twt_nudge_status_to_host_twt_status(WMI_TWT_NUDGE_STATUS_T status)
- {
- switch (status) {
- case WMI_NUDGE_TWT_STATUS_OK:
- return HOST_TWT_NUDGE_STATUS_OK;
- case WMI_NUDGE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return HOST_TWT_NUDGE_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_NUDGE_TWT_STATUS_INVALID_PARAM:
- return HOST_TWT_NUDGE_STATUS_INVALID_PARAM;
- case WMI_NUDGE_TWT_STATUS_DIALOG_ID_BUSY:
- return HOST_TWT_NUDGE_STATUS_DIALOG_ID_BUSY;
- case WMI_NUDGE_TWT_STATUS_NO_RESOURCE:
- return HOST_TWT_NUDGE_STATUS_NO_RESOURCE;
- case WMI_NUDGE_TWT_STATUS_NO_ACK:
- return HOST_TWT_NUDGE_STATUS_NO_ACK;
- case WMI_NUDGE_TWT_STATUS_ALREADY_PAUSED:
- return HOST_TWT_NUDGE_STATUS_ALREADY_PAUSED;
- case WMI_NUDGE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return HOST_TWT_NUDGE_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_NUDGE_TWT_STATUS_ROAM_IN_PROGRESS:
- return HOST_TWT_NUDGE_STATUS_ROAM_IN_PROGRESS;
- case WMI_NUDGE_TWT_STATUS_SCAN_IN_PROGRESS:
- return HOST_TWT_NUDGE_STATUS_SCAN_IN_PROGRESS;
- default:
- return HOST_TWT_NUDGE_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_nudge_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_nudge_dialog_complete_event_param *params)
- {
- WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_nudge_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- params->peer_macaddr.bytes);
- params->status = wmi_twt_nudge_status_to_host_twt_status(ev->status);
- params->dialog_id = ev->dialog_id;
- params->next_twt_tsf_us_lo = ev->sp_tsf_us_lo;
- params->next_twt_tsf_us_hi = ev->sp_tsf_us_hi;
- wmi_debug("vdev_id: %d dialog_id: %d tsf hi : %x tsf lo: %x",
- params->vdev_id, params->dialog_id,
- params->next_twt_tsf_us_hi, params->next_twt_tsf_us_lo);
- return QDF_STATUS_SUCCESS;
- }
- static enum HOST_TWT_RESUME_STATUS
- wmi_get_converted_twt_resume_dialog_status(WMI_RESUME_TWT_STATUS_T tgt_status)
- {
- switch (tgt_status) {
- case WMI_RESUME_TWT_STATUS_OK:
- return HOST_TWT_RESUME_STATUS_OK;
- case WMI_RESUME_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return HOST_TWT_RESUME_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_RESUME_TWT_STATUS_INVALID_PARAM:
- return HOST_TWT_RESUME_STATUS_INVALID_PARAM;
- case WMI_RESUME_TWT_STATUS_DIALOG_ID_BUSY:
- return HOST_TWT_RESUME_STATUS_DIALOG_ID_BUSY;
- case WMI_RESUME_TWT_STATUS_NOT_PAUSED:
- return HOST_TWT_RESUME_STATUS_NOT_PAUSED;
- case WMI_RESUME_TWT_STATUS_NO_RESOURCE:
- return HOST_TWT_RESUME_STATUS_NO_RESOURCE;
- case WMI_RESUME_TWT_STATUS_NO_ACK:
- return HOST_TWT_RESUME_STATUS_NO_ACK;
- case WMI_RESUME_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return HOST_TWT_RESUME_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_RESUME_TWT_STATUS_ROAM_IN_PROGRESS:
- return HOST_TWT_RESUME_STATUS_ROAM_IN_PROGRESS;
- case WMI_RESUME_TWT_STATUS_SCAN_IN_PROGRESS:
- return HOST_TWT_RESUME_STATUS_SCAN_IN_PROGRESS;
- default:
- return HOST_TWT_RESUME_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_resume_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_resume_dialog_complete_event_param *params)
- {
- WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_resume_dialog_complete_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- params->peer_macaddr.bytes);
- params->status = wmi_get_converted_twt_resume_dialog_status(ev->status);
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- static enum HOST_TWT_NOTIFY_STATUS
- wmi_get_converted_twt_notify_status(WMI_TWT_NOTIFICATION_ID_T tgt_status)
- {
- switch (tgt_status) {
- case WMI_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_SET:
- return HOST_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_SET;
- case WMI_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_CLEAR:
- return HOST_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_CLEAR;
- default:
- return HOST_TWT_NOTIFY_EVENT_READY;
- }
- }
- static QDF_STATUS extract_twt_notify_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_notify_event_param *params)
- {
- WMI_TWT_NOTIFY_EVENTID_param_tlvs *param_buf;
- wmi_twt_notify_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_NOTIFY_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- if (ev->event_id > WMI_TWT_NOTIFY_EVENT_AP_TWT_REQ_BIT_CLEAR) {
- wmi_debug("Incorrect TWT notify event vdev_id: %d, status: %d",
- ev->vdev_id, ev->event_id);
- return QDF_STATUS_E_INVAL;
- }
- params->vdev_id = ev->vdev_id;
- params->status = wmi_get_converted_twt_notify_status(ev->event_id);
- wmi_debug("Extract notify event vdev_id: %d, status: %d",
- params->vdev_id, params->status);
- return QDF_STATUS_SUCCESS;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static QDF_STATUS
- extract_twt_btwt_invite_sta_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct
- twt_btwt_invite_sta_complete_event_param
- *params)
- {
- WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_btwt_invite_sta_complete_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- params->peer_macaddr.bytes);
- params->status = ev->status;
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS
- extract_twt_btwt_remove_sta_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct
- twt_btwt_remove_sta_complete_event_param
- *params)
- {
- WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_btwt_remove_sta_complete_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- params->peer_macaddr.bytes);
- params->status = ev->status;
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- #endif
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static void
- wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
- {
- ops->send_twt_btwt_invite_sta_cmd = send_twt_btwt_invite_sta_cmd_tlv;
- ops->send_twt_btwt_remove_sta_cmd = send_twt_btwt_remove_sta_cmd_tlv;
- ops->extract_twt_btwt_invite_sta_comp_event =
- extract_twt_btwt_invite_sta_comp_event_tlv;
- ops->extract_twt_btwt_remove_sta_comp_event =
- extract_twt_btwt_remove_sta_comp_event_tlv;
- }
- #else
- static void
- wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
- {
- }
- #endif
- static QDF_STATUS
- extract_twt_session_stats_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_session_stats_event_param
- *params)
- {
- WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
- wmi_pdev_twt_session_stats_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- ev->pdev_id);
- params->num_sessions = param_buf->num_twt_sessions;
- wmi_debug("pdev_id=%d, num of TWT sessions=%d",
- params->pdev_id, params->num_sessions);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS
- extract_twt_session_stats_event_data(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_session_stats_event_param
- *params,
- struct twt_session_stats_info
- *session,
- uint32_t idx)
- {
- WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
- wmi_twt_session_stats_info *twt_session;
- uint32_t flags;
- wmi_mac_addr *m1;
- uint8_t *m2;
- param_buf =
- (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- if (idx >= param_buf->num_twt_sessions) {
- wmi_err("wrong idx, idx=%d, num_sessions=%d",
- idx, param_buf->num_twt_sessions);
- return QDF_STATUS_E_INVAL;
- }
- twt_session = ¶m_buf->twt_sessions[idx];
- session->vdev_id = twt_session->vdev_id;
- m1 = &twt_session->peer_mac;
- m2 = session->peer_mac.bytes;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(m1, m2);
- session->event_type = twt_session->event_type;
- flags = twt_session->flow_id_flags;
- session->flow_id = WMI_TWT_SESSION_FLAG_FLOW_ID_GET(flags);
- session->bcast = WMI_TWT_SESSION_FLAG_BCAST_TWT_GET(flags);
- session->trig = WMI_TWT_SESSION_FLAG_TRIGGER_TWT_GET(flags);
- session->announ = WMI_TWT_SESSION_FLAG_ANNOUN_TWT_GET(flags);
- session->protection = WMI_TWT_SESSION_FLAG_TWT_PROTECTION_GET(flags);
- session->info_frame_disabled =
- WMI_TWT_SESSION_FLAG_TWT_INFO_FRAME_DISABLED_GET(flags);
- session->pm_responder_bit =
- WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_GET(flags);
- session->pm_responder_bit_valid =
- WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_VALID_GET(flags);
- session->dialog_id = twt_session->dialog_id;
- session->wake_dura_us = twt_session->wake_dura_us;
- session->wake_intvl_us = twt_session->wake_intvl_us;
- session->sp_offset_us = twt_session->sp_offset_us;
- session->sp_tsf_us_lo = twt_session->sp_tsf_us_lo;
- session->sp_tsf_us_hi = twt_session->sp_tsf_us_hi;
- wmi_debug("type=%d id=%d bcast=%d trig=%d announ=%d diagid=%d wake_dur=%ul wake_int=%ul offset=%ul",
- session->event_type, session->flow_id,
- session->bcast, session->trig,
- session->announ, session->dialog_id, session->wake_dura_us,
- session->wake_intvl_us, session->sp_offset_us);
- wmi_debug("resp_pm_valid=%d resp_pm=%d",
- session->pm_responder_bit_valid, session->pm_responder_bit);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS extract_twt_cap_service_ready_ext2_tlv(
- wmi_unified_t wmi_handle, uint8_t *event,
- struct wmi_twt_cap_bitmap_params *var)
- {
- WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *param_buf;
- wmi_twt_caps_params *twt_caps;
- param_buf = (WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *)event;
- if (!param_buf)
- return QDF_STATUS_E_INVAL;
- twt_caps = param_buf->twt_caps;
- if (!twt_caps)
- return QDF_STATUS_E_INVAL;
- var->twt_ack_support_cap = WMI_GET_BITS(twt_caps->twt_capability_bitmap,
- 0, 1);
- return QDF_STATUS_SUCCESS;
- }
- static enum WMI_HOST_TWT_CMD_FOR_ACK_EVENT
- wmi_get_converted_twt_command_for_ack_event(WMI_CMD_ID tgt_cmd)
- {
- switch (tgt_cmd) {
- case WMI_TWT_ADD_DIALOG_CMDID:
- return WMI_HOST_TWT_ADD_DIALOG_CMDID;
- case WMI_TWT_DEL_DIALOG_CMDID:
- return WMI_HOST_TWT_DEL_DIALOG_CMDID;
- case WMI_TWT_PAUSE_DIALOG_CMDID:
- return WMI_HOST_TWT_PAUSE_DIALOG_CMDID;
- case WMI_TWT_RESUME_DIALOG_CMDID:
- return WMI_HOST_TWT_RESUME_DIALOG_CMDID;
- case WMI_TWT_NUDGE_DIALOG_CMDID:
- return WMI_HOST_TWT_NUDGE_DIALOG_CMDID;
- default:
- return WMI_HOST_TWT_UNKNOWN_CMDID;
- }
- }
- static QDF_STATUS
- extract_twt_ack_comp_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct twt_ack_complete_event_param *var)
- {
- WMI_TWT_ACK_EVENTID_param_tlvs *param_buf;
- wmi_twt_ack_event_fixed_param *ack_event;
- param_buf = (WMI_TWT_ACK_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ack_event = param_buf->fixed_param;
- var->vdev_id = ack_event->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ack_event->peer_macaddr,
- var->peer_macaddr.bytes);
- var->dialog_id = ack_event->dialog_id;
- var->twt_cmd_ack = wmi_get_converted_twt_command_for_ack_event(
- ack_event->twt_cmd);
- switch (ack_event->twt_cmd) {
- case WMI_TWT_ADD_DIALOG_CMDID:
- var->status = wmi_get_converted_twt_add_dialog_status(
- ack_event->status);
- break;
- case WMI_TWT_DEL_DIALOG_CMDID:
- var->status = wmi_get_converted_twt_del_dialog_status(
- ack_event->status);
- break;
- case WMI_TWT_PAUSE_DIALOG_CMDID:
- var->status = wmi_twt_pause_status_to_host_twt_status(
- ack_event->status);
- break;
- case WMI_TWT_RESUME_DIALOG_CMDID:
- var->status = wmi_get_converted_twt_resume_dialog_status(
- ack_event->status);
- break;
- case WMI_TWT_NUDGE_DIALOG_CMDID:
- var->status = wmi_twt_nudge_status_to_host_twt_status(
- ack_event->status);
- break;
- default:
- break;
- }
- return QDF_STATUS_SUCCESS;
- }
- #elif WLAN_SUPPORT_TWT
- static QDF_STATUS send_twt_enable_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_enable_param *params)
- {
- wmi_twt_enable_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_enable_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_enable_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_enable_cmd_fixed_param));
- cmd->pdev_id =
- wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- params->pdev_id);
- cmd->sta_cong_timer_ms = params->sta_cong_timer_ms;
- cmd->mbss_support = params->mbss_support;
- cmd->default_slot_size = params->default_slot_size;
- cmd->congestion_thresh_setup = params->congestion_thresh_setup;
- cmd->congestion_thresh_teardown = params->congestion_thresh_teardown;
- cmd->congestion_thresh_critical = params->congestion_thresh_critical;
- cmd->interference_thresh_teardown =
- params->interference_thresh_teardown;
- cmd->interference_thresh_setup = params->interference_thresh_setup;
- cmd->min_no_sta_setup = params->min_no_sta_setup;
- cmd->min_no_sta_teardown = params->min_no_sta_teardown;
- cmd->no_of_bcast_mcast_slots = params->no_of_bcast_mcast_slots;
- cmd->min_no_twt_slots = params->min_no_twt_slots;
- cmd->max_no_sta_twt = params->max_no_sta_twt;
- cmd->mode_check_interval = params->mode_check_interval;
- cmd->add_sta_slot_interval = params->add_sta_slot_interval;
- cmd->remove_sta_slot_interval = params->remove_sta_slot_interval;
- TWT_EN_DIS_FLAGS_SET_BTWT(cmd->flags, params->b_twt_enable);
- TWT_EN_DIS_FLAGS_SET_B_R_TWT(cmd->flags, params->r_twt_enable);
- TWT_EN_DIS_FLAGS_SET_L_MBSSID(cmd->flags,
- params->b_twt_legacy_mbss_enable);
- TWT_EN_DIS_FLAGS_SET_AX_MBSSID(cmd->flags,
- params->b_twt_ax_mbss_enable);
- if (params->ext_conf_present) {
- TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
- TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
- TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
- }
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_ENABLE_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_ENABLE_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- static QDF_STATUS send_twt_disable_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_disable_param *params)
- {
- wmi_twt_disable_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_disable_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_disable_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_disable_cmd_fixed_param));
- cmd->pdev_id =
- wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- params->pdev_id);
- if (params->ext_conf_present) {
- TWT_EN_DIS_FLAGS_SET_SPLIT_CONFIG(cmd->flags, 1);
- TWT_EN_DIS_FLAGS_SET_REQ_RESP(cmd->flags, params->twt_role);
- TWT_EN_DIS_FLAGS_SET_I_B_TWT(cmd->flags, params->twt_oper);
- }
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_DISABLE_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_DISABLE_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static void
- twt_add_dialog_set_bcast_twt_params(struct wmi_twt_add_dialog_param *params,
- wmi_twt_add_dialog_cmd_fixed_param *cmd)
- {
- TWT_FLAGS_SET_BTWT_ID0(cmd->flags, params->flag_b_twt_id0);
- cmd->b_twt_persistence = params->b_twt_persistence;
- cmd->b_twt_recommendation = params->b_twt_recommendation;
- }
- #else
- static void
- twt_add_dialog_set_bcast_twt_params(struct wmi_twt_add_dialog_param *params,
- wmi_twt_add_dialog_cmd_fixed_param *cmd)
- {
- }
- #endif
- static QDF_STATUS
- send_twt_add_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_add_dialog_param *params)
- {
- wmi_twt_add_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_add_dialog_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_add_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_add_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->wake_intvl_us = params->wake_intvl_us;
- cmd->wake_intvl_mantis = params->wake_intvl_mantis;
- cmd->wake_dura_us = params->wake_dura_us;
- cmd->sp_offset_us = params->sp_offset_us;
- cmd->min_wake_intvl_us = params->min_wake_intvl_us;
- cmd->max_wake_intvl_us = params->max_wake_intvl_us;
- cmd->min_wake_dura_us = params->min_wake_dura_us;
- cmd->max_wake_dura_us = params->max_wake_dura_us;
- cmd->sp_start_tsf_lo = (uint32_t)(params->wake_time_tsf & 0xFFFFFFFF);
- cmd->sp_start_tsf_hi = (uint32_t)(params->wake_time_tsf >> 32);
- cmd->announce_timeout_us = params->announce_timeout_us;
- cmd->link_id_bitmap = params->link_id_bitmap;
- cmd->r_twt_dl_tid_bitmap = params->r_twt_dl_tid_bitmap;
- cmd->r_twt_ul_tid_bitmap = params->r_twt_ul_tid_bitmap;
- TWT_FLAGS_SET_CMD(cmd->flags, params->twt_cmd);
- TWT_FLAGS_SET_BROADCAST(cmd->flags, params->flag_bcast);
- TWT_FLAGS_SET_TRIGGER(cmd->flags, params->flag_trigger);
- TWT_FLAGS_SET_FLOW_TYPE(cmd->flags, params->flag_flow_type);
- TWT_FLAGS_SET_PROTECTION(cmd->flags, params->flag_protection);
- twt_add_dialog_set_bcast_twt_params(params, cmd);
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_ADD_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_ADD_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static void
- twt_del_dialog_set_bcast_twt_params(struct wmi_twt_del_dialog_param *params,
- wmi_twt_del_dialog_cmd_fixed_param *cmd)
- {
- cmd->b_twt_persistence = params->b_twt_persistence;
- }
- #else
- static void
- twt_del_dialog_set_bcast_twt_params(struct wmi_twt_del_dialog_param *params,
- wmi_twt_del_dialog_cmd_fixed_param *cmd)
- {
- }
- #endif
- static QDF_STATUS
- send_twt_del_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_del_dialog_param *params)
- {
- wmi_twt_del_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_del_dialog_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_del_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_del_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- twt_del_dialog_set_bcast_twt_params(params, cmd);
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_DEL_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_DEL_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- static QDF_STATUS
- send_twt_pause_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_pause_dialog_cmd_param *params)
- {
- wmi_twt_pause_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_pause_dialog_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_pause_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_pause_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_PAUSE_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_PAUSE_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- static QDF_STATUS
- send_twt_nudge_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_nudge_dialog_cmd_param *params)
- {
- wmi_twt_nudge_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf)
- return QDF_STATUS_E_FAILURE;
- cmd = (wmi_twt_nudge_dialog_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_nudge_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_nudge_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->suspend_duration_ms = params->suspend_duration / 1000;
- cmd->next_twt_size = params->next_twt_size;
- wmi_debug("vdev_id: %d dialog_id: %d duration(in ms): %u next_twt_size: %d "
- "peer_macaddr: "QDF_MAC_ADDR_FMT, cmd->vdev_id,
- cmd->dialog_id, cmd->suspend_duration_ms, cmd->next_twt_size,
- QDF_MAC_ADDR_REF(params->peer_macaddr));
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_NUDGE_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status))
- wmi_buf_free(buf);
- return status;
- }
- static QDF_STATUS send_twt_resume_dialog_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_resume_dialog_cmd_param *params)
- {
- wmi_twt_resume_dialog_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_resume_dialog_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_resume_dialog_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_resume_dialog_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- cmd->sp_offset_us = params->sp_offset_us;
- cmd->next_twt_size = params->next_twt_size;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_RESUME_DIALOG_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to send WMI_TWT_RESUME_DIALOG_CMDID");
- wmi_buf_free(buf);
- }
- return status;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static QDF_STATUS
- send_twt_btwt_invite_sta_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_btwt_invite_sta_cmd_param
- *params)
- {
- wmi_twt_btwt_invite_sta_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_btwt_invite_sta_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_btwt_invite_sta_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_btwt_invite_sta_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_BTWT_INVITE_STA_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_buf_free(buf);
- }
- return status;
- }
- static QDF_STATUS
- send_twt_btwt_remove_sta_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmi_twt_btwt_remove_sta_cmd_param
- *params)
- {
- wmi_twt_btwt_remove_sta_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!buf) {
- wmi_err("Failed to allocate memory");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_twt_btwt_remove_sta_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_twt_btwt_remove_sta_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_twt_btwt_remove_sta_cmd_fixed_param));
- cmd->vdev_id = params->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
- cmd->dialog_id = params->dialog_id;
- status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_TWT_BTWT_REMOVE_STA_CMDID);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_buf_free(buf);
- }
- return status;
- }
- #endif
- static QDF_STATUS extract_twt_enable_comp_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_enable_complete_event_param *params)
- {
- WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_enable_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->pdev_id =
- wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
- ev->pdev_id);
- params->status = ev->status;
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS extract_twt_disable_comp_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_disable_complete_event *params)
- {
- WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_disable_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- #if 0
- params->pdev_id =
- wmi_handle->ops->convert_pdev_id_target_to_host(wmi_handle,
- ev->pdev_id);
- params->status = ev->status;
- #endif
- return QDF_STATUS_SUCCESS;
- }
- static enum WMI_HOST_ADD_TWT_STATUS
- wmi_get_converted_twt_add_dialog_status(WMI_ADD_TWT_STATUS_T tgt_status)
- {
- switch (tgt_status) {
- case WMI_ADD_TWT_STATUS_OK:
- return WMI_HOST_ADD_TWT_STATUS_OK;
- case WMI_ADD_TWT_STATUS_TWT_NOT_ENABLED:
- return WMI_HOST_ADD_TWT_STATUS_TWT_NOT_ENABLED;
- case WMI_ADD_TWT_STATUS_USED_DIALOG_ID:
- return WMI_HOST_ADD_TWT_STATUS_USED_DIALOG_ID;
- case WMI_ADD_TWT_STATUS_INVALID_PARAM:
- return WMI_HOST_ADD_TWT_STATUS_INVALID_PARAM;
- case WMI_ADD_TWT_STATUS_NOT_READY:
- return WMI_HOST_ADD_TWT_STATUS_NOT_READY;
- case WMI_ADD_TWT_STATUS_NO_RESOURCE:
- return WMI_HOST_ADD_TWT_STATUS_NO_RESOURCE;
- case WMI_ADD_TWT_STATUS_NO_ACK:
- return WMI_HOST_ADD_TWT_STATUS_NO_ACK;
- case WMI_ADD_TWT_STATUS_NO_RESPONSE:
- return WMI_HOST_ADD_TWT_STATUS_NO_RESPONSE;
- case WMI_ADD_TWT_STATUS_DENIED:
- return WMI_HOST_ADD_TWT_STATUS_DENIED;
- case WMI_ADD_TWT_STATUS_AP_PARAMS_NOT_IN_RANGE:
- return WMI_HOST_ADD_TWT_STATUS_AP_PARAMS_NOT_IN_RANGE;
- case WMI_ADD_TWT_STATUS_AP_IE_VALIDATION_FAILED:
- return WMI_HOST_ADD_TWT_STATUS_AP_IE_VALIDATION_FAILED;
- case WMI_ADD_TWT_STATUS_ROAM_IN_PROGRESS:
- return WMI_HOST_ADD_TWT_STATUS_ROAM_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return WMI_HOST_ADD_TWT_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_SCAN_IN_PROGRESS:
- return WMI_HOST_ADD_TWT_STATUS_SCAN_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_LINK_SWITCH_IN_PROGRESS:
- return WMI_HOST_ADD_TWT_STATUS_LINK_SWITCH_IN_PROGRESS;
- case WMI_ADD_TWT_STATUS_UNSUPPORTED_MODE_MLMR:
- return WMI_HOST_ADD_TWT_STATUS_UNSUPPORTED_MODE_MLMR;
- default:
- return WMI_HOST_ADD_TWT_STATUS_UNKNOWN_ERROR;
- }
- }
- /**
- * extract_twt_add_dialog_comp_event_tlv - Extacts twt add dialog complete wmi
- * event from firmware
- * @wmi_handle: WMI handle
- * @evt_buf: Pointer to wmi event buf of twt add dialog complete event
- * @params: Pointer to store the extracted parameters
- *
- * Return: QDF_STATUS_SUCCESS on success or QDF STATUS error values on failure
- */
- static QDF_STATUS extract_twt_add_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_add_dialog_complete_event_param *params)
- {
- WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_add_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
- params->status = wmi_get_converted_twt_add_dialog_status(ev->status);
- params->dialog_id = ev->dialog_id;
- params->num_additional_twt_params = param_buf->num_twt_params;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_twt_add_dialog_comp_additional_parameters() - Extracts additional twt
- * twt parameters, as part of add dialog completion event
- * @wmi_handle: wmi handle
- * @evt_buf: Pointer event buffer
- * @evt_buf_len: length of the add dialog event buffer
- * @idx: index of num_twt_params
- * @additional_params: twt additional parameters to extract
- *
- * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_INVAL for failure
- */
- static QDF_STATUS extract_twt_add_dialog_comp_additional_parameters
- (
- wmi_unified_t wmi_handle, uint8_t *evt_buf,
- uint32_t evt_buf_len, uint32_t idx,
- struct wmi_twt_add_dialog_additional_params *additional_params
- )
- {
- WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_add_dialog_complete_event_fixed_param *ev;
- uint32_t flags = 0;
- uint32_t expected_len;
- param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- if (idx >= param_buf->num_twt_params) {
- wmi_err("Invalid idx %d while num_twt_params = %d",
- idx, param_buf->num_twt_params);
- return QDF_STATUS_E_INVAL;
- }
- if (!param_buf->twt_params) {
- wmi_err("Unable to extract additional twt parameters");
- return QDF_STATUS_E_INVAL;
- }
- expected_len = (sizeof(wmi_twt_add_dialog_complete_event_fixed_param) +
- WMI_TLV_HDR_SIZE + (param_buf->num_twt_params *
- sizeof(wmi_twt_add_dialog_additional_params)));
- if (evt_buf_len != expected_len) {
- wmi_err("Got invalid len data from FW %d expected %d",
- evt_buf_len, expected_len);
- return QDF_STATUS_E_INVAL;
- }
- flags = param_buf->twt_params[idx].flags;
- additional_params->twt_cmd = TWT_FLAGS_GET_CMD(flags);
- additional_params->bcast = TWT_FLAGS_GET_BROADCAST(flags);
- additional_params->trig_en = TWT_FLAGS_GET_TRIGGER(flags);
- additional_params->announce = TWT_FLAGS_GET_FLOW_TYPE(flags);
- additional_params->protection = TWT_FLAGS_GET_PROTECTION(flags);
- additional_params->b_twt_id0 = TWT_FLAGS_GET_BTWT_ID0(flags);
- additional_params->info_frame_disabled =
- TWT_FLAGS_GET_TWT_INFO_FRAME_DISABLED(flags);
- additional_params->wake_dur_us = param_buf->twt_params[idx].wake_dur_us;
- additional_params->wake_intvl_us =
- param_buf->twt_params[idx].wake_intvl_us;
- additional_params->sp_offset_us =
- param_buf->twt_params[idx].sp_offset_us;
- additional_params->sp_tsf_us_lo =
- param_buf->twt_params[idx].sp_tsf_us_lo;
- additional_params->sp_tsf_us_hi =
- param_buf->twt_params[idx].sp_tsf_us_hi;
- additional_params->pm_responder_bit_valid =
- TWT_FLAGS_GET_PM_RESPONDER_MODE_VALID(flags);
- additional_params->pm_responder_bit =
- TWT_FLAGS_GET_PM_RESPONDER_MODE(flags);
- return QDF_STATUS_SUCCESS;
- }
- static enum WMI_HOST_DEL_TWT_STATUS
- wmi_get_converted_twt_del_dialog_status(WMI_DEL_TWT_STATUS_T tgt_status)
- {
- switch (tgt_status) {
- case WMI_DEL_TWT_STATUS_OK:
- return WMI_HOST_DEL_TWT_STATUS_OK;
- case WMI_DEL_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return WMI_HOST_DEL_TWT_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_DEL_TWT_STATUS_INVALID_PARAM:
- return WMI_HOST_DEL_TWT_STATUS_INVALID_PARAM;
- case WMI_DEL_TWT_STATUS_DIALOG_ID_BUSY:
- return WMI_HOST_DEL_TWT_STATUS_DIALOG_ID_BUSY;
- case WMI_DEL_TWT_STATUS_NO_RESOURCE:
- return WMI_HOST_DEL_TWT_STATUS_NO_RESOURCE;
- case WMI_DEL_TWT_STATUS_NO_ACK:
- return WMI_HOST_DEL_TWT_STATUS_NO_ACK;
- case WMI_DEL_TWT_STATUS_UNKNOWN_ERROR:
- return WMI_HOST_DEL_TWT_STATUS_UNKNOWN_ERROR;
- case WMI_DEL_TWT_STATUS_PEER_INIT_TEARDOWN:
- return WMI_HOST_DEL_TWT_STATUS_PEER_INIT_TEARDOWN;
- case WMI_DEL_TWT_STATUS_ROAMING:
- return WMI_HOST_DEL_TWT_STATUS_ROAMING;
- case WMI_DEL_TWT_STATUS_CONCURRENCY:
- return WMI_HOST_DEL_TWT_STATUS_CONCURRENCY;
- case WMI_DEL_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return WMI_HOST_DEL_TWT_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_DEL_TWT_STATUS_SCAN_IN_PROGRESS:
- return WMI_HOST_DEL_TWT_STATUS_SCAN_IN_PROGRESS;
- default:
- return WMI_HOST_DEL_TWT_STATUS_UNKNOWN_ERROR;
- }
- return WMI_HOST_DEL_TWT_STATUS_UNKNOWN_ERROR;
- }
- static QDF_STATUS extract_twt_del_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_del_dialog_complete_event_param *params)
- {
- WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_del_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
- params->dialog_id = ev->dialog_id;
- params->status = wmi_get_converted_twt_del_dialog_status(ev->status);
- return QDF_STATUS_SUCCESS;
- }
- static enum WMI_HOST_PAUSE_TWT_STATUS
- wmi_twt_pause_status_to_host_twt_status(WMI_PAUSE_TWT_STATUS_T status)
- {
- switch (status) {
- case WMI_PAUSE_TWT_STATUS_OK:
- return WMI_HOST_PAUSE_TWT_STATUS_OK;
- case WMI_PAUSE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return WMI_HOST_PAUSE_TWT_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_PAUSE_TWT_STATUS_INVALID_PARAM:
- return WMI_HOST_PAUSE_TWT_STATUS_INVALID_PARAM;
- case WMI_PAUSE_TWT_STATUS_DIALOG_ID_BUSY:
- return WMI_HOST_PAUSE_TWT_STATUS_DIALOG_ID_BUSY;
- case WMI_PAUSE_TWT_STATUS_NO_RESOURCE:
- return WMI_HOST_PAUSE_TWT_STATUS_NO_RESOURCE;
- case WMI_PAUSE_TWT_STATUS_NO_ACK:
- return WMI_HOST_PAUSE_TWT_STATUS_NO_ACK;
- case WMI_PAUSE_TWT_STATUS_UNKNOWN_ERROR:
- return WMI_HOST_PAUSE_TWT_STATUS_UNKNOWN_ERROR;
- case WMI_PAUSE_TWT_STATUS_ALREADY_PAUSED:
- return WMI_HOST_PAUSE_TWT_STATUS_ALREADY_PAUSED;
- case WMI_PAUSE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return WMI_HOST_PAUSE_TWT_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_PAUSE_TWT_STATUS_ROAM_IN_PROGRESS:
- return WMI_HOST_PAUSE_TWT_STATUS_ROAM_IN_PROGRESS;
- case WMI_PAUSE_TWT_STATUS_SCAN_IN_PROGRESS:
- return WMI_HOST_PAUSE_TWT_STATUS_SCAN_IN_PROGRESS;
- default:
- return WMI_HOST_PAUSE_TWT_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_pause_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_pause_dialog_complete_event_param *params)
- {
- WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_pause_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
- params->status = wmi_twt_pause_status_to_host_twt_status(ev->status);
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- static enum WMI_HOST_NUDGE_TWT_STATUS
- wmi_twt_nudge_status_to_host_twt_status(WMI_TWT_NUDGE_STATUS_T status)
- {
- switch (status) {
- case WMI_NUDGE_TWT_STATUS_OK:
- return WMI_HOST_NUDGE_TWT_STATUS_OK;
- case WMI_NUDGE_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return WMI_HOST_NUDGE_TWT_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_NUDGE_TWT_STATUS_INVALID_PARAM:
- return WMI_HOST_NUDGE_TWT_STATUS_INVALID_PARAM;
- case WMI_NUDGE_TWT_STATUS_DIALOG_ID_BUSY:
- return WMI_HOST_NUDGE_TWT_STATUS_DIALOG_ID_BUSY;
- case WMI_NUDGE_TWT_STATUS_NO_RESOURCE:
- return WMI_HOST_NUDGE_TWT_STATUS_NO_RESOURCE;
- case WMI_NUDGE_TWT_STATUS_NO_ACK:
- return WMI_HOST_NUDGE_TWT_STATUS_NO_ACK;
- case WMI_NUDGE_TWT_STATUS_UNKNOWN_ERROR:
- return WMI_HOST_NUDGE_TWT_STATUS_UNKNOWN_ERROR;
- case WMI_NUDGE_TWT_STATUS_ALREADY_PAUSED:
- return WMI_HOST_NUDGE_TWT_STATUS_ALREADY_PAUSED;
- case WMI_NUDGE_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return WMI_HOST_NUDGE_TWT_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_NUDGE_TWT_STATUS_ROAM_IN_PROGRESS:
- return WMI_HOST_NUDGE_TWT_STATUS_ROAM_IN_PROGRESS;
- case WMI_NUDGE_TWT_STATUS_SCAN_IN_PROGRESS:
- return WMI_HOST_NUDGE_TWT_STATUS_SCAN_IN_PROGRESS;
- default:
- return WMI_HOST_NUDGE_TWT_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_nudge_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_nudge_dialog_complete_event_param *params)
- {
- WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_nudge_dialog_complete_event_fixed_param *ev;
- param_buf = (WMI_TWT_NUDGE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
- params->status = wmi_twt_nudge_status_to_host_twt_status(ev->status);
- params->dialog_id = ev->dialog_id;
- params->next_twt_tsf_us_lo = ev->sp_tsf_us_lo;
- params->next_twt_tsf_us_hi = ev->sp_tsf_us_hi;
- wmi_debug("vdev_id: %d dialog_id: %d tsf hi : %x tsf lo: %x",
- params->vdev_id, params->dialog_id,
- params->next_twt_tsf_us_hi, params->next_twt_tsf_us_lo);
- return QDF_STATUS_SUCCESS;
- }
- static enum WMI_HOST_RESUME_TWT_STATUS
- wmi_get_converted_twt_resume_dialog_status(WMI_RESUME_TWT_STATUS_T tgt_status)
- {
- switch (tgt_status) {
- case WMI_RESUME_TWT_STATUS_OK:
- return WMI_HOST_RESUME_TWT_STATUS_OK;
- case WMI_RESUME_TWT_STATUS_DIALOG_ID_NOT_EXIST:
- return WMI_HOST_RESUME_TWT_STATUS_DIALOG_ID_NOT_EXIST;
- case WMI_RESUME_TWT_STATUS_INVALID_PARAM:
- return WMI_HOST_RESUME_TWT_STATUS_INVALID_PARAM;
- case WMI_RESUME_TWT_STATUS_DIALOG_ID_BUSY:
- return WMI_HOST_RESUME_TWT_STATUS_DIALOG_ID_BUSY;
- case WMI_RESUME_TWT_STATUS_NOT_PAUSED:
- return WMI_HOST_RESUME_TWT_STATUS_NOT_PAUSED;
- case WMI_RESUME_TWT_STATUS_NO_RESOURCE:
- return WMI_HOST_RESUME_TWT_STATUS_NO_RESOURCE;
- case WMI_RESUME_TWT_STATUS_NO_ACK:
- return WMI_HOST_RESUME_TWT_STATUS_NO_ACK;
- case WMI_RESUME_TWT_STATUS_CHAN_SW_IN_PROGRESS:
- return WMI_HOST_RESUME_TWT_STATUS_CHAN_SW_IN_PROGRESS;
- case WMI_RESUME_TWT_STATUS_ROAM_IN_PROGRESS:
- return WMI_HOST_RESUME_TWT_STATUS_ROAM_IN_PROGRESS;
- case WMI_RESUME_TWT_STATUS_SCAN_IN_PROGRESS:
- return WMI_HOST_RESUME_TWT_STATUS_SCAN_IN_PROGRESS;
- default:
- return WMI_HOST_RESUME_TWT_STATUS_UNKNOWN_ERROR;
- }
- }
- static QDF_STATUS extract_twt_resume_dialog_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_resume_dialog_complete_event_param *params)
- {
- WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_resume_dialog_complete_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
- params->status = wmi_get_converted_twt_resume_dialog_status(ev->status);
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS extract_twt_notify_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_notify_event_param *params)
- {
- WMI_TWT_NOTIFY_EVENTID_param_tlvs *param_buf;
- wmi_twt_notify_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_NOTIFY_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- return QDF_STATUS_SUCCESS;
- }
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static QDF_STATUS
- extract_twt_btwt_invite_sta_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct
- wmi_twt_btwt_invite_sta_complete_event_param
- *params)
- {
- WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_btwt_invite_sta_complete_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_BTWT_INVITE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
- params->status = ev->status;
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS
- extract_twt_btwt_remove_sta_comp_event_tlv(
- wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct
- wmi_twt_btwt_remove_sta_complete_event_param
- *params)
- {
- WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *param_buf;
- wmi_twt_btwt_remove_sta_complete_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_BTWT_REMOVE_STA_COMPLETE_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr, params->peer_macaddr);
- params->status = ev->status;
- params->dialog_id = ev->dialog_id;
- return QDF_STATUS_SUCCESS;
- }
- #endif
- #ifdef WLAN_SUPPORT_BCAST_TWT
- static void
- wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
- {
- ops->send_twt_btwt_invite_sta_cmd = send_twt_btwt_invite_sta_cmd_tlv;
- ops->send_twt_btwt_remove_sta_cmd = send_twt_btwt_remove_sta_cmd_tlv;
- ops->extract_twt_btwt_invite_sta_comp_event =
- extract_twt_btwt_invite_sta_comp_event_tlv;
- ops->extract_twt_btwt_remove_sta_comp_event =
- extract_twt_btwt_remove_sta_comp_event_tlv;
- }
- #else
- static void
- wmi_twt_attach_bcast_twt_tlv(struct wmi_ops *ops)
- {
- }
- #endif
- static QDF_STATUS
- extract_twt_session_stats_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_session_stats_event_param
- *params)
- {
- WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
- wmi_pdev_twt_session_stats_event_fixed_param *ev;
- param_buf =
- (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ev = param_buf->fixed_param;
- params->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- ev->pdev_id);
- params->num_sessions = param_buf->num_twt_sessions;
- wmi_debug("pdev_id=%d, num of TWT sessions=%d",
- params->pdev_id, params->num_sessions);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS
- extract_twt_session_stats_event_data(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_session_stats_event_param
- *params,
- struct wmi_host_twt_session_stats_info
- *session,
- uint32_t idx)
- {
- WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *param_buf;
- wmi_twt_session_stats_info *twt_session;
- uint32_t flags;
- wmi_mac_addr *m1;
- uint8_t *m2;
- param_buf =
- (WMI_TWT_SESSION_STATS_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- if (idx >= param_buf->num_twt_sessions) {
- wmi_err("wrong idx, idx=%d, num_sessions=%d",
- idx, param_buf->num_twt_sessions);
- return QDF_STATUS_E_INVAL;
- }
- twt_session = ¶m_buf->twt_sessions[idx];
- session->vdev_id = twt_session->vdev_id;
- m1 = &twt_session->peer_mac;
- m2 = session->peer_mac;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(m1, m2);
- session->event_type = twt_session->event_type;
- flags = twt_session->flow_id_flags;
- session->flow_id = WMI_TWT_SESSION_FLAG_FLOW_ID_GET(flags);
- session->bcast = WMI_TWT_SESSION_FLAG_BCAST_TWT_GET(flags);
- session->trig = WMI_TWT_SESSION_FLAG_TRIGGER_TWT_GET(flags);
- session->announ = WMI_TWT_SESSION_FLAG_ANNOUN_TWT_GET(flags);
- session->protection = WMI_TWT_SESSION_FLAG_TWT_PROTECTION_GET(flags);
- session->info_frame_disabled =
- WMI_TWT_SESSION_FLAG_TWT_INFO_FRAME_DISABLED_GET(flags);
- session->pm_responder_bit =
- WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_GET(flags);
- session->pm_responder_bit_valid =
- WMI_TWT_SESSION_FLAG_TWT_PM_RESPONDER_MODE_VALID_GET(flags);
- session->dialog_id = twt_session->dialog_id;
- session->wake_dura_us = twt_session->wake_dura_us;
- session->wake_intvl_us = twt_session->wake_intvl_us;
- session->sp_offset_us = twt_session->sp_offset_us;
- session->sp_tsf_us_lo = twt_session->sp_tsf_us_lo;
- session->sp_tsf_us_hi = twt_session->sp_tsf_us_hi;
- wmi_debug("type=%d id=%d bcast=%d trig=%d announ=%d diagid=%d wake_dur=%ul wake_int=%ul offset=%ul",
- session->event_type, session->flow_id,
- session->bcast, session->trig,
- session->announ, session->dialog_id, session->wake_dura_us,
- session->wake_intvl_us, session->sp_offset_us);
- wmi_debug("resp_pm_valid=%d resp_pm=%d",
- session->pm_responder_bit_valid, session->pm_responder_bit);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS extract_twt_cap_service_ready_ext2_tlv(
- wmi_unified_t wmi_handle, uint8_t *event,
- struct wmi_twt_cap_bitmap_params *var)
- {
- WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *param_buf;
- wmi_twt_caps_params *twt_caps;
- param_buf = (WMI_SERVICE_READY_EXT2_EVENTID_param_tlvs *)event;
- if (!param_buf)
- return QDF_STATUS_E_INVAL;
- twt_caps = param_buf->twt_caps;
- if (!twt_caps)
- return QDF_STATUS_E_INVAL;
- var->twt_ack_support_cap = WMI_GET_BITS(twt_caps->twt_capability_bitmap,
- 0, 1);
- return QDF_STATUS_SUCCESS;
- }
- static enum WMI_HOST_TWT_CMD_FOR_ACK_EVENT
- wmi_get_converted_twt_command_for_ack_event(WMI_CMD_ID tgt_cmd)
- {
- switch (tgt_cmd) {
- case WMI_TWT_ADD_DIALOG_CMDID:
- return WMI_HOST_TWT_ADD_DIALOG_CMDID;
- case WMI_TWT_DEL_DIALOG_CMDID:
- return WMI_HOST_TWT_DEL_DIALOG_CMDID;
- case WMI_TWT_PAUSE_DIALOG_CMDID:
- return WMI_HOST_TWT_PAUSE_DIALOG_CMDID;
- case WMI_TWT_RESUME_DIALOG_CMDID:
- return WMI_HOST_TWT_RESUME_DIALOG_CMDID;
- case WMI_TWT_NUDGE_DIALOG_CMDID:
- return WMI_HOST_TWT_NUDGE_DIALOG_CMDID;
- default:
- return WMI_HOST_TWT_UNKNOWN_CMDID;
- }
- }
- static QDF_STATUS
- extract_twt_ack_comp_event_tlv(wmi_unified_t wmi_handle,
- uint8_t *evt_buf,
- struct wmi_twt_ack_complete_event_param *var)
- {
- WMI_TWT_ACK_EVENTID_param_tlvs *param_buf;
- wmi_twt_ack_event_fixed_param *ack_event;
- param_buf = (WMI_TWT_ACK_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- wmi_err("evt_buf is NULL");
- return QDF_STATUS_E_INVAL;
- }
- ack_event = param_buf->fixed_param;
- var->vdev_id = ack_event->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ack_event->peer_macaddr,
- var->peer_macaddr.bytes);
- var->dialog_id = ack_event->dialog_id;
- var->twt_cmd_ack = wmi_get_converted_twt_command_for_ack_event(
- ack_event->twt_cmd);
- switch (ack_event->twt_cmd) {
- case WMI_TWT_ADD_DIALOG_CMDID:
- var->status = wmi_get_converted_twt_add_dialog_status(
- ack_event->status);
- break;
- case WMI_TWT_DEL_DIALOG_CMDID:
- var->status = wmi_get_converted_twt_del_dialog_status(
- ack_event->status);
- break;
- case WMI_TWT_PAUSE_DIALOG_CMDID:
- var->status = wmi_twt_pause_status_to_host_twt_status(
- ack_event->status);
- break;
- case WMI_TWT_RESUME_DIALOG_CMDID:
- var->status = wmi_get_converted_twt_resume_dialog_status(
- ack_event->status);
- break;
- case WMI_TWT_NUDGE_DIALOG_CMDID:
- var->status = wmi_twt_nudge_status_to_host_twt_status(
- ack_event->status);
- break;
- default:
- break;
- }
- return QDF_STATUS_SUCCESS;
- }
- #endif
- void wmi_twt_attach_tlv(wmi_unified_t wmi_handle)
- {
- struct wmi_ops *ops = wmi_handle->ops;
- ops->send_twt_enable_cmd = send_twt_enable_cmd_tlv;
- ops->send_twt_disable_cmd = send_twt_disable_cmd_tlv;
- ops->send_twt_add_dialog_cmd = send_twt_add_dialog_cmd_tlv;
- ops->send_twt_del_dialog_cmd = send_twt_del_dialog_cmd_tlv;
- ops->send_twt_pause_dialog_cmd = send_twt_pause_dialog_cmd_tlv;
- ops->send_twt_nudge_dialog_cmd = send_twt_nudge_dialog_cmd_tlv;
- ops->send_twt_resume_dialog_cmd = send_twt_resume_dialog_cmd_tlv;
- ops->extract_twt_enable_comp_event = extract_twt_enable_comp_event_tlv;
- ops->extract_twt_disable_comp_event =
- extract_twt_disable_comp_event_tlv;
- ops->extract_twt_add_dialog_comp_event =
- extract_twt_add_dialog_comp_event_tlv;
- ops->extract_twt_add_dialog_comp_additional_params =
- extract_twt_add_dialog_comp_additional_parameters;
- ops->extract_twt_del_dialog_comp_event =
- extract_twt_del_dialog_comp_event_tlv;
- ops->extract_twt_pause_dialog_comp_event =
- extract_twt_pause_dialog_comp_event_tlv;
- ops->extract_twt_nudge_dialog_comp_event =
- extract_twt_nudge_dialog_comp_event_tlv;
- ops->extract_twt_resume_dialog_comp_event =
- extract_twt_resume_dialog_comp_event_tlv;
- ops->extract_twt_session_stats_event =
- extract_twt_session_stats_event_tlv;
- ops->extract_twt_session_stats_data =
- extract_twt_session_stats_event_data;
- ops->extract_twt_notify_event =
- extract_twt_notify_event_tlv;
- ops->extract_twt_cap_service_ready_ext2 =
- extract_twt_cap_service_ready_ext2_tlv,
- ops->extract_twt_ack_comp_event = extract_twt_ack_comp_event_tlv;
- wmi_twt_attach_bcast_twt_tlv(ops);
- }
|