1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725 |
- /*
- * Copyright (c) 2016-2020 The Linux Foundation. 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_ap_api.h"
- #include <wlan_utility.h>
- /**
- * send_peer_add_wds_entry_cmd_tlv() - send peer add command to fw
- * @wmi_handle: wmi handle
- * @param: pointer holding peer details
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS send_peer_add_wds_entry_cmd_tlv(wmi_unified_t wmi_handle,
- struct peer_add_wds_entry_params *param)
- {
- wmi_peer_add_wds_entry_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- int len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- qdf_print("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_peer_add_wds_entry_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_peer_add_wds_entry_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_peer_add_wds_entry_cmd_fixed_param));
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param->dest_addr, &cmd->wds_macaddr);
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_addr, &cmd->peer_macaddr);
- cmd->flags = (param->flags & WMI_HOST_WDS_FLAG_STATIC) ?
- WMI_WDS_FLAG_STATIC : 0;
- cmd->vdev_id = param->vdev_id;
- wmi_mtrace(WMI_PEER_ADD_WDS_ENTRY_CMDID, cmd->vdev_id, 0);
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PEER_ADD_WDS_ENTRY_CMDID)) {
- WMI_LOGE("%s: peer %pM vdev_id %d wds %pM flag %d failed!\n",
- __func__, param->peer_addr, param->vdev_id,
- param->dest_addr, param->flags);
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- WMI_LOGD("%s: peer_macaddr %pM vdev_id %d, wds_macaddr %pM flag %d\n",
- __func__, param->peer_addr, param->vdev_id,
- param->dest_addr, param->flags);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_peer_del_wds_entry_cmd_tlv() - send peer delete command to fw
- * @wmi_handle: wmi handle
- * @param: pointer holding peer details
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS send_peer_del_wds_entry_cmd_tlv(wmi_unified_t wmi_handle,
- struct peer_del_wds_entry_params *param)
- {
- wmi_peer_remove_wds_entry_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- int len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- qdf_print("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- cmd = (wmi_peer_remove_wds_entry_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_peer_remove_wds_entry_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_peer_remove_wds_entry_cmd_fixed_param));
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param->dest_addr, &cmd->wds_macaddr);
- cmd->vdev_id = param->vdev_id;
- wmi_mtrace(WMI_PEER_REMOVE_WDS_ENTRY_CMDID, cmd->vdev_id, 0);
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PEER_REMOVE_WDS_ENTRY_CMDID)) {
- WMI_LOGE("%s: vdev_id %d wds_addr %pM failed!\n",
- __func__, param->vdev_id, param->dest_addr);
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- WMI_LOGD("%s: vdev_id %d wds_addr %pM\n",
- __func__, param->vdev_id, param->dest_addr);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_peer_update_wds_entry_cmd_tlv() - send peer update command to fw
- * @wmi_handle: wmi handle
- * @param: pointer holding peer details
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS send_peer_update_wds_entry_cmd_tlv(wmi_unified_t wmi_handle,
- struct peer_update_wds_entry_params *param)
- {
- wmi_peer_update_wds_entry_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- int len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- qdf_print("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- /* wmi_buf_alloc returns zeroed command buffer */
- cmd = (wmi_peer_update_wds_entry_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_peer_update_wds_entry_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_peer_update_wds_entry_cmd_fixed_param));
- cmd->flags = (param->flags & WMI_HOST_WDS_FLAG_STATIC) ? WMI_WDS_FLAG_STATIC : 0;
- cmd->vdev_id = param->vdev_id;
- if (param->wds_macaddr)
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param->wds_macaddr,
- &cmd->wds_macaddr);
- if (param->peer_macaddr)
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_macaddr,
- &cmd->peer_macaddr);
- wmi_mtrace(WMI_PEER_UPDATE_WDS_ENTRY_CMDID, cmd->vdev_id, 0);
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PEER_UPDATE_WDS_ENTRY_CMDID)) {
- WMI_LOGE("%s: peer %pM vdev_id %d wds %pM flags %d failed!\n",
- __func__, param->peer_macaddr, param->vdev_id,
- param->wds_macaddr, param->flags);
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- WMI_LOGD("%s: peer_addr %pM vdev_id %d wds_addr %pM flags %d\n",
- __func__, param->peer_macaddr, param->vdev_id,
- param->wds_macaddr, param->flags);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_pdev_get_tpc_config_cmd_tlv() - send get tpc config command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to get tpc config params
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_pdev_get_tpc_config_cmd_tlv(wmi_unified_t wmi_handle,
- uint32_t param)
- {
- wmi_pdev_get_tpc_config_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- int32_t len = sizeof(wmi_pdev_get_tpc_config_cmd_fixed_param);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s:wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- cmd = (wmi_pdev_get_tpc_config_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_get_tpc_config_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_pdev_get_tpc_config_cmd_fixed_param));
- cmd->param = param;
- wmi_mtrace(WMI_PDEV_GET_TPC_CONFIG_CMDID, NO_SESSION, 0);
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_GET_TPC_CONFIG_CMDID)) {
- WMI_LOGE("Send pdev get tpc config cmd failed");
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- WMI_LOGD("%s:send success", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_set_ctl_table_cmd_tlv() - send ctl table cmd to fw
- * @wmi_handle: wmi handle
- * @param: pointer to hold ctl table param
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS
- send_set_ctl_table_cmd_tlv(wmi_unified_t wmi_handle,
- struct ctl_table_params *param)
- {
- uint16_t len, ctl_tlv_len;
- uint8_t *buf_ptr;
- wmi_buf_t buf;
- wmi_pdev_set_ctl_table_cmd_fixed_param *cmd;
- uint32_t *ctl_array;
- if (!param->ctl_array)
- return QDF_STATUS_E_FAILURE;
- ctl_tlv_len = WMI_TLV_HDR_SIZE +
- roundup(param->ctl_cmd_len, sizeof(uint32_t));
- len = sizeof(*cmd) + ctl_tlv_len;
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s:wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- buf_ptr = wmi_buf_data(buf);
- qdf_mem_zero(buf_ptr, len);
- cmd = (wmi_pdev_set_ctl_table_cmd_fixed_param *)buf_ptr;
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_set_ctl_table_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_pdev_set_ctl_table_cmd_fixed_param));
- cmd->ctl_len = param->ctl_cmd_len;
- cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- param->pdev_id);
- buf_ptr += sizeof(*cmd);
- WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
- (cmd->ctl_len));
- buf_ptr += WMI_TLV_HDR_SIZE;
- ctl_array = (uint32_t *)buf_ptr;
- WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(&ctl_array[0], ¶m->ctl_band,
- sizeof(param->ctl_band));
- WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(&ctl_array[1], param->ctl_array,
- param->ctl_cmd_len -
- sizeof(param->ctl_band));
- wmi_mtrace(WMI_PDEV_SET_CTL_TABLE_CMDID, NO_SESSION, 0);
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_SET_CTL_TABLE_CMDID)) {
- WMI_LOGE("%s:Failed to send command", __func__);
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_set_mimogain_table_cmd_tlv() - send mimogain table cmd to fw
- * @wmi_handle: wmi handle
- * @param: pointer to hold mimogain table param
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS
- send_set_mimogain_table_cmd_tlv(wmi_unified_t wmi_handle,
- struct mimogain_table_params *param)
- {
- uint16_t len, table_tlv_len;
- wmi_buf_t buf;
- uint8_t *buf_ptr;
- wmi_pdev_set_mimogain_table_cmd_fixed_param *cmd;
- uint32_t *gain_table;
- if (!param->array_gain)
- return QDF_STATUS_E_FAILURE;
- /* len must be multiple of a single array gain table */
- if (param->tbl_len %
- ((WMI_HOST_TX_NUM_CHAIN-1) * WMI_HOST_TPC_REGINDEX_MAX *
- WMI_HOST_ARRAY_GAIN_NUM_STREAMS) != 0) {
- WMI_LOGE("Array gain table len not correct");
- return QDF_STATUS_E_FAILURE;
- }
- table_tlv_len = WMI_TLV_HDR_SIZE +
- roundup(param->tbl_len, sizeof(uint32_t));
- len = sizeof(*cmd) + table_tlv_len;
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s:wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- buf_ptr = wmi_buf_data(buf);
- qdf_mem_zero(buf_ptr, len);
- cmd = (wmi_pdev_set_mimogain_table_cmd_fixed_param *)buf_ptr;
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_set_mimogain_table_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_pdev_set_mimogain_table_cmd_fixed_param));
- cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- param->pdev_id);
- WMI_MIMOGAIN_ARRAY_GAIN_LEN_SET(cmd->mimogain_info, param->tbl_len);
- WMI_MIMOGAIN_MULTI_CHAIN_BYPASS_SET(cmd->mimogain_info,
- param->multichain_gain_bypass);
- buf_ptr += sizeof(*cmd);
- WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
- (param->tbl_len));
- buf_ptr += WMI_TLV_HDR_SIZE;
- gain_table = (uint32_t *)buf_ptr;
- WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(gain_table,
- param->array_gain,
- param->tbl_len);
- wmi_mtrace(WMI_PDEV_SET_MIMOGAIN_TABLE_CMDID, NO_SESSION, 0);
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_SET_MIMOGAIN_TABLE_CMDID)) {
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * enum packet_power_tlv_flags: target defined
- * packet power rate flags for TLV
- * @WMI_TLV_FLAG_ONE_CHAIN: one chain
- * @WMI_TLV_FLAG_TWO_CHAIN: two chain
- * @WMI_TLV_FLAG_THREE_CHAIN: three chain
- * @WMI_TLV_FLAG_FOUR_CHAIN: four chain
- * @WMI_TLV_FLAG_FIVE_CHAIN: five chain
- * @WMI_TLV_FLAG_SIX_CHAIN: six chain
- * @WMI_TLV_FLAG_SEVEN_CHAIN: seven chain
- * @WMI_TLV_FLAG_EIGHT_CHAIN:eight chain
- * @WMI_TLV_FLAG_STBC: STBC is set
- * @WMI_TLV_FLAG_40MHZ: 40MHz chan width
- * @WMI_TLV_FLAG_80MHZ: 80MHz chan width
- * @WMI_TLV_FLAG_160MHZ: 160MHz chan width
- * @WMI_TLV_FLAG_TXBF: Tx Bf enabled
- * @WMI_TLV_FLAG_RTSENA: RTS enabled
- * @WMI_TLV_FLAG_CTSENA: CTS enabled
- * @WMI_TLV_FLAG_LDPC: LDPC is set
- * @WMI_TLV_FLAG_SGI: Short gaurd interval
- * @WMI_TLV_FLAG_SU: SU Data
- * @WMI_TLV_FLAG_DL_MU_MIMO_AC: DL AC MU data
- * @WMI_TLV_FLAG_DL_MU_MIMO_AX: DL AX MU data
- * @WMI_TLV_FLAG_DL_OFDMA: DL OFDMA data
- * @WMI_TLV_FLAG_UL_OFDMA: UL OFDMA data
- * @WMI_TLV_FLAG_UL_MU_MIMO: UL MU data
- *
- * @WMI_TLV_FLAG_BW_MASK: bandwidth mask
- * @WMI_TLV_FLAG_BW_SHIFT: bandwidth shift
- * @WMI_TLV_FLAG_SU_MU_OFDMA_MASK: su/mu/ofdma mask
- * @WMI_TLV_FLAG_SU_MU_OFDMA_shift: su/mu/ofdma shift
- */
- enum packet_power_tlv_flags {
- WMI_TLV_FLAG_ONE_CHAIN = 0x00000001,
- WMI_TLV_FLAG_TWO_CHAIN = 0x00000003,
- WMI_TLV_FLAG_THREE_CHAIN = 0x00000007,
- WMI_TLV_FLAG_FOUR_CHAIN = 0x0000000F,
- WMI_TLV_FLAG_FIVE_CHAIN = 0x0000001F,
- WMI_TLV_FLAG_SIX_CHAIN = 0x0000003F,
- WMI_TLV_FLAG_SEVEN_CHAIN = 0x0000007F,
- WMI_TLV_FLAG_EIGHT_CHAIN = 0x0000008F,
- WMI_TLV_FLAG_STBC = 0x00000100,
- WMI_TLV_FLAG_40MHZ = 0x00000200,
- WMI_TLV_FLAG_80MHZ = 0x00000300,
- WMI_TLV_FLAG_160MHZ = 0x00000400,
- WMI_TLV_FLAG_TXBF = 0x00000800,
- WMI_TLV_FLAG_RTSENA = 0x00001000,
- WMI_TLV_FLAG_CTSENA = 0x00002000,
- WMI_TLV_FLAG_LDPC = 0x00004000,
- WMI_TLV_FLAG_SGI = 0x00008000,
- WMI_TLV_FLAG_SU = 0x00100000,
- WMI_TLV_FLAG_DL_MU_MIMO_AC = 0x00200000,
- WMI_TLV_FLAG_DL_MU_MIMO_AX = 0x00300000,
- WMI_TLV_FLAG_DL_OFDMA = 0x00400000,
- WMI_TLV_FLAG_UL_OFDMA = 0x00500000,
- WMI_TLV_FLAG_UL_MU_MIMO = 0x00600000,
- WMI_TLV_FLAG_CHAIN_MASK = 0xff,
- WMI_TLV_FLAG_BW_MASK = 0x3,
- WMI_TLV_FLAG_BW_SHIFT = 9,
- WMI_TLV_FLAG_SU_MU_OFDMA_MASK = 0x7,
- WMI_TLV_FLAG_SU_MU_OFDMA_SHIFT = 20,
- };
- /**
- * convert_to_power_info_rate_flags() - convert packet_power_info_params
- * to FW understandable format
- * @param: pointer to hold packet power info param
- *
- * @return FW understandable 32 bit rate flags
- */
- static uint32_t
- convert_to_power_info_rate_flags(struct packet_power_info_params *param)
- {
- uint32_t rateflags = 0;
- if (param->chainmask)
- rateflags |=
- (param->chainmask & WMI_TLV_FLAG_CHAIN_MASK);
- if (param->chan_width)
- rateflags |=
- ((param->chan_width & WMI_TLV_FLAG_BW_MASK)
- << WMI_TLV_FLAG_BW_SHIFT);
- if (param->su_mu_ofdma)
- rateflags |=
- ((param->su_mu_ofdma & WMI_TLV_FLAG_SU_MU_OFDMA_MASK)
- << WMI_TLV_FLAG_SU_MU_OFDMA_SHIFT);
- if (param->rate_flags & WMI_HOST_FLAG_STBC)
- rateflags |= WMI_TLV_FLAG_STBC;
- if (param->rate_flags & WMI_HOST_FLAG_LDPC)
- rateflags |= WMI_TLV_FLAG_LDPC;
- if (param->rate_flags & WMI_HOST_FLAG_TXBF)
- rateflags |= WMI_TLV_FLAG_TXBF;
- if (param->rate_flags & WMI_HOST_FLAG_RTSENA)
- rateflags |= WMI_TLV_FLAG_RTSENA;
- if (param->rate_flags & WMI_HOST_FLAG_CTSENA)
- rateflags |= WMI_TLV_FLAG_CTSENA;
- if (param->rate_flags & WMI_HOST_FLAG_SGI)
- rateflags |= WMI_TLV_FLAG_SGI;
- return rateflags;
- }
- /**
- * send_packet_power_info_get_cmd_tlv() - send request to get packet power
- * info to fw
- * @wmi_handle: wmi handle
- * @param: pointer to hold packet power info param
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS
- send_packet_power_info_get_cmd_tlv(wmi_unified_t wmi_handle,
- struct packet_power_info_params *param)
- {
- wmi_pdev_get_tpc_cmd_fixed_param *cmd;
- wmi_buf_t wmibuf;
- uint8_t *buf_ptr;
- u_int32_t len = sizeof(wmi_pdev_get_tpc_cmd_fixed_param);
- wmibuf = wmi_buf_alloc(wmi_handle, len);
- if (wmibuf == NULL)
- return QDF_STATUS_E_NOMEM;
- buf_ptr = (uint8_t *)wmi_buf_data(wmibuf);
- cmd = (wmi_pdev_get_tpc_cmd_fixed_param *)buf_ptr;
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_get_tpc_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_pdev_get_tpc_cmd_fixed_param));
- cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- param->pdev_id);
- cmd->rate_flags = convert_to_power_info_rate_flags(param);
- cmd->nss = param->nss;
- cmd->preamble = param->preamble;
- cmd->hw_rate = param->hw_rate;
- WMI_LOGI("%s[%d] commandID %d, wmi_pdev_get_tpc_cmd=0x%x,"
- "rate_flags: 0x%x, nss: %d, preamble: %d, hw_rate: %d",
- __func__, __LINE__, WMI_PDEV_GET_TPC_CMDID, *((u_int32_t *)cmd),
- cmd->rate_flags, cmd->nss, cmd->preamble, cmd->hw_rate);
- wmi_mtrace(WMI_PDEV_GET_TPC_CMDID, NO_SESSION, 0);
- if (wmi_unified_cmd_send(wmi_handle, wmibuf, len,
- WMI_PDEV_GET_TPC_CMDID)) {
- WMI_LOGE(FL("Failed to get tpc command"));
- wmi_buf_free(wmibuf);
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_nf_dbr_dbm_info_get_cmd_tlv() - send request to get nf to fw
- * @wmi_handle: wmi handle
- * @mac_id: radio context
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_nf_dbr_dbm_info_get_cmd_tlv(wmi_unified_t wmi_handle, uint8_t mac_id)
- {
- wmi_buf_t buf;
- QDF_STATUS ret;
- wmi_pdev_get_nfcal_power_fixed_param *cmd;
- int32_t len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (buf == NULL)
- return QDF_STATUS_E_NOMEM;
- cmd = (wmi_pdev_get_nfcal_power_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_get_nfcal_power_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_pdev_get_nfcal_power_fixed_param));
- cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- mac_id);
- wmi_mtrace(WMI_PDEV_GET_NFCAL_POWER_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_GET_NFCAL_POWER_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending get nfcal power cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_set_ht_ie_cmd_tlv() - send ht ie command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to ht ie param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_set_ht_ie_cmd_tlv(wmi_unified_t wmi_handle,
- struct ht_ie_params *param)
- {
- wmi_pdev_set_ht_ie_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS ret;
- int32_t len;
- uint8_t *buf_ptr;
- len = sizeof(*cmd) + WMI_TLV_HDR_SIZE +
- roundup(param->ie_len, sizeof(uint32_t));
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- buf_ptr = (uint8_t *)wmi_buf_data(buf);
- cmd = (wmi_pdev_set_ht_ie_cmd_fixed_param *)buf_ptr;
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_set_ht_ie_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_pdev_set_ht_ie_cmd_fixed_param));
- cmd->reserved0 = 0;
- cmd->ie_len = param->ie_len;
- cmd->tx_streams = param->tx_streams;
- cmd->rx_streams = param->rx_streams;
- buf_ptr += sizeof(*cmd);
- WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, cmd->ie_len);
- buf_ptr += WMI_TLV_HDR_SIZE;
- if (param->ie_len)
- WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(buf_ptr, param->ie_data,
- cmd->ie_len);
- wmi_mtrace(WMI_PDEV_SET_HT_CAP_IE_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_SET_HT_CAP_IE_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending set ht ie cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_set_vht_ie_cmd_tlv() - send vht ie command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to vht ie param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_set_vht_ie_cmd_tlv(wmi_unified_t wmi_handle,
- struct vht_ie_params *param)
- {
- wmi_pdev_set_vht_ie_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS ret;
- int32_t len;
- uint8_t *buf_ptr;
- len = sizeof(*cmd) + WMI_TLV_HDR_SIZE +
- roundup(param->ie_len, sizeof(uint32_t));
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- buf_ptr = (uint8_t *)wmi_buf_data(buf);
- cmd = (wmi_pdev_set_vht_ie_cmd_fixed_param *)buf_ptr;
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_set_vht_ie_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_pdev_set_vht_ie_cmd_fixed_param));
- cmd->reserved0 = 0;
- cmd->ie_len = param->ie_len;
- cmd->tx_streams = param->tx_streams;
- cmd->rx_streams = param->rx_streams;
- buf_ptr += sizeof(*cmd);
- WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, cmd->ie_len);
- buf_ptr += WMI_TLV_HDR_SIZE;
- if (param->ie_len)
- WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(buf_ptr, param->ie_data,
- cmd->ie_len);
- wmi_mtrace(WMI_PDEV_SET_VHT_CAP_IE_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_SET_VHT_CAP_IE_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending set vht ie cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_set_quiet_mode_cmd_tlv() - send set quiet mode command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to quiet mode params
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_set_quiet_mode_cmd_tlv(wmi_unified_t wmi_handle,
- struct set_quiet_mode_params *param)
- {
- wmi_pdev_set_quiet_cmd_fixed_param *quiet_cmd;
- wmi_buf_t buf;
- QDF_STATUS ret;
- int32_t len;
- len = sizeof(*quiet_cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- quiet_cmd = (wmi_pdev_set_quiet_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&quiet_cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_set_quiet_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_pdev_set_quiet_cmd_fixed_param));
- quiet_cmd = (wmi_pdev_set_quiet_cmd_fixed_param *)wmi_buf_data(buf);
- quiet_cmd->enabled = param->enabled;
- quiet_cmd->period = (param->period)*(param->intval);
- quiet_cmd->duration = param->duration;
- quiet_cmd->next_start = param->offset;
- quiet_cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- WMI_HOST_PDEV_ID_SOC);
- wmi_mtrace(WMI_PDEV_SET_QUIET_MODE_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_SET_QUIET_MODE_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending set quiet cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_set_bcn_offload_quiet_mode_cmd_tlv() - send set quiet mode command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to quiet mode params in bcn offload mode
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_set_bcn_offload_quiet_mode_cmd_tlv(wmi_unified_t wmi_handle,
- struct set_bcn_offload_quiet_mode_params *param)
- {
- wmi_vdev_bcn_offload_quiet_config_cmd_fixed_param *quiet_cmd;
- wmi_buf_t buf;
- QDF_STATUS ret;
- int32_t len;
- len = sizeof(*quiet_cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- quiet_cmd = (wmi_vdev_bcn_offload_quiet_config_cmd_fixed_param *)
- wmi_buf_data(buf);
- WMITLV_SET_HDR(&quiet_cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_vdev_bcn_offload_quiet_config_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_vdev_bcn_offload_quiet_config_cmd_fixed_param));
- quiet_cmd = (wmi_vdev_bcn_offload_quiet_config_cmd_fixed_param *)
- wmi_buf_data(buf);
- quiet_cmd->vdev_id = param->vdev_id;
- quiet_cmd->period = param->period;
- quiet_cmd->duration = param->duration;
- quiet_cmd->next_start = param->next_start;
- quiet_cmd->flags = param->flag;
- wmi_mtrace(WMI_VDEV_BCN_OFFLOAD_QUIET_CONFIG_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_VDEV_BCN_OFFLOAD_QUIET_CONFIG_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending set quiet cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_bcn_offload_control_cmd_tlv - send beacon ofload control cmd to fw
- * @wmi_handle: wmi handle
- * @bcn_ctrl_param: pointer to bcn_offload_control param
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static
- QDF_STATUS send_bcn_offload_control_cmd_tlv(wmi_unified_t wmi_handle,
- struct bcn_offload_control *bcn_ctrl_param)
- {
- wmi_buf_t buf;
- wmi_bcn_offload_ctrl_cmd_fixed_param *cmd;
- QDF_STATUS ret;
- uint32_t len;
- len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- qdf_print("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_bcn_offload_ctrl_cmd_fixed_param *) wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_bcn_offload_ctrl_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_bcn_offload_ctrl_cmd_fixed_param));
- cmd->vdev_id = bcn_ctrl_param->vdev_id;
- switch (bcn_ctrl_param->bcn_ctrl_op) {
- case BCN_OFFLD_CTRL_TX_DISABLE:
- cmd->bcn_ctrl_op = WMI_BEACON_CTRL_TX_DISABLE;
- break;
- case BCN_OFFLD_CTRL_TX_ENABLE:
- cmd->bcn_ctrl_op = WMI_BEACON_CTRL_TX_ENABLE;
- break;
- case BCN_OFFLD_CTRL_SWBA_DISABLE:
- cmd->bcn_ctrl_op = WMI_BEACON_CTRL_SWBA_EVENT_DISABLE;
- break;
- case BCN_OFFLD_CTRL_SWBA_ENABLE:
- cmd->bcn_ctrl_op = WMI_BEACON_CTRL_SWBA_EVENT_ENABLE;
- break;
- default:
- WMI_LOGE("WMI_BCN_OFFLOAD_CTRL_CMDID unknown CTRL Operation %d",
- bcn_ctrl_param->bcn_ctrl_op);
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- break;
- }
- wmi_mtrace(WMI_BCN_OFFLOAD_CTRL_CMDID, cmd->vdev_id, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_BCN_OFFLOAD_CTRL_CMDID);
- if (QDF_IS_STATUS_ERROR(ret)) {
- WMI_LOGE("WMI_BCN_OFFLOAD_CTRL_CMDID send returned Error %d",
- ret);
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * extract_swba_num_vdevs_tlv() - extract swba num vdevs from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param num_vdevs: Pointer to hold num vdevs
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_swba_num_vdevs_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, uint32_t *num_vdevs)
- {
- WMI_HOST_SWBA_EVENTID_param_tlvs *param_buf;
- wmi_host_swba_event_fixed_param *swba_event;
- uint32_t vdev_map;
- param_buf = (WMI_HOST_SWBA_EVENTID_param_tlvs *) evt_buf;
- if (!param_buf) {
- WMI_LOGE("Invalid swba event buffer");
- return QDF_STATUS_E_INVAL;
- }
- swba_event = param_buf->fixed_param;
- *num_vdevs = swba_event->num_vdevs;
- if (!(*num_vdevs)) {
- vdev_map = swba_event->vdev_map;
- *num_vdevs = wmi_vdev_map_to_num_vdevs(vdev_map);
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_swba_tim_info_tlv() - extract swba tim info from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param idx: Index to bcn info
- * @param tim_info: Pointer to hold tim info
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_swba_tim_info_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, uint32_t idx, wmi_host_tim_info *tim_info)
- {
- WMI_HOST_SWBA_EVENTID_param_tlvs *param_buf;
- wmi_tim_info *tim_info_ev;
- param_buf = (WMI_HOST_SWBA_EVENTID_param_tlvs *) evt_buf;
- if (!param_buf) {
- WMI_LOGE("Invalid swba event buffer");
- return QDF_STATUS_E_INVAL;
- }
- tim_info_ev = ¶m_buf->tim_info[idx];
- if (tim_info_ev->tim_len != 0) {
- tim_info->tim_len = tim_info_ev->tim_len;
- tim_info->tim_mcast = tim_info_ev->tim_mcast;
- qdf_mem_copy(tim_info->tim_bitmap, tim_info_ev->tim_bitmap,
- (sizeof(uint32_t) * WMI_TIM_BITMAP_ARRAY_SIZE));
- tim_info->tim_changed = tim_info_ev->tim_changed;
- tim_info->tim_num_ps_pending = tim_info_ev->tim_num_ps_pending;
- tim_info->vdev_id = tim_info_ev->vdev_id;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_swba_noa_info_tlv() - extract swba NoA information from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param idx: Index to bcn info
- * @param p2p_desc: Pointer to hold p2p NoA info
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_swba_noa_info_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, uint32_t idx, wmi_host_p2p_noa_info *p2p_desc)
- {
- WMI_HOST_SWBA_EVENTID_param_tlvs *param_buf;
- wmi_p2p_noa_info *p2p_noa_info;
- uint8_t i = 0;
- param_buf = (WMI_HOST_SWBA_EVENTID_param_tlvs *) evt_buf;
- if (!param_buf) {
- WMI_LOGE("Invalid swba event buffer");
- return QDF_STATUS_E_INVAL;
- }
- p2p_noa_info = ¶m_buf->p2p_noa_info[idx];
- p2p_desc->modified = false;
- p2p_desc->num_descriptors = 0;
- if (WMI_UNIFIED_NOA_ATTR_IS_MODIFIED(p2p_noa_info)) {
- p2p_desc->modified = true;
- p2p_desc->index =
- (uint8_t) WMI_UNIFIED_NOA_ATTR_INDEX_GET(p2p_noa_info);
- p2p_desc->oppPS =
- (uint8_t) WMI_UNIFIED_NOA_ATTR_OPP_PS_GET(p2p_noa_info);
- p2p_desc->ctwindow =
- (uint8_t) WMI_UNIFIED_NOA_ATTR_CTWIN_GET(p2p_noa_info);
- p2p_desc->num_descriptors =
- (uint8_t) WMI_UNIFIED_NOA_ATTR_NUM_DESC_GET
- (p2p_noa_info);
- for (i = 0; i < p2p_desc->num_descriptors; i++) {
- p2p_desc->noa_descriptors[i].type_count =
- (uint8_t) p2p_noa_info->noa_descriptors[i].
- type_count;
- p2p_desc->noa_descriptors[i].duration =
- p2p_noa_info->noa_descriptors[i].duration;
- p2p_desc->noa_descriptors[i].interval =
- p2p_noa_info->noa_descriptors[i].interval;
- p2p_desc->noa_descriptors[i].start_time =
- p2p_noa_info->noa_descriptors[i].start_time;
- }
- p2p_desc->vdev_id = p2p_noa_info->vdev_id;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_swba_quiet_info_tlv() - extract swba quiet info from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param idx: Index to bcn info
- * @param quiet_info: Pointer to hold quiet info
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_swba_quiet_info_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, uint32_t idx,
- wmi_host_quiet_info *quiet_info)
- {
- WMI_HOST_SWBA_EVENTID_param_tlvs *param_buf;
- wmi_quiet_offload_info *quiet_info_ev;
- param_buf = (WMI_HOST_SWBA_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- WMI_LOGE("Invalid swba event buffer");
- return QDF_STATUS_E_INVAL;
- }
- if (!param_buf->quiet_offload_info)
- return QDF_STATUS_E_NULL_VALUE;
- quiet_info_ev = ¶m_buf->quiet_offload_info[idx];
- if (quiet_info_ev->tbttcount != 0) {
- quiet_info->vdev_id = quiet_info_ev->vdev_id;
- quiet_info->tbttcount = quiet_info_ev->tbttcount;
- quiet_info->period = quiet_info_ev->period;
- quiet_info->duration = quiet_info_ev->duration;
- quiet_info->offset = quiet_info_ev->offset;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_offchan_data_tx_compl_param_tlv() -
- * extract Offchan data tx completion event params
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold offchan data TX completion params
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_offchan_data_tx_compl_param_tlv(
- wmi_unified_t wmi_handle, void *evt_buf,
- struct wmi_host_offchan_data_tx_compl_event *param)
- {
- WMI_OFFCHAN_DATA_TX_COMPLETION_EVENTID_param_tlvs *param_buf;
- wmi_offchan_data_tx_compl_event_fixed_param *cmpl_params;
- param_buf = (WMI_OFFCHAN_DATA_TX_COMPLETION_EVENTID_param_tlvs *)
- evt_buf;
- if (!param_buf) {
- WMI_LOGE("%s: Invalid offchan data Tx compl event", __func__);
- return QDF_STATUS_E_INVAL;
- }
- cmpl_params = param_buf->fixed_param;
- param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- cmpl_params->pdev_id);
- param->desc_id = cmpl_params->desc_id;
- param->status = cmpl_params->status;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_pdev_csa_switch_count_status_tlv() - extract pdev csa switch count
- * status tlv
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold csa switch count status event param
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_pdev_csa_switch_count_status_tlv(
- wmi_unified_t wmi_handle,
- void *evt_buf,
- struct pdev_csa_switch_count_status *param)
- {
- WMI_PDEV_CSA_SWITCH_COUNT_STATUS_EVENTID_param_tlvs *param_buf;
- wmi_pdev_csa_switch_count_status_event_fixed_param *csa_status;
- param_buf = (WMI_PDEV_CSA_SWITCH_COUNT_STATUS_EVENTID_param_tlvs *)
- evt_buf;
- if (!param_buf) {
- WMI_LOGE("%s: Invalid CSA status event", __func__);
- return QDF_STATUS_E_INVAL;
- }
- csa_status = param_buf->fixed_param;
- param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- csa_status->pdev_id);
- param->current_switch_count = csa_status->current_switch_count;
- param->num_vdevs = csa_status->num_vdevs;
- param->vdev_ids = param_buf->vdev_ids;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_pdev_tpc_config_ev_param_tlv() - extract pdev tpc configuration
- * param from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold tpc configuration
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS extract_pdev_tpc_config_ev_param_tlv(wmi_unified_t wmi_handle,
- void *evt_buf,
- wmi_host_pdev_tpc_config_event *param)
- {
- wmi_pdev_tpc_config_event_fixed_param *event =
- (wmi_pdev_tpc_config_event_fixed_param *)evt_buf;
- if (!event) {
- WMI_LOGE("Invalid event buffer");
- return QDF_STATUS_E_INVAL;
- }
- param->pdev_id = event->pdev_id;
- param->regDomain = event->regDomain;
- param->chanFreq = event->chanFreq;
- param->phyMode = event->phyMode;
- param->twiceAntennaReduction = event->twiceAntennaReduction;
- param->twiceAntennaGain = event->twiceAntennaGain;
- param->twiceMaxRDPower = event->twiceMaxRDPower;
- param->powerLimit = event->powerLimit;
- param->rateMax = event->rateMax;
- param->numTxChain = event->numTxChain;
- param->ctl = event->ctl;
- param->flags = event->flags;
- qdf_mem_copy(param->maxRegAllowedPower, event->maxRegAllowedPower,
- sizeof(param->maxRegAllowedPower));
- qdf_mem_copy(param->maxRegAllowedPowerAGCDD,
- event->maxRegAllowedPowerAGCDD,
- sizeof(param->maxRegAllowedPowerAGCDD));
- qdf_mem_copy(param->maxRegAllowedPowerAGSTBC,
- event->maxRegAllowedPowerAGSTBC,
- sizeof(param->maxRegAllowedPowerAGSTBC));
- qdf_mem_copy(param->maxRegAllowedPowerAGTXBF,
- event->maxRegAllowedPowerAGTXBF,
- sizeof(param->maxRegAllowedPowerAGTXBF));
- WMI_LOGD("%s:extract success", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_peer_sta_kickout_ev_tlv() - extract peer sta kickout event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param ev: Pointer to hold peer param
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_peer_sta_kickout_ev_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, wmi_host_peer_sta_kickout_event *ev)
- {
- WMI_PEER_STA_KICKOUT_EVENTID_param_tlvs *param_buf = NULL;
- wmi_peer_sta_kickout_event_fixed_param *kickout_event = NULL;
- param_buf = (WMI_PEER_STA_KICKOUT_EVENTID_param_tlvs *) evt_buf;
- kickout_event = param_buf->fixed_param;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&kickout_event->peer_macaddr,
- ev->peer_macaddr);
- ev->reason = kickout_event->reason;
- ev->rssi = kickout_event->rssi;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_multiple_vdev_restart_req_cmd_tlv() - send multiple vdev restart req
- * @wmi_handle: wmi handle
- * @param: wmi multiple vdev restart req param
- *
- * Send WMI_PDEV_MULTIPLE_VDEV_RESTART_REQUEST_CMDID parameters to fw.
- *
- * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error
- */
- static QDF_STATUS send_multiple_vdev_restart_req_cmd_tlv(
- wmi_unified_t wmi_handle,
- struct multiple_vdev_restart_params *param)
- {
- wmi_buf_t buf;
- QDF_STATUS qdf_status;
- wmi_pdev_multiple_vdev_restart_request_cmd_fixed_param *cmd;
- int i;
- uint8_t *buf_ptr;
- uint32_t *vdev_ids, *phymode;
- wmi_channel *chan_info;
- struct mlme_channel_param *tchan_info;
- uint16_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE;
- if (!param->num_vdevs) {
- WMI_LOGE("vdev's not found for MVR cmd");
- qdf_status = QDF_STATUS_E_FAULT;
- goto end;
- }
- len += sizeof(wmi_channel);
- if (param->num_vdevs) {
- len += sizeof(uint32_t) * param->num_vdevs + WMI_TLV_HDR_SIZE;
- /* for phymode */
- len += sizeof(uint32_t) * param->num_vdevs;
- }
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("Failed to allocate memory");
- qdf_status = QDF_STATUS_E_NOMEM;
- goto end;
- }
- buf_ptr = (uint8_t *)wmi_buf_data(buf);
- cmd = (wmi_pdev_multiple_vdev_restart_request_cmd_fixed_param *)
- buf_ptr;
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_multiple_vdev_restart_request_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_pdev_multiple_vdev_restart_request_cmd_fixed_param));
- cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(
- wmi_handle,
- param->pdev_id);
- cmd->requestor_id = param->requestor_id;
- cmd->disable_hw_ack = param->disable_hw_ack;
- cmd->cac_duration_ms = param->cac_duration_ms;
- cmd->num_vdevs = param->num_vdevs;
- WMI_LOGI("%s:cmd->pdev_id: %d ,cmd->requestor_id: %d ,"
- "cmd->disable_hw_ack: %d , cmd->cac_duration_ms:%d ,"
- " cmd->num_vdevs: %d ",
- __func__, cmd->pdev_id, cmd->requestor_id,
- cmd->disable_hw_ack, cmd->cac_duration_ms, cmd->num_vdevs);
- buf_ptr += sizeof(*cmd);
- WMITLV_SET_HDR(buf_ptr,
- WMITLV_TAG_ARRAY_UINT32,
- sizeof(uint32_t) * param->num_vdevs);
- vdev_ids = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
- for (i = 0; i < param->num_vdevs; i++)
- vdev_ids[i] = param->vdev_ids[i];
- buf_ptr += (sizeof(uint32_t) * param->num_vdevs) + WMI_TLV_HDR_SIZE;
- WMITLV_SET_HDR(buf_ptr,
- WMITLV_TAG_STRUC_wmi_channel,
- WMITLV_GET_STRUCT_TLVLEN(wmi_channel));
- chan_info = (wmi_channel *)buf_ptr;
- tchan_info = &(param->ch_param);
- chan_info->mhz = tchan_info->mhz;
- chan_info->band_center_freq1 = tchan_info->cfreq1;
- chan_info->band_center_freq2 = tchan_info->cfreq2;
- if (tchan_info->is_chan_passive)
- WMI_SET_CHANNEL_FLAG(chan_info,
- WMI_CHAN_FLAG_PASSIVE);
- if (tchan_info->dfs_set)
- WMI_SET_CHANNEL_FLAG(chan_info, WMI_CHAN_FLAG_DFS);
- if (tchan_info->dfs_set_cfreq2)
- WMI_SET_CHANNEL_FLAG(chan_info, WMI_CHAN_FLAG_DFS_CFREQ2);
- if (tchan_info->allow_vht)
- WMI_SET_CHANNEL_FLAG(chan_info,
- WMI_CHAN_FLAG_ALLOW_VHT);
- else if (tchan_info->allow_ht)
- WMI_SET_CHANNEL_FLAG(chan_info,
- WMI_CHAN_FLAG_ALLOW_HT);
- WMI_SET_CHANNEL_MODE(chan_info, tchan_info->phy_mode);
- WMI_SET_CHANNEL_MIN_POWER(chan_info, tchan_info->minpower);
- WMI_SET_CHANNEL_MAX_POWER(chan_info, tchan_info->maxpower);
- WMI_SET_CHANNEL_REG_POWER(chan_info, tchan_info->maxregpower);
- WMI_SET_CHANNEL_ANTENNA_MAX(chan_info, tchan_info->antennamax);
- WMI_SET_CHANNEL_REG_CLASSID(chan_info, tchan_info->reg_class_id);
- WMI_SET_CHANNEL_MAX_TX_POWER(chan_info, tchan_info->maxregpower);
- WMI_LOGI("%s:tchan_info->is_chan_passive: %d ,"
- "tchan_info->dfs_set : %d ,tchan_info->allow_vht:%d ,"
- "tchan_info->allow_ht: %d ,tchan_info->antennamax: %d ,"
- "tchan_info->phy_mode: %d ,tchan_info->minpower: %d,"
- "tchan_info->maxpower: %d ,tchan_info->maxregpower: %d ,"
- "tchan_info->reg_class_id: %d ,"
- "tchan_info->maxregpower : %d ", __func__,
- tchan_info->is_chan_passive, tchan_info->dfs_set,
- tchan_info->allow_vht, tchan_info->allow_ht,
- tchan_info->antennamax, tchan_info->phy_mode,
- tchan_info->minpower, tchan_info->maxpower,
- tchan_info->maxregpower, tchan_info->reg_class_id,
- tchan_info->maxregpower);
- buf_ptr += sizeof(*chan_info);
- WMITLV_SET_HDR(buf_ptr,
- WMITLV_TAG_ARRAY_UINT32,
- sizeof(uint32_t) * param->num_vdevs);
- phymode = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
- for (i = 0; i < param->num_vdevs; i++)
- WMI_MULTIPLE_VDEV_RESTART_FLAG_SET_PHYMODE(
- phymode[i], param->mvr_param[i].phymode);
- /* Target expects flag for phymode processing */
- WMI_MULTIPLE_VDEV_RESTART_FLAG_SET_PHYMODE_PRESENT(cmd->flags, 1);
- /*
- * Target expects to be informed that MVR response is
- * expected by host corresponding to this request.
- */
- WMI_MULTIPLE_VDEV_RESTART_FLAG_SET_MVRR_EVENT_SUPPORT(cmd->flags, 1);
- wmi_mtrace(WMI_PDEV_MULTIPLE_VDEV_RESTART_REQUEST_CMDID, NO_SESSION, 0);
- qdf_status = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_MULTIPLE_VDEV_RESTART_REQUEST_CMDID);
- if (QDF_IS_STATUS_ERROR(qdf_status)) {
- WMI_LOGE("%s: Failed to send", __func__);
- wmi_buf_free(buf);
- }
- end:
- return qdf_status;
- }
- /**
- * extract_dcs_interference_type_tlv() - extract dcs interference type
- * from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold dcs interference param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS extract_dcs_interference_type_tlv(
- wmi_unified_t wmi_handle,
- void *evt_buf, struct wmi_host_dcs_interference_param *param)
- {
- WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *param_buf;
- param_buf = (WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *) evt_buf;
- if (!param_buf)
- return QDF_STATUS_E_INVAL;
- param->interference_type = param_buf->fixed_param->interference_type;
- param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- param_buf->fixed_param->pdev_id);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * extract_dcs_cw_int_tlv() - extract dcs cw interference from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param cw_int: Pointer to hold cw interference
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS extract_dcs_cw_int_tlv(wmi_unified_t wmi_handle,
- void *evt_buf,
- wmi_host_ath_dcs_cw_int *cw_int)
- {
- WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *param_buf;
- wlan_dcs_cw_int *ev;
- param_buf = (WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *) evt_buf;
- if (!param_buf)
- return QDF_STATUS_E_INVAL;
- ev = param_buf->cw_int;
- cw_int->channel = ev->channel;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_dcs_im_tgt_stats_tlv() - extract dcs im target stats from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param wlan_stat: Pointer to hold wlan stats
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS extract_dcs_im_tgt_stats_tlv(wmi_unified_t wmi_handle,
- void *evt_buf,
- wmi_host_dcs_im_tgt_stats_t *wlan_stat)
- {
- WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *param_buf;
- wlan_dcs_im_tgt_stats_t *ev;
- param_buf = (WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *) evt_buf;
- if (!param_buf)
- return QDF_STATUS_E_INVAL;
- ev = param_buf->wlan_stat;
- wlan_stat->reg_tsf32 = ev->reg_tsf32;
- wlan_stat->last_ack_rssi = ev->last_ack_rssi;
- wlan_stat->tx_waste_time = ev->tx_waste_time;
- wlan_stat->rx_time = ev->rx_time;
- wlan_stat->phyerr_cnt = ev->phyerr_cnt;
- wlan_stat->mib_stats.listen_time = ev->listen_time;
- wlan_stat->mib_stats.reg_tx_frame_cnt = ev->reg_tx_frame_cnt;
- wlan_stat->mib_stats.reg_rx_frame_cnt = ev->reg_rx_frame_cnt;
- wlan_stat->mib_stats.reg_rxclr_cnt = ev->reg_rxclr_cnt;
- wlan_stat->mib_stats.reg_cycle_cnt = ev->reg_cycle_cnt;
- wlan_stat->mib_stats.reg_rxclr_ext_cnt = ev->reg_rxclr_ext_cnt;
- wlan_stat->mib_stats.reg_ofdm_phyerr_cnt = ev->reg_ofdm_phyerr_cnt;
- wlan_stat->mib_stats.reg_cck_phyerr_cnt = ev->reg_cck_phyerr_cnt;
- wlan_stat->chan_nf = ev->chan_nf;
- wlan_stat->my_bss_rx_cycle_count = ev->my_bss_rx_cycle_count;
- return QDF_STATUS_SUCCESS;
- }
- /*
- * extract_peer_delete_response_event_tlv() - extract peer delete response event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param vdev_id: Pointer to hold vdev_id
- * @param mac_addr: Pointer to hold peer mac address
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_peer_delete_response_event_tlv(wmi_unified_t wmi_hdl,
- void *evt_buf, struct wmi_host_peer_delete_response_event *param)
- {
- WMI_PEER_DELETE_RESP_EVENTID_param_tlvs *param_buf;
- wmi_peer_delete_resp_event_fixed_param *ev;
- param_buf = (WMI_PEER_DELETE_RESP_EVENTID_param_tlvs *)evt_buf;
- ev = (wmi_peer_delete_resp_event_fixed_param *) param_buf->fixed_param;
- if (!ev) {
- WMI_LOGE("%s: Invalid peer_delete response", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- param->vdev_id = ev->vdev_id;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->peer_macaddr,
- ¶m->mac_address.bytes[0]);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_pdev_tpc_ev_param_tlv() - extract tpc param from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold tpc param
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS extract_pdev_tpc_ev_param_tlv(wmi_unified_t wmi_handle,
- void *evt_buf,
- wmi_host_pdev_tpc_event *param)
- {
- WMI_PDEV_TPC_EVENTID_param_tlvs *param_buf;
- wmi_pdev_tpc_event_fixed_param *event;
- param_buf = (WMI_PDEV_TPC_EVENTID_param_tlvs *)evt_buf;
- event = (wmi_pdev_tpc_event_fixed_param *)param_buf->fixed_param;
- param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- event->pdev_id);
- qdf_mem_copy(param->tpc, param_buf->tpc, sizeof(param->tpc));
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_nfcal_power_ev_param_tlv() - extract noise floor calibration
- * power param from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold nf cal power param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- extract_nfcal_power_ev_param_tlv(wmi_unified_t wmi_handle,
- void *evt_buf,
- wmi_host_pdev_nfcal_power_all_channels_event *param)
- {
- WMI_PDEV_NFCAL_POWER_ALL_CHANNELS_EVENTID_param_tlvs *param_buf;
- wmi_pdev_nfcal_power_all_channels_event_fixed_param *event;
- wmi_pdev_nfcal_power_all_channels_nfdBr *ch_nfdbr;
- wmi_pdev_nfcal_power_all_channels_nfdBm *ch_nfdbm;
- wmi_pdev_nfcal_power_all_channels_freqNum *ch_freqnum;
- uint32_t i;
- param_buf =
- (WMI_PDEV_NFCAL_POWER_ALL_CHANNELS_EVENTID_param_tlvs *)evt_buf;
- event = param_buf->fixed_param;
- ch_nfdbr = param_buf->nfdbr;
- ch_nfdbm = param_buf->nfdbm;
- ch_freqnum = param_buf->freqnum;
- WMI_LOGD("pdev_id[%x], num_nfdbr[%d], num_nfdbm[%d] num_freqnum[%d]",
- event->pdev_id, param_buf->num_nfdbr,
- param_buf->num_nfdbm, param_buf->num_freqnum);
- if (param_buf->num_nfdbr >
- WMI_HOST_RXG_CAL_CHAN_MAX * WMI_HOST_MAX_NUM_CHAINS) {
- WMI_LOGE("invalid number of nfdBr");
- return QDF_STATUS_E_FAILURE;
- }
- if (param_buf->num_nfdbm >
- WMI_HOST_RXG_CAL_CHAN_MAX * WMI_HOST_MAX_NUM_CHAINS) {
- WMI_LOGE("invalid number of nfdBm");
- return QDF_STATUS_E_FAILURE;
- }
- if (param_buf->num_freqnum > WMI_HOST_RXG_CAL_CHAN_MAX) {
- WMI_LOGE("invalid number of freqNum");
- return QDF_STATUS_E_FAILURE;
- }
- for (i = 0; i < param_buf->num_nfdbr; i++) {
- param->nfdbr[i] = (int8_t)ch_nfdbr->nfdBr;
- param->nfdbm[i] = (int8_t)ch_nfdbm->nfdBm;
- ch_nfdbr++;
- ch_nfdbm++;
- }
- for (i = 0; i < param_buf->num_freqnum; i++) {
- param->freqnum[i] = ch_freqnum->freqNum;
- ch_freqnum++;
- }
- param->pdev_id = wmi_handle->ops->
- convert_pdev_id_target_to_host(wmi_handle,
- event->pdev_id);
- return QDF_STATUS_SUCCESS;
- }
- #ifdef BIG_ENDIAN_HOST
- /**
- * wds_addr_ev_conv_data_be() - LE to BE conversion of wds addr event
- * @param data_len - data length
- * @param data - pointer to data
- *
- * Return: QDF_STATUS - success or error status
- */
- static QDF_STATUS wds_addr_ev_conv_data_be(uint16_t data_len, uint8_t *ev)
- {
- uint8_t *datap = (uint8_t *)ev;
- int i;
- /* Skip swapping the first word */
- datap += sizeof(uint32_t);
- for (i = 0; i < ((data_len / sizeof(uint32_t))-1);
- i++, datap += sizeof(uint32_t)) {
- *(uint32_t *)datap = qdf_le32_to_cpu(*(uint32_t *)datap);
- }
- return QDF_STATUS_SUCCESS;
- }
- #else
- /**
- * wds_addr_ev_conv_data_be() - Dummy operation for LE platforms
- * @param data_len - data length
- * @param data - pointer to data
- *
- * Return: QDF_STATUS - success or error status
- */
- static QDF_STATUS wds_addr_ev_conv_data_be(uint32_t data_len, uint8_t *ev)
- {
- return QDF_STATUS_SUCCESS;
- }
- #endif
- /**
- * extract_wds_addr_event_tlv() - extract wds address from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param wds_ev: Pointer to hold wds address
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS extract_wds_addr_event_tlv(wmi_unified_t wmi_handle,
- void *evt_buf,
- uint16_t len, wds_addr_event_t *wds_ev)
- {
- WMI_WDS_PEER_EVENTID_param_tlvs *param_buf;
- wmi_wds_addr_event_fixed_param *ev;
- int i;
- param_buf = (WMI_WDS_PEER_EVENTID_param_tlvs *)evt_buf;
- ev = (wmi_wds_addr_event_fixed_param *)param_buf->fixed_param;
- if (wds_addr_ev_conv_data_be(len, (uint8_t *)ev) != QDF_STATUS_SUCCESS)
- return QDF_STATUS_E_FAILURE;
- qdf_mem_copy(wds_ev->event_type, ev->event_type,
- sizeof(wds_ev->event_type));
- for (i = 0; i < 4; i++) {
- wds_ev->peer_mac[i] =
- ((u_int8_t *)&(ev->peer_mac.mac_addr31to0))[i];
- wds_ev->dest_mac[i] =
- ((u_int8_t *)&(ev->dest_mac.mac_addr31to0))[i];
- }
- for (i = 0; i < 2; i++) {
- wds_ev->peer_mac[4+i] =
- ((u_int8_t *)&(ev->peer_mac.mac_addr47to32))[i];
- wds_ev->dest_mac[4+i] =
- ((u_int8_t *)&(ev->dest_mac.mac_addr47to32))[i];
- }
- wds_ev->vdev_id = ev->vdev_id;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_peer_sta_ps_statechange_ev_tlv() - extract peer sta ps state
- * from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param ev: Pointer to hold peer param and ps state
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS extract_peer_sta_ps_statechange_ev_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, wmi_host_peer_sta_ps_statechange_event *ev)
- {
- WMI_PEER_STA_PS_STATECHG_EVENTID_param_tlvs *param_buf;
- wmi_peer_sta_ps_statechange_event_fixed_param *event;
- param_buf = (WMI_PEER_STA_PS_STATECHG_EVENTID_param_tlvs *)evt_buf;
- event = (wmi_peer_sta_ps_statechange_event_fixed_param *)
- param_buf->fixed_param;
- WMI_MAC_ADDR_TO_CHAR_ARRAY(&event->peer_macaddr, ev->peer_macaddr);
- ev->peer_ps_state = event->peer_ps_state;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_inst_rssi_stats_event_tlv() - extract inst rssi stats from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param inst_rssi_resp: Pointer to hold inst rssi response
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS extract_inst_rssi_stats_event_tlv(
- wmi_unified_t wmi_handle, void *evt_buf,
- wmi_host_inst_stats_resp *inst_rssi_resp)
- {
- WMI_INST_RSSI_STATS_EVENTID_param_tlvs *param_buf;
- wmi_inst_rssi_stats_resp_fixed_param *event;
- param_buf = (WMI_INST_RSSI_STATS_EVENTID_param_tlvs *)evt_buf;
- event = (wmi_inst_rssi_stats_resp_fixed_param *)param_buf->fixed_param;
- qdf_mem_copy(&(inst_rssi_resp->peer_macaddr),
- &(event->peer_macaddr), sizeof(wmi_mac_addr));
- inst_rssi_resp->iRSSI = event->iRSSI;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_pdev_caldata_version_check_cmd_tlv() - send caldata check cmd to fw
- * @wmi_handle: wmi handle
- * @param: reserved param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_pdev_caldata_version_check_cmd_tlv(wmi_unified_t wmi_handle,
- uint32_t param)
- {
- wmi_pdev_check_cal_version_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- int32_t len = sizeof(wmi_pdev_check_cal_version_cmd_fixed_param);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- qdf_print("%s:wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_pdev_check_cal_version_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_check_cal_version_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_pdev_check_cal_version_cmd_fixed_param));
- cmd->pdev_id = param; /* set to 0x0 as expected from FW */
- wmi_mtrace(WMI_PDEV_CHECK_CAL_VERSION_CMDID, NO_SESSION, 0);
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_CHECK_CAL_VERSION_CMDID)) {
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_pdev_caldata_version_check_ev_param_tlv() - extract caldata from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold peer caldata version data
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS extract_pdev_caldata_version_check_ev_param_tlv(
- wmi_unified_t wmi_handle,
- void *evt_buf,
- wmi_host_pdev_check_cal_version_event *param)
- {
- WMI_PDEV_CHECK_CAL_VERSION_EVENTID_param_tlvs *param_tlvs;
- wmi_pdev_check_cal_version_event_fixed_param *event;
- param_tlvs = (WMI_PDEV_CHECK_CAL_VERSION_EVENTID_param_tlvs *) evt_buf;
- if (!param_tlvs) {
- WMI_LOGE("invalid cal version event buf");
- return QDF_STATUS_E_FAILURE;
- }
- event = param_tlvs->fixed_param;
- if (event->board_mcn_detail[WMI_BOARD_MCN_STRING_MAX_SIZE] != '\0')
- event->board_mcn_detail[WMI_BOARD_MCN_STRING_MAX_SIZE] = '\0';
- WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(param->board_mcn_detail,
- event->board_mcn_detail, WMI_BOARD_MCN_STRING_BUF_SIZE);
- param->software_cal_version = event->software_cal_version;
- param->board_cal_version = event->board_cal_version;
- param->cal_ok = event->cal_status;
- return QDF_STATUS_SUCCESS;
- }
- #ifdef WLAN_SUPPORT_RX_PROTOCOL_TYPE_TAG
- /**
- * set_rx_pkt_type_routing_tag_update_tlv() - add/delete protocol tag in CCE
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: pointer to protocol tag/routing struct
- *
- * @return:QDF_STATUS_SUCCESS for success or
- * QDF_STATUS_E_NOMEM/QDF_STATUS_E_FAILURE on failure
- */
- static QDF_STATUS set_rx_pkt_type_routing_tag_update_tlv(
- wmi_unified_t wmi_hdl,
- struct wmi_rx_pkt_protocol_routing_info *param)
- {
- wmi_pdev_update_pkt_routing_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- uint32_t len = sizeof(wmi_pdev_update_pkt_routing_cmd_fixed_param);
- buf = wmi_buf_alloc(wmi_hdl, len);
- if (!buf) {
- WMI_LOGE("%s : wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- cmd = (wmi_pdev_update_pkt_routing_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_update_pkt_routing_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_pdev_update_pkt_routing_cmd_fixed_param));
- cmd->pdev_id = param->pdev_id;
- cmd->op_code = (A_UINT32) param->op_code;
- cmd->routing_type_bitmap = param->routing_type_bitmap;
- cmd->dest_ring = param->dest_ring;
- cmd->meta_data = param->meta_data;
- cmd->dest_ring_handler = param->dest_ring_handler;
- WMI_LOGI("Set RX PKT ROUTING TYPE TAG - opcode: %u", param->op_code);
- WMI_LOGI("routing_bitmap: %u, dest_ring: %u",
- param->routing_type_bitmap, param->dest_ring);
- WMI_LOGI("dest_ring_handler: %u, meta_data: 0x%x",
- param->dest_ring_handler, param->meta_data);
- wmi_mtrace(WMI_PDEV_UPDATE_PKT_ROUTING_CMDID, cmd->pdev_id, 0);
- status = wmi_unified_cmd_send(wmi_hdl, buf, len,
- WMI_PDEV_UPDATE_PKT_ROUTING_CMDID);
- if (status != QDF_STATUS_SUCCESS) {
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- #endif /* WLAN_SUPPORT_RX_PROTOCOL_TYPE_TAG */
- /**
- * send_peer_vlan_config_cmd_tlv() - Send PEER vlan hw acceleration cmd to fw
- * @wmi: wmi handle
- * @peer_addr: peer mac addr
- * @param: struct peer_vlan_config_param *
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS send_peer_vlan_config_cmd_tlv(wmi_unified_t wmi,
- uint8_t peer_addr[QDF_MAC_ADDR_SIZE],
- struct peer_vlan_config_param *param)
- {
- wmi_peer_config_vlan_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- uint32_t len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi, len);
- if (!buf)
- return QDF_STATUS_E_NOMEM;
- cmd = (wmi_peer_config_vlan_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_peer_config_vlan_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_peer_config_vlan_cmd_fixed_param));
- WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr);
- /* vdev id */
- cmd->vdev_id = param->vdev_id;
- /* Tx command - Check if cmd is Tx then configure Tx cmd */
- if (param->tx_cmd) {
- WMI_VLAN_TX_SET(cmd->peer_vlan_config_mask, param->tx_cmd);
- /* Setting insert_or_strip bit for Tx */
- WMI_TX_INSERT_OR_STRIP_SET(cmd->peer_vlan_config_mask,
- param->tx_strip_insert);
- if (param->tx_strip_insert_inner && param->tx_strip_insert) {
- /* Setting the strip_insert_vlan_inner bit fo Tx */
- WMI_TX_STRIP_INSERT_VLAN_INNER_SET(cmd->peer_vlan_config_mask,
- param->tx_strip_insert_inner);
- /* If Insert inner tag bit is set, then fill inner_tci */
- WMI_TX_INSERT_VLAN_INNER_TCI_SET(cmd->insert_vlan_tci,
- param->insert_vlan_inner_tci);
- }
- if (param->tx_strip_insert_outer && param->tx_strip_insert) {
- /* Setting the strip_insert_vlan_outer bit fo Tx */
- WMI_TX_STRIP_INSERT_VLAN_OUTER_SET(cmd->peer_vlan_config_mask,
- param->tx_strip_insert_outer);
- /* If Insert outer tag bit is set, then fill outer_tci */
- WMI_TX_INSERT_VLAN_OUTER_TCI_SET(cmd->insert_vlan_tci,
- param->insert_vlan_outer_tci);
- }
- }
- /* Rx command - Check if cmd is Rx then configure Rx cmd */
- if (param->rx_cmd) {
- WMI_VLAN_RX_SET(cmd->peer_vlan_config_mask, param->rx_cmd);
- /* Setting the strip_vlan_c_tag_decap bit in RX */
- WMI_RX_STRIP_VLAN_C_TAG_SET(cmd->peer_vlan_config_mask,
- param->rx_strip_c_tag);
- /* Setting the strip_vlan_s_tag_decap bit in RX */
- WMI_RX_STRIP_VLAN_S_TAG_SET(cmd->peer_vlan_config_mask,
- param->rx_strip_s_tag);
- /* Setting the insert_vlan_c_tag_decap bit in RX */
- WMI_RX_INSERT_VLAN_C_TAG_SET(cmd->peer_vlan_config_mask,
- param->rx_insert_c_tag);
- /* Setting the insert_vlan_s_tag_decap bit in RX */
- WMI_RX_INSERT_VLAN_S_TAG_SET(cmd->peer_vlan_config_mask,
- param->rx_insert_s_tag);
- }
- if (wmi_unified_cmd_send(wmi, buf, len, WMI_PEER_CONFIG_VLAN_CMDID)) {
- WMI_LOGE("%s: Failed to send peer hw vlan acceleration command", __func__);
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- #ifdef WLAN_SUPPORT_FILS
- /**
- * send_vdev_fils_enable_cmd_tlv() - enable/Disable FD Frame command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to hold FILS discovery enable param
- *
- * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_FAILURE on failure
- */
- static QDF_STATUS
- send_vdev_fils_enable_cmd_tlv(wmi_unified_t wmi_handle,
- struct config_fils_params *param)
- {
- wmi_enable_fils_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS status;
- uint32_t len = sizeof(wmi_enable_fils_cmd_fixed_param);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s : wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- cmd = (wmi_enable_fils_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_enable_fils_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_enable_fils_cmd_fixed_param));
- cmd->vdev_id = param->vdev_id;
- cmd->fd_period = param->fd_period;
- cmd->flags = param->send_prb_rsp_frame;
- WMI_LOGI("Setting FD period to %d vdev id : %d",
- param->fd_period, param->vdev_id);
- wmi_mtrace(WMI_ENABLE_FILS_CMDID, cmd->vdev_id, 0);
- status = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_ENABLE_FILS_CMDID);
- if (status != QDF_STATUS_SUCCESS) {
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_swfda_vdev_id_tlv() - extract swfda vdev id from event
- * @wmi_handle: wmi handle
- * @evt_buf: pointer to event buffer
- * @vdev_id: pointer to hold vdev id
- *
- * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_INVAL on failure
- */
- static QDF_STATUS
- extract_swfda_vdev_id_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, uint32_t *vdev_id)
- {
- WMI_HOST_SWFDA_EVENTID_param_tlvs *param_buf;
- wmi_host_swfda_event_fixed_param *swfda_event;
- param_buf = (WMI_HOST_SWFDA_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- WMI_LOGE("Invalid swfda event buffer");
- return QDF_STATUS_E_INVAL;
- }
- swfda_event = param_buf->fixed_param;
- *vdev_id = swfda_event->vdev_id;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_fils_discovery_send_cmd_tlv() - WMI FILS Discovery send function
- * @wmi_handle: wmi handle
- * @param: pointer to hold FD send cmd parameter
- *
- * Return : QDF_STATUS_SUCCESS on success and QDF_STATUS_E_NOMEM on failure.
- */
- static QDF_STATUS
- send_fils_discovery_send_cmd_tlv(wmi_unified_t wmi_handle,
- struct fd_params *param)
- {
- QDF_STATUS ret;
- wmi_fd_send_from_host_cmd_fixed_param *cmd;
- wmi_buf_t wmi_buf;
- qdf_dma_addr_t dma_addr;
- wmi_buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
- if (!wmi_buf) {
- WMI_LOGE("%s : wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- cmd = (wmi_fd_send_from_host_cmd_fixed_param *)wmi_buf_data(wmi_buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_fd_send_from_host_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_fd_send_from_host_cmd_fixed_param));
- cmd->vdev_id = param->vdev_id;
- cmd->data_len = qdf_nbuf_len(param->wbuf);
- dma_addr = qdf_nbuf_get_frag_paddr(param->wbuf, 0);
- qdf_dmaaddr_to_32s(dma_addr, &cmd->frag_ptr_lo, &cmd->frag_ptr_hi);
- cmd->frame_ctrl = param->frame_ctrl;
- wmi_mtrace(WMI_PDEV_SEND_FD_CMDID, cmd->vdev_id, 0);
- ret = wmi_unified_cmd_send(wmi_handle, wmi_buf, sizeof(*cmd),
- WMI_PDEV_SEND_FD_CMDID);
- if (ret != QDF_STATUS_SUCCESS) {
- WMI_LOGE("%s: Failed to send fils discovery frame: %d",
- __func__, ret);
- wmi_buf_free(wmi_buf);
- }
- return ret;
- }
- #endif /* WLAN_SUPPORT_FILS */
- /**
- * send_set_qboost_param_cmd_tlv() - send set qboost command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to qboost params
- * @macaddr: vdev mac address
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS
- send_set_qboost_param_cmd_tlv(wmi_unified_t wmi_handle,
- uint8_t macaddr[QDF_MAC_ADDR_SIZE],
- struct set_qboost_params *param)
- {
- WMI_QBOOST_CFG_CMD_fixed_param *cmd;
- wmi_buf_t buf;
- int32_t len;
- QDF_STATUS ret;
- len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (WMI_QBOOST_CFG_CMD_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_WMI_QBOOST_CFG_CMD_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- WMI_QBOOST_CFG_CMD_fixed_param));
- cmd->vdev_id = param->vdev_id;
- WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
- cmd->qb_enable = param->value;
- wmi_mtrace(WMI_QBOOST_CFG_CMDID, cmd->vdev_id, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_QBOOST_CFG_CMDID);
- if (ret != 0) {
- WMI_LOGE("Setting qboost cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_gpio_config_cmd_tlv() - send gpio config to fw
- * @wmi_handle: wmi handle
- * @param: pointer to hold gpio config param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_gpio_config_cmd_tlv(wmi_unified_t wmi_handle,
- struct gpio_config_params *param)
- {
- wmi_gpio_config_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- int32_t len;
- QDF_STATUS ret;
- len = sizeof(*cmd);
- /* Sanity Checks */
- if (param->pull_type > WMI_GPIO_PULL_DOWN ||
- param->intr_mode > WMI_GPIO_INTTYPE_LEVEL_HIGH) {
- return QDF_STATUS_E_FAILURE;
- }
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_gpio_config_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_gpio_config_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_gpio_config_cmd_fixed_param));
- cmd->gpio_num = param->gpio_num;
- cmd->input = param->input;
- cmd->pull_type = param->pull_type;
- cmd->intr_mode = param->intr_mode;
- wmi_mtrace(WMI_GPIO_CONFIG_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_GPIO_CONFIG_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending GPIO config cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_gpio_output_cmd_tlv() - send gpio output to fw
- * @wmi_handle: wmi handle
- * @param: pointer to hold gpio output param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_gpio_output_cmd_tlv(wmi_unified_t wmi_handle,
- struct gpio_output_params *param)
- {
- wmi_gpio_output_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- int32_t len;
- QDF_STATUS ret;
- len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_gpio_output_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_gpio_output_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_gpio_output_cmd_fixed_param));
- cmd->gpio_num = param->gpio_num;
- cmd->set = param->set;
- wmi_mtrace(WMI_GPIO_OUTPUT_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
- WMI_GPIO_OUTPUT_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending GPIO output cmd failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_mcast_group_update_cmd_tlv() - send mcast group update cmd to fw
- * @wmi_handle: wmi handle
- * @param: pointer to hold mcast update param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_mcast_group_update_cmd_tlv(wmi_unified_t wmi_handle,
- struct mcast_group_update_params *param)
- {
- wmi_peer_mcast_group_cmd_fixed_param *cmd;
- wmi_buf_t buf;
- QDF_STATUS ret;
- int32_t len;
- int offset = 0;
- static char dummymask[4] = { 0xFF, 0xFF, 0xFF, 0xFF};
- len = sizeof(*cmd);
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_peer_mcast_group_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_peer_mcast_group_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_peer_mcast_group_cmd_fixed_param));
- /* confirm the buffer is 4-byte aligned */
- QDF_ASSERT((((size_t) cmd) & 0x3) == 0);
- qdf_mem_zero(cmd, sizeof(*cmd));
- cmd->vdev_id = param->vap_id;
- /* construct the message assuming our endianness matches the target */
- cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_ACTION_M &
- (param->action << WMI_PEER_MCAST_GROUP_FLAG_ACTION_S);
- cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_WILDCARD_M &
- (param->wildcard << WMI_PEER_MCAST_GROUP_FLAG_WILDCARD_S);
- if (param->is_action_delete)
- cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_DELETEALL_M;
- if (param->is_mcast_addr_len)
- cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_IPV6_M;
- if (param->is_filter_mode_snoop)
- cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_SRC_FILTER_EXCLUDE_M;
- /* unicast address spec only applies for non-wildcard cases */
- if (!param->wildcard && param->ucast_mac_addr) {
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param->ucast_mac_addr,
- &cmd->ucast_mac_addr);
- }
- if (param->mcast_ip_addr) {
- QDF_ASSERT(param->mcast_ip_addr_bytes <=
- sizeof(cmd->mcast_ip_addr));
- offset = sizeof(cmd->mcast_ip_addr) -
- param->mcast_ip_addr_bytes;
- qdf_mem_copy(((uint8_t *)&cmd->mcast_ip_addr) + offset,
- param->mcast_ip_addr,
- param->mcast_ip_addr_bytes);
- }
- if (!param->mask)
- param->mask = &dummymask[0];
- qdf_mem_copy(((uint8_t *)&cmd->mcast_ip_mask) + offset,
- param->mask,
- param->mcast_ip_addr_bytes);
- if (param->srcs && param->nsrcs) {
- cmd->num_filter_addr = param->nsrcs;
- QDF_ASSERT((param->nsrcs * param->mcast_ip_addr_bytes) <=
- sizeof(cmd->filter_addr));
- qdf_mem_copy(((uint8_t *) &cmd->filter_addr), param->srcs,
- param->nsrcs * param->mcast_ip_addr_bytes);
- }
- wmi_mtrace(WMI_PEER_MCAST_GROUP_CMDID, cmd->vdev_id, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PEER_MCAST_GROUP_CMDID);
- if (ret != QDF_STATUS_SUCCESS) {
- WMI_LOGE("%s : WMI Failed", __func__);
- wmi_buf_free(buf);
- }
- return ret;
- }
- /**
- * send_pdev_qvit_cmd_tlv() - send qvit command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to pdev_qvit_params
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_pdev_qvit_cmd_tlv(wmi_unified_t wmi_handle,
- struct pdev_qvit_params *param)
- {
- wmi_buf_t buf;
- QDF_STATUS ret = QDF_STATUS_E_INVAL;
- uint8_t *cmd;
- static uint8_t msgref = 1;
- uint8_t segnumber = 0, seginfo, numsegments;
- uint16_t chunk_len, total_bytes;
- uint8_t *bufpos;
- QVIT_SEG_HDR_INFO_STRUCT seghdrinfo;
- bufpos = param->utf_payload;
- total_bytes = param->len;
- ASSERT(total_bytes / MAX_WMI_QVIT_LEN ==
- (uint8_t) (total_bytes / MAX_WMI_QVIT_LEN));
- numsegments = (uint8_t) (total_bytes / MAX_WMI_QVIT_LEN);
- if (param->len - (numsegments * MAX_WMI_QVIT_LEN))
- numsegments++;
- while (param->len) {
- if (param->len > MAX_WMI_QVIT_LEN)
- chunk_len = MAX_WMI_QVIT_LEN; /* MAX message */
- else
- chunk_len = param->len;
- buf = wmi_buf_alloc(wmi_handle,
- (chunk_len + sizeof(seghdrinfo) +
- WMI_TLV_HDR_SIZE));
- if (!buf) {
- WMI_LOGE("%s:wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- cmd = (uint8_t *) wmi_buf_data(buf);
- seghdrinfo.len = total_bytes;
- seghdrinfo.msgref = msgref;
- seginfo = ((numsegments << 4) & 0xF0) | (segnumber & 0xF);
- seghdrinfo.segmentInfo = seginfo;
- segnumber++;
- WMITLV_SET_HDR(cmd, WMITLV_TAG_ARRAY_BYTE,
- (chunk_len + sizeof(seghdrinfo)));
- cmd += WMI_TLV_HDR_SIZE;
- qdf_mem_copy(cmd, &seghdrinfo, sizeof(seghdrinfo));
- qdf_mem_copy(&cmd[sizeof(seghdrinfo)], bufpos, chunk_len);
- wmi_mtrace(WMI_PDEV_QVIT_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf,
- (chunk_len + sizeof(seghdrinfo) +
- WMI_TLV_HDR_SIZE),
- WMI_PDEV_QVIT_CMDID);
- if (ret != 0) {
- WMI_LOGE("Failed to send WMI_PDEV_QVIT_CMDID command");
- wmi_buf_free(buf);
- break;
- }
- param->len -= chunk_len;
- bufpos += chunk_len;
- }
- msgref++;
- return ret;
- }
- /**
- * send_wmm_update_cmd_tlv() - send wmm update command to fw
- * @wmi_handle: wmi handle
- * @param: pointer to wmm update param
- *
- * Return: 0 for success or error code
- */
- static QDF_STATUS
- send_wmm_update_cmd_tlv(wmi_unified_t wmi_handle,
- struct wmm_update_params *param)
- {
- wmi_pdev_set_wmm_params_cmd_fixed_param *cmd;
- wmi_wmm_params *wmm_param;
- wmi_buf_t buf;
- QDF_STATUS ret;
- int32_t len;
- int ac = 0;
- struct wmi_host_wmeParams *wmep;
- uint8_t *buf_ptr;
- len = sizeof(*cmd) + (WME_NUM_AC * sizeof(*wmm_param));
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- buf_ptr = (uint8_t *) wmi_buf_data(buf);
- cmd = (wmi_pdev_set_wmm_params_cmd_fixed_param *) buf_ptr;
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_set_wmm_params_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN
- (wmi_pdev_set_wmm_params_cmd_fixed_param));
- cmd->reserved0 = WMI_HOST_PDEV_ID_SOC;
- buf_ptr += sizeof(wmi_pdev_set_wmm_params_cmd_fixed_param);
- for (ac = 0; ac < WME_NUM_AC; ac++) {
- wmep = ¶m->wmep_array[ac];
- wmm_param = (wmi_wmm_params *)buf_ptr;
- WMITLV_SET_HDR(&wmm_param->tlv_header,
- WMITLV_TAG_STRUC_wmi_wmm_params,
- WMITLV_GET_STRUCT_TLVLEN(wmi_wmm_params));
- wmm_param->aifs = wmep->wmep_aifsn;
- wmm_param->cwmin = ATH_EXPONENT_TO_VALUE(wmep->wmep_logcwmin);
- wmm_param->cwmax = ATH_EXPONENT_TO_VALUE(wmep->wmep_logcwmax);
- wmm_param->txoplimit = ATH_TXOP_TO_US(wmep->wmep_txopLimit);
- wmm_param->acm = wmep->wmep_acm;
- wmm_param->no_ack = wmep->wmep_noackPolicy;
- buf_ptr += sizeof(wmi_wmm_params);
- }
- wmi_mtrace(WMI_PDEV_SET_WMM_PARAMS_CMDID, NO_SESSION, 0);
- ret = wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PDEV_SET_WMM_PARAMS_CMDID);
- if (ret != 0) {
- WMI_LOGE("Sending WMM update CMD failed");
- wmi_buf_free(buf);
- }
- return ret;
- }
- #define WMI_TSF_SHIFT_UPPER 32
- #define WMI_TSF_MASK_UPPER_32 0xFFFFFFFF00000000
- /**
- * extract_mgmt_tx_compl_param_tlv() - extract MGMT tx completion event params
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param param: Pointer to hold MGMT TX completion params
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_mgmt_tx_compl_param_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, wmi_host_mgmt_tx_compl_event *param)
- {
- WMI_MGMT_TX_COMPLETION_EVENTID_param_tlvs *param_buf;
- wmi_mgmt_tx_compl_event_fixed_param *cmpl_params;
- param_buf = (WMI_MGMT_TX_COMPLETION_EVENTID_param_tlvs *)
- evt_buf;
- if (!param_buf) {
- WMI_LOGE("%s: Invalid mgmt Tx completion event", __func__);
- return QDF_STATUS_E_INVAL;
- }
- cmpl_params = param_buf->fixed_param;
- param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- cmpl_params->pdev_id);
- param->desc_id = cmpl_params->desc_id;
- param->status = cmpl_params->status;
- param->ppdu_id = cmpl_params->ppdu_id;
- param->retries_count = cmpl_params->retries_count;
- param->tx_tsf = cmpl_params->tx_tsf_u32;
- param->tx_tsf = ((param->tx_tsf << WMI_TSF_SHIFT_UPPER) &
- WMI_TSF_MASK_UPPER_32) |
- cmpl_params->tx_tsf_l32;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_chan_info_event_tlv() - extract chan information from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param chan_info: Pointer to hold chan information
- *
- * Return: QDF_STATUS_SUCCESS for success or error code
- */
- static QDF_STATUS extract_chan_info_event_tlv(wmi_unified_t wmi_handle,
- void *evt_buf, wmi_host_chan_info_event *chan_info)
- {
- WMI_CHAN_INFO_EVENTID_param_tlvs *param_buf;
- wmi_chan_info_event_fixed_param *ev;
- param_buf = (WMI_CHAN_INFO_EVENTID_param_tlvs *) evt_buf;
- ev = (wmi_chan_info_event_fixed_param *) param_buf->fixed_param;
- if (!ev) {
- WMI_LOGE("%s: Failed to allocmemory", __func__);
- return QDF_STATUS_E_FAILURE;
- }
- chan_info->err_code = ev->err_code;
- chan_info->freq = ev->freq;
- chan_info->cmd_flags = ev->cmd_flags;
- chan_info->noise_floor = ev->noise_floor;
- chan_info->rx_clear_count = ev->rx_clear_count;
- chan_info->cycle_count = ev->cycle_count;
- chan_info->tx_frame_cnt = ev->tx_frame_cnt;
- chan_info->mac_clk_mhz = ev->mac_clk_mhz;
- chan_info->pdev_id = wlan_get_pdev_id_from_vdev_id(
- (struct wlan_objmgr_psoc *)wmi_handle->soc->wmi_psoc,
- ev->vdev_id, WLAN_SCAN_ID);
- chan_info->chan_tx_pwr_range = ev->chan_tx_pwr_range;
- chan_info->chan_tx_pwr_tp = ev->chan_tx_pwr_tp;
- chan_info->my_bss_rx_cycle_count = ev->my_bss_rx_cycle_count;
- chan_info->rx_11b_mode_data_duration = ev->rx_11b_mode_data_duration;
- chan_info->tx_frame_cnt = ev->tx_frame_cnt;
- chan_info->rx_frame_count = ev->rx_frame_count;
- chan_info->mac_clk_mhz = ev->mac_clk_mhz;
- chan_info->vdev_id = ev->vdev_id;
- qdf_mem_copy(chan_info->per_chain_noise_floor,
- ev->per_chain_noise_floor,
- sizeof(chan_info->per_chain_noise_floor));
- return QDF_STATUS_SUCCESS;
- }
- /**
- * extract_channel_hopping_event_tlv() - extract channel hopping param
- * from event
- * @wmi_handle: wmi handle
- * @param evt_buf: pointer to event buffer
- * @param ch_hopping: Pointer to hold channel hopping param
- *
- * @return QDF_STATUS_SUCCESS on success and -ve on failure.
- */
- static QDF_STATUS extract_channel_hopping_event_tlv(
- wmi_unified_t wmi_handle, void *evt_buf,
- wmi_host_pdev_channel_hopping_event *ch_hopping)
- {
- WMI_PDEV_CHANNEL_HOPPING_EVENTID_param_tlvs *param_buf;
- wmi_pdev_channel_hopping_event_fixed_param *event;
- param_buf = (WMI_PDEV_CHANNEL_HOPPING_EVENTID_param_tlvs *)evt_buf;
- event = (wmi_pdev_channel_hopping_event_fixed_param *)
- param_buf->fixed_param;
- ch_hopping->noise_floor_report_iter = event->noise_floor_report_iter;
- ch_hopping->noise_floor_total_iter = event->noise_floor_total_iter;
- ch_hopping->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host(
- wmi_handle,
- event->pdev_id);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * send_peer_chan_width_switch_cmd_tlv() - send peer channel width params
- * @wmi_handle: WMI handle
- * @param: Peer channel width switching params
- *
- * Return: QDF_STATUS_SUCCESS on success or error code
- */
- static QDF_STATUS
- send_peer_chan_width_switch_cmd_tlv(wmi_unified_t wmi_handle,
- struct peer_chan_width_switch_params *param)
- {
- wmi_buf_t buf;
- wmi_peer_chan_width_switch_cmd_fixed_param *cmd;
- int32_t len;
- uint32_t max_peers_per_command, max_peers_per_buf;
- wmi_chan_width_peer_list *cmd_peer_list;
- int16_t pending_peers = param->num_peers;
- struct peer_chan_width_switch_info *param_peer_list =
- param->chan_width_peer_list;
- uint8_t ix;
- /* Max peers per WMI buffer */
- max_peers_per_buf = (wmi_get_max_msg_len(wmi_handle) -
- sizeof(*cmd) - WMI_TLV_HDR_SIZE) /
- sizeof(*cmd_peer_list);
- /*
- * Use param value only if it's greater than 0 and less than
- * the max peers per WMI buf.
- */
- if (param->max_peers_per_cmd &&
- (param->max_peers_per_cmd <= max_peers_per_buf)) {
- max_peers_per_command = param->max_peers_per_cmd;
- } else {
- max_peers_per_command = max_peers_per_buf;
- }
- WMI_LOGD("Setting peer limit as %u", max_peers_per_command);
- while (pending_peers > 0) {
- len = sizeof(*cmd) + WMI_TLV_HDR_SIZE;
- if (pending_peers >= max_peers_per_command) {
- len += (max_peers_per_command * sizeof(*cmd_peer_list));
- } else {
- len += (pending_peers * sizeof(*cmd_peer_list));
- }
- buf = wmi_buf_alloc(wmi_handle, len);
- if (!buf) {
- WMI_LOGE("wmi_buf_alloc failed");
- return QDF_STATUS_E_FAILURE;
- }
- cmd = (wmi_peer_chan_width_switch_cmd_fixed_param *)
- wmi_buf_data(buf);
- WMITLV_SET_HDR(&cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_peer_chan_width_switch_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_peer_chan_width_switch_cmd_fixed_param));
- cmd->num_peers = (pending_peers >= max_peers_per_command) ?
- max_peers_per_command : pending_peers;
- WMITLV_SET_HDR(((void *)cmd + sizeof(*cmd)),
- WMITLV_TAG_ARRAY_STRUC,
- cmd->num_peers *
- sizeof(wmi_chan_width_peer_list));
- cmd_peer_list = (wmi_chan_width_peer_list *)
- ((void *)cmd + sizeof(*cmd) +
- WMI_TLV_HDR_SIZE);
- for (ix = 0; ix < cmd->num_peers; ix++) {
- WMITLV_SET_HDR(&cmd_peer_list[ix].tlv_header,
- WMITLV_TAG_STRUC_wmi_chan_width_peer_list,
- WMITLV_GET_STRUCT_TLVLEN(
- wmi_chan_width_peer_list));
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param_peer_list[ix].mac_addr,
- &cmd_peer_list[ix].peer_macaddr);
- cmd_peer_list[ix].chan_width =
- param_peer_list[ix].chan_width;
- WMI_LOGD("Peer[%u]: chan_width = %u", ix,
- cmd_peer_list[ix].chan_width);
- }
- pending_peers -= cmd->num_peers;
- param_peer_list += cmd->num_peers;
- if (wmi_unified_cmd_send(wmi_handle, buf, len,
- WMI_PEER_CHAN_WIDTH_SWITCH_CMDID)) {
- WMI_LOGE("Sending peers for chwidth switch failed");
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- }
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS extract_multi_vdev_restart_resp_event_tlv(
- wmi_unified_t wmi_hdl, void *evt_buf,
- struct multi_vdev_restart_resp *param)
- {
- WMI_PDEV_MULTIPLE_VDEV_RESTART_RESP_EVENTID_param_tlvs *param_buf;
- wmi_pdev_multiple_vdev_restart_resp_event_fixed_param *ev;
- param_buf =
- (WMI_PDEV_MULTIPLE_VDEV_RESTART_RESP_EVENTID_param_tlvs *)evt_buf;
- if (!param_buf) {
- WMI_LOGE("Invalid buf multi_vdev restart response");
- return QDF_STATUS_E_INVAL;
- }
- ev = (wmi_pdev_multiple_vdev_restart_resp_event_fixed_param *)
- param_buf->fixed_param;
- if (!ev) {
- WMI_LOGE("Invalid ev multi_vdev restart response");
- return QDF_STATUS_E_INVAL;
- }
- param->pdev_id = wmi_hdl->ops->convert_target_pdev_id_to_host(
- wmi_hdl,
- ev->pdev_id);
- param->status = ev->status;
- if (!param_buf->num_vdev_ids_bitmap)
- return QDF_STATUS_E_FAILURE;
- qdf_mem_copy(param->vdev_id_bmap, param_buf->vdev_ids_bitmap,
- sizeof(param->vdev_id_bmap));
- WMI_LOGD("vdev_id_bmap is as follows");
- qdf_trace_hex_dump(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
- param->vdev_id_bmap, sizeof(param->vdev_id_bmap));
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS send_multisoc_tbtt_sync_cmd_tlv(wmi_unified_t wmi,
- struct rnr_tbtt_multisoc_sync_param *param)
- {
- wmi_pdev_tbtt_offset_sync_cmd_fixed_param *tbtt_sync_cmd;
- wmi_buf_t buf;
- wmi_pdev_rnr_bss_tbtt_info *bss_tbtt_info;
- int32_t len = 0;
- int idx;
- uint8_t *buf_ptr = NULL;
- switch (param->cmd_type) {
- case WMI_PDEV_GET_TBTT_OFFSET:
- len = sizeof(wmi_pdev_tbtt_offset_sync_cmd_fixed_param);
- break;
- case WMI_PDEV_SET_TBTT_OFFSET:
- len = sizeof(wmi_pdev_tbtt_offset_sync_cmd_fixed_param) +
- WMI_TLV_HDR_SIZE +
- (param->rnr_vap_count *
- sizeof(wmi_pdev_rnr_bss_tbtt_info));
- break;
- default:
- WMI_LOGP("%s: cmd_type: %d invalid", __func__, param->cmd_type);
- return QDF_STATUS_E_FAILURE;
- }
- buf = wmi_buf_alloc(wmi, len);
- if (!buf) {
- WMI_LOGP("%s: wmi_buf_alloc failed", __func__);
- return QDF_STATUS_E_NOMEM;
- }
- buf_ptr = wmi_buf_data(buf);
- tbtt_sync_cmd = (wmi_pdev_tbtt_offset_sync_cmd_fixed_param *)wmi_buf_data(buf);
- WMITLV_SET_HDR(&tbtt_sync_cmd->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_tbtt_offset_sync_cmd_fixed_param,
- WMITLV_GET_STRUCT_TLVLEN(wmi_pdev_tbtt_offset_sync_cmd_fixed_param));
- tbtt_sync_cmd->cmd_type = param->cmd_type;
- tbtt_sync_cmd->pdev_id = wmi->ops->convert_host_pdev_id_to_target(
- wmi,
- param->pdev_id);
- if (tbtt_sync_cmd->cmd_type == WMI_PDEV_SET_TBTT_OFFSET &&
- param->rnr_vap_count) {
- buf_ptr += sizeof(wmi_pdev_tbtt_offset_sync_cmd_fixed_param);
- WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
- (param->rnr_vap_count *
- sizeof(wmi_pdev_rnr_bss_tbtt_info)));
- bss_tbtt_info = (wmi_pdev_rnr_bss_tbtt_info *)(buf_ptr +
- WMI_TLV_HDR_SIZE);
- for (idx = 0; idx < param->rnr_vap_count; idx++) {
- WMITLV_SET_HDR(&bss_tbtt_info->tlv_header,
- WMITLV_TAG_STRUC_wmi_pdev_rnr_bss_tbtt_info,
- WMITLV_GET_STRUCT_TLVLEN(wmi_pdev_rnr_bss_tbtt_info));
- WMI_CHAR_ARRAY_TO_MAC_ADDR(param->rnr_bss_tbtt->bss_mac,
- &bss_tbtt_info->bss_mac);
- bss_tbtt_info->beacon_intval =
- param->rnr_bss_tbtt->beacon_intval;
- bss_tbtt_info->opclass = param->rnr_bss_tbtt->opclass;
- bss_tbtt_info->chan_idx =
- param->rnr_bss_tbtt->chan_idx;
- bss_tbtt_info->next_qtime_tbtt_high =
- param->rnr_bss_tbtt->next_qtime_tbtt_high;
- bss_tbtt_info->next_qtime_tbtt_low =
- param->rnr_bss_tbtt->next_qtime_tbtt_low;
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
- "Beacon Intval: %d, Chan: %d, opclass: %d",
- bss_tbtt_info->beacon_intval,
- bss_tbtt_info->chan_idx,
- bss_tbtt_info->opclass);
- bss_tbtt_info++;
- param->rnr_bss_tbtt++;
- }
- }
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
- "Cmd Type: %d, Pdev id: %d Vap count: %d", tbtt_sync_cmd->cmd_type,
- tbtt_sync_cmd->pdev_id, param->rnr_vap_count);
- if (wmi_unified_cmd_send(wmi, buf, len, WMI_PDEV_TBTT_OFFSET_SYNC_CMDID)) {
- WMI_LOGP("%s: Failed to send multisoc tbtt sync command", __func__);
- wmi_buf_free(buf);
- return QDF_STATUS_E_FAILURE;
- }
- return QDF_STATUS_SUCCESS;
- }
- void wmi_ap_attach_tlv(wmi_unified_t wmi_handle)
- {
- struct wmi_ops *ops = wmi_handle->ops;
- ops->send_peer_add_wds_entry_cmd = send_peer_add_wds_entry_cmd_tlv;
- ops->send_peer_del_wds_entry_cmd = send_peer_del_wds_entry_cmd_tlv;
- ops->send_peer_update_wds_entry_cmd =
- send_peer_update_wds_entry_cmd_tlv;
- ops->send_pdev_get_tpc_config_cmd = send_pdev_get_tpc_config_cmd_tlv;
- ops->send_set_ctl_table_cmd = send_set_ctl_table_cmd_tlv;
- ops->send_set_mimogain_table_cmd = send_set_mimogain_table_cmd_tlv;
- ops->send_packet_power_info_get_cmd =
- send_packet_power_info_get_cmd_tlv;
- ops->send_nf_dbr_dbm_info_get_cmd = send_nf_dbr_dbm_info_get_cmd_tlv;
- ops->send_set_ht_ie_cmd = send_set_ht_ie_cmd_tlv;
- ops->send_set_vht_ie_cmd = send_set_vht_ie_cmd_tlv;
- ops->send_set_quiet_mode_cmd = send_set_quiet_mode_cmd_tlv;
- ops->send_set_bcn_offload_quiet_mode_cmd =
- send_set_bcn_offload_quiet_mode_cmd_tlv;
- ops->send_bcn_offload_control_cmd = send_bcn_offload_control_cmd_tlv;
- ops->extract_swba_num_vdevs = extract_swba_num_vdevs_tlv;
- ops->extract_swba_tim_info = extract_swba_tim_info_tlv;
- ops->extract_swba_quiet_info = extract_swba_quiet_info_tlv;
- ops->extract_swba_noa_info = extract_swba_noa_info_tlv;
- ops->extract_offchan_data_tx_compl_param =
- extract_offchan_data_tx_compl_param_tlv;
- ops->extract_peer_sta_kickout_ev = extract_peer_sta_kickout_ev_tlv;
- ops->send_multiple_vdev_restart_req_cmd =
- send_multiple_vdev_restart_req_cmd_tlv;
- ops->extract_dcs_interference_type = extract_dcs_interference_type_tlv;
- ops->extract_dcs_cw_int = extract_dcs_cw_int_tlv;
- ops->extract_dcs_im_tgt_stats = extract_dcs_im_tgt_stats_tlv;
- ops->extract_peer_delete_response_event =
- extract_peer_delete_response_event_tlv;
- ops->extract_pdev_csa_switch_count_status =
- extract_pdev_csa_switch_count_status_tlv;
- ops->extract_pdev_tpc_ev_param = extract_pdev_tpc_ev_param_tlv;
- ops->extract_pdev_tpc_config_ev_param =
- extract_pdev_tpc_config_ev_param_tlv;
- ops->extract_nfcal_power_ev_param = extract_nfcal_power_ev_param_tlv;
- ops->extract_wds_addr_event = extract_wds_addr_event_tlv;
- ops->extract_peer_sta_ps_statechange_ev =
- extract_peer_sta_ps_statechange_ev_tlv;
- ops->extract_inst_rssi_stats_event = extract_inst_rssi_stats_event_tlv;
- ops->send_pdev_caldata_version_check_cmd =
- send_pdev_caldata_version_check_cmd_tlv;
- ops->extract_pdev_caldata_version_check_ev_param =
- extract_pdev_caldata_version_check_ev_param_tlv;
- #ifdef WLAN_SUPPORT_FILS
- ops->send_vdev_fils_enable_cmd = send_vdev_fils_enable_cmd_tlv;
- ops->extract_swfda_vdev_id = extract_swfda_vdev_id_tlv;
- ops->send_fils_discovery_send_cmd = send_fils_discovery_send_cmd_tlv;
- #endif /* WLAN_SUPPORT_FILS */
- ops->send_set_qboost_param_cmd = send_set_qboost_param_cmd_tlv;
- ops->send_gpio_config_cmd = send_gpio_config_cmd_tlv;
- ops->send_gpio_output_cmd = send_gpio_output_cmd_tlv;
- ops->send_mcast_group_update_cmd = send_mcast_group_update_cmd_tlv;
- ops->send_pdev_qvit_cmd = send_pdev_qvit_cmd_tlv;
- ops->send_wmm_update_cmd = send_wmm_update_cmd_tlv;
- ops->extract_mgmt_tx_compl_param = extract_mgmt_tx_compl_param_tlv;
- ops->extract_chan_info_event = extract_chan_info_event_tlv;
- ops->extract_channel_hopping_event = extract_channel_hopping_event_tlv;
- ops->send_peer_chan_width_switch_cmd =
- send_peer_chan_width_switch_cmd_tlv;
- #ifdef WLAN_SUPPORT_RX_PROTOCOL_TYPE_TAG
- ops->set_rx_pkt_type_routing_tag_cmd =
- set_rx_pkt_type_routing_tag_update_tlv;
- #endif /* WLAN_SUPPORT_RX_PROTOCOL_TYPE_TAG */
- ops->send_peer_vlan_config_cmd = send_peer_vlan_config_cmd_tlv;
- ops->extract_multi_vdev_restart_resp_event =
- extract_multi_vdev_restart_resp_event_tlv;
- ops->multisoc_tbtt_sync_cmd = send_multisoc_tbtt_sync_cmd_tlv;
- }
|